common_data.h 6.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180
  1. //
  2. // Created by huli on 2020/9/8.
  3. //
  4. #ifndef NNXX_TESTS_COMMON_DATA_H
  5. #define NNXX_TESTS_COMMON_DATA_H
  6. #include <string>
  7. #include "../message/message_base.pb.h"
  8. class Common_data
  9. {
  10. public:
  11. //万集雷达扫描周期66ms, (频率15hz), 一般设置大一些
  12. #define WANJI_716_SCAN_CYCLE_MS 70
  13. //车位表
  14. #define PARKSPACE_ID_BASE 0
  15. #define PASSAGEWAY_ID_BASE 1100
  16. //唯一码的默认长度 32byte
  17. #define COMMAND_KEY_DEFAULT_LENGTH 32
  18. //整车的测量信息
  19. struct Car_measure_information
  20. {
  21. float center_x = 0; //整车的中心点x值, 四轮的中心
  22. float center_y = 0; //整车的中心点y值, 四轮的中心
  23. float car_angle = 0; //整车的车身旋转角,
  24. float car_length = 0; //整车的长度, 用于规避碰撞
  25. float car_width = 0; //整车的宽度, 用于规避碰撞
  26. float car_height = 0; //整车的高度, 用于规避碰撞
  27. float car_wheel_base = 0; //整车的轮距, 前后轮的距离, 用于机器人或agv的抓车
  28. float car_wheel_width = 0; //整车的轮距, 左右轮的距离, 用于机器人或agv的抓车
  29. float car_front_theta = 0; //整车的前轮的旋转角
  30. bool correctness = false; //整车的校准标记位
  31. };
  32. //四轮的测量信息
  33. struct Car_wheel_information
  34. {
  35. float center_x = 0; //整车的中心点x值, 四轮的中心
  36. float center_y = 0; //整车的中心点y值, 四轮的中心
  37. float car_angle = 0; //整车的车身旋转角,
  38. float car_wheel_base = 0; //整车的轮距, 前后轮的距离, 用于机器人或agv的抓车
  39. float car_wheel_width = 0; //整车的轮距, 左右轮的距离, 用于机器人或agv的抓车
  40. float car_front_theta = 0; //整车的前轮的旋转角
  41. bool correctness = false; //整车的校准标记位
  42. };
  43. struct Car_information
  44. {
  45. std::string license; //车辆凭证号
  46. float car_length=0; //车长
  47. float car_width=0; //车宽
  48. float car_height=0; //车高
  49. float car_wheel_base = 0; //整车的轮距; 前后轮的距离; 用于机器人或agv的抓车
  50. float car_wheel_width = 0; //整车的轮距; 左右轮的距离; 用于机器人或agv的抓车
  51. };
  52. //车位状态枚举
  53. enum Parkspace_status
  54. {
  55. PARKSPACE_STATUS_UNKNOW = 0,
  56. PARKSPACE_EMPTY = 1, //空闲,可分配
  57. PARKSPACE_OCCUPIED = 2, //被占用,不可分配
  58. PARKSPACE_RESERVED = 3, //被预约,预约车辆可分配, 暂时不用
  59. PARKSPACE_LOCKED = 4, //临时锁定,不可分配
  60. PARKSPACE_ERROR = 5, //车位机械结构或硬件故障
  61. };
  62. enum Direction
  63. {
  64. DIRECTION_UNKNOW = 0,
  65. DIRECTION_FORWARD = 1,
  66. DIRECTION_BACKWARD = 2,
  67. };
  68. //车位分配路线(根据中跑车的路线来定)
  69. enum Parkspace_path
  70. {
  71. UNKNOW_PATH = 0,
  72. OPTIMAL_PATH = 1,
  73. LEFT_PATH = 2,
  74. RIGHT_PATH = 3,
  75. TEMPORARY_CACHE_PATH = 4,
  76. };
  77. //车位类型
  78. enum Parkspace_type
  79. {
  80. UNKNOW_PARKSPACE_TYPE = 0,
  81. MIN_PARKINGSPACE = 1,//小车位
  82. MID_PARKINGSPACE = 2,//中车位
  83. BIG_PARKINGSPACE = 3,//大车位
  84. };
  85. //汽车类型
  86. enum Car_type
  87. {
  88. UNKNOW_CAR_TYPE = 0,
  89. MIN_CAR = 1,//小车
  90. MID_CAR = 2,//中车
  91. BIG_CAR = 3,//大车
  92. };
  93. //单个车位基本信息与状态信息,车位信息以及车位上的车辆信息
  94. struct Parkspace_information
  95. {
  96. int parkingspace_index_id=0; //车位编号
  97. Parkspace_type parkingspace_type=UNKNOW_PARKSPACE_TYPE; //车位类型
  98. int parkingspace_unit_id=0; //区块编号
  99. int parkingspace_floor_id=0; //楼层
  100. int parkingspace_room_id=0; //同层编号
  101. Direction parkingspace_direction=DIRECTION_UNKNOW; //前后
  102. float parkingspace_width=0; //车位宽
  103. float parkingspace_height=0; //车位高
  104. Parkspace_status parkingspace_status=PARKSPACE_EMPTY; //车位当前状态
  105. Car_information car_information; //当前车位存入车辆的凭证号
  106. std::string car_entry_time; //入场时间
  107. std::string car_leave_time; //离场时间
  108. Parkspace_path parkspace_path = UNKNOW_PATH; // 车位分配路线
  109. float path_estimate_time = 0; //车位分配路线 time(s)
  110. Parkspace_status parkspace_status_target=PARKSPACE_EMPTY; //车位目标状态
  111. };
  112. static void copy_data(Car_measure_information& car_measure_information_out, const message::Locate_information& locate_information_in);
  113. static void copy_data(message::Locate_information& locate_information_out, const Car_measure_information& car_measure_information_in);
  114. static void copy_data(Car_information& car_information_out, const message::Car_info& car_info_in);
  115. static void copy_data(message::Car_info& car_info_out, const Car_information& car_information_in);
  116. static void copy_data(Parkspace_information& parkspace_information_out, const message::Parkspace_info& parkspace_info_in);
  117. static void copy_data(message::Parkspace_info& parkspace_info_out, const Parkspace_information& parkspace_information_in);
  118. static void transform_data(Car_information& car_information_out, const Car_measure_information& car_measure_information_in);
  119. static void transform_data(Car_measure_information& car_measure_information_out, const Car_information& car_informatio_in);
  120. static void transform_data(Car_wheel_information& car_wheel_information_out, const Car_measure_information& car_measure_information_in);
  121. static void transform_data(Car_measure_information& car_measure_information_out, const Car_wheel_information& car_wheel_information_in);
  122. static void scaling(Car_measure_information& car_measure_information, float rate);
  123. static void scaling(Car_information& car_information, float rate);
  124. static void scaling(Parkspace_information& parkspace_information, float rate);
  125. static bool approximate_rate(float a, float b, float rate);
  126. static bool approximate_difference(float a, float b, float difference);
  127. //调度模块
  128. //调度任务类型
  129. enum Dispatch_process_type
  130. {
  131. DISPATCH_PROCESS_TYPE_UNKNOW = 0, //未知
  132. DISPATCH_PROCESS_STORE = 101, //存车
  133. DISPATCH_PROCESS_PICKUP = 102, //取车
  134. };
  135. };
  136. #endif //NNXX_TESTS_COMMON_DATA_H