lazy.sa 2.1 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768
  1. semantic adaptation reactive moore LazySA lazy_sa
  2. at "./path/to/LazySA.fmu"
  3. for inner fmu Controller controller
  4. at "./path/to/Controller.fmu"
  5. with input ports Bool obj_detected, Bool passenger_up, Bool passenger_down, Bool passenger_stop, Bool driver_up, Bool driver_down, Bool driver_stop
  6. with output ports Bool up, Bool down, Bool stop
  7. input ports obj_detected -> controller.obj_detected,
  8. passenger_up -> controller.passenger_up,
  9. passenger_down -> controller.passenger_down,
  10. passenger_stop -> controller.passenger_stop,
  11. driver_up -> controller.driver_up,
  12. driver_down -> controller.driver_down,
  13. driver_stop -> controller.driver_stop
  14. param INIT_OBJ_DETECTED := false,
  15. INIT_PASSENGER_UP := false,
  16. INIT_PASSENGER_DOWN := false,
  17. INIT_PASSENGER_STOP := false,
  18. INIT_DRIVER_UP := false,
  19. INIT_DRIVER_DOWN := false,
  20. INIT_DRIVER_STOP := false;
  21. control var tn := -1.0,
  22. tl := -1.0,
  23. prev_obj_detected := INIT_OBJ_DETECTED,
  24. prev_passenger_up := INIT_PASSENGER_UP,
  25. prev_passenger_down := INIT_PASSENGER_DOWN,
  26. prev_passenger_stop := INIT_PASSENGER_STOP,
  27. prev_driver_up := INIT_DRIVER_UP,
  28. prev_driver_down := INIT_DRIVER_DOWN,
  29. prev_driver_stop := INIT_DRIVER_STOP;
  30. control rules {
  31. if (tl < 0.0){
  32. tl := t;
  33. }
  34. var step_size := min(H, tn - t);
  35. if (lazy_sa.obj_detected != prev_obj_detected or
  36. lazy_sa.passenger_up != prev_passenger_up or
  37. lazy_sa.passenger_down != prev_passenger_down or
  38. lazy_sa.passenger_stop != prev_passenger_stop or
  39. lazy_sa.driver_up != prev_driver_up or
  40. lazy_sa.driver_down != prev_driver_down or
  41. lazy_sa.driver_stop != prev_driver_stop or
  42. (t+H) >= tn
  43. ){
  44. var Real step_to_be_done := (t+H-tl);
  45. var step_done := do_step(controller, t, step_to_be_done);
  46. tn := tl + step_done + get_next_time_step(controller);
  47. step_size := tl + step_done - t;
  48. tl := tl + step_done;
  49. }
  50. prev_obj_detected := lazy_sa.obj_detected;
  51. prev_passenger_up := lazy_sa.passenger_up;
  52. prev_passenger_down := lazy_sa.passenger_down;
  53. prev_passenger_stop := lazy_sa.passenger_stop;
  54. prev_driver_up := lazy_sa.driver_up;
  55. prev_driver_down := lazy_sa.driver_down;
  56. prev_driver_stop := lazy_sa.driver_stop;
  57. return step_size;
  58. }