lazy.sa 1.1 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253
  1. module Lazy_SA
  2. semantic adaptation reactive moore LazySA lazy_sa
  3. at "./path/to/LazySA.fmu"
  4. for inner fmu Controller controller
  5. at "./path/to/Controller.fmu"
  6. with input ports obj_detected, passenger_up, passenger_down, passenger_stop, driver_up, driver_down, driver_stop
  7. with output ports up, down, stop
  8. input ports obj_detected -> controller.obj_detected
  9. output ports up, down, stop
  10. param INIT_UP := 0.0,
  11. INIT_DOWN := 0.0,
  12. INIT_STOP := 0.0;
  13. control var tn := -1.0,
  14. tl := -1.0;
  15. control rules {
  16. if (tl < 0.0){
  17. tl := t;
  18. }
  19. var step_size := min(H, tn - t);
  20. if (lazy_sa.obj_detected or (t+H) >= tn){
  21. var step_to_be_done := (t+H-tl);
  22. var step_done := do_step(controller, t, step_to_be_done);
  23. tn := tl + step_done + get_next_time_step(controller);
  24. step_size := tl + step_done - t;
  25. tl := tl + step_done;
  26. }
  27. return step_size;
  28. }
  29. out var stored_up := INIT_UP,
  30. stored_down := INIT_DOWN,
  31. stored_stop := INIT_STOP;
  32. out rules{
  33. true -> {
  34. stored_up := controller.up;
  35. stored_down := controller.down;
  36. stored_stop := controller.stop;
  37. } --> {
  38. lazy_sa.up := stored_up;
  39. lazy_sa.down := stored_down;
  40. lazy_sa.stop := stored_stop;
  41. };
  42. }