overswing.go 772 B

123456789101112131415161718192021222324252627282930313233343536373839404142
  1. package main
  2. import (
  3. "cicv-data-closedloop/pjisuv_msgs"
  4. "math"
  5. )
  6. /*
  7. def callback_cicv_location(data):
  8. global angular_velocity_z
  9. global Ego_position_x
  10. global Ego_position_y
  11. global Ego_yaw
  12. Ego_position_x=data.position_x
  13. Ego_position_y=data.position_y
  14. Ego_yaw=data.yaw
  15. #print(Ego_yaw)
  16. angular_velocity_z=data.angular_velocity_z
  17. #print(angular_velocity_z)
  18. if abs(angular_velocity_z)>=27:
  19. event_label='overswing' #横摆角速度过大
  20. print(event_label)
  21. */
  22. func Topic() string {
  23. return "/cicv_location"
  24. }
  25. func Label() string {
  26. return "overswing"
  27. }
  28. func Rule(data *pjisuv_msgs.PerceptionLocalization) string {
  29. if math.Abs(data.AngularVelocityZ) >= 27.0 {
  30. return "overswing"
  31. } else {
  32. return ""
  33. }
  34. }