module_traffic_light_rule.h 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129
  1. #ifndef module_traffic_light_rule_h
  2. #define module_traffic_light_rule_h
  3. #include <vector>
  4. #include <list>
  5. #include <map>
  6. #include <unordered_map>
  7. #include <thread>
  8. #include <condition_variable>
  9. #include "module_traffic_light_common.h"
  10. #include "module_traffic_light.h"
  11. using vt_traffic_group = std::vector<traffic_light_group_ptr>;
  12. using mp_traffic_group = std::map<int, vt_traffic_group>;
  13. // 规则基类
  14. struct rule{
  15. rule(){}
  16. virtual ~rule(){}
  17. virtual void handle_rule(pos_data& p) = 0;
  18. virtual void put(traffic_light_group_ptr tlp) = 0;
  19. virtual void put(vt_traffic_group&& vc) = 0;
  20. // 闯红灯检查
  21. virtual std::shared_ptr<run_red_light> check_run_red_light(pos_data& p) = 0;
  22. // 车子按距离红绿灯组坐标点排序
  23. bool sort_vehicle(const uint64_t lhs, const uint64_t rhs, const traffic_light_group_ptr& g);
  24. bool sort_vehicle_by_level(const uint64_t lhs, const uint64_t rhs, const traffic_light_group_ptr& g);
  25. // 在红绿灯组数组中找离位置点(x,y)最近的灯组信息
  26. traffic_light_ptr find_nearby_light(const point& p, traffic_light_group_ptr g);
  27. };
  28. // 路口规则
  29. struct crossing_rule: rule{
  30. crossing_rule(){}
  31. ~crossing_rule(){}
  32. //
  33. void handle_rule(pos_data& p);
  34. // 谁先到达炉口红绿灯指定的距离,变绿灯,其他变红灯
  35. bool get_vehicle_state(const uint64_t& card_id);
  36. // 自动控制
  37. bool handle_manual_ctrl(traffic_light_group_ptr g);
  38. // 查找附近的红绿灯
  39. bool find_light(const uint64_t& cid, traffic_light_group_ptr g, bool a = false);
  40. // 避让处理
  41. bool handle_avoidance(traffic_light_group_ptr g);
  42. bool avoidance_by_level(traffic_light_group_ptr& group);
  43. bool avoidance_by_updown(traffic_light_group_ptr& group);
  44. // 路口处理
  45. bool handle_crossing(traffic_light_group_ptr group);
  46. // 修改红绿灯组状态
  47. void change_state(const uint64_t cid, traffic_light_group_ptr g);
  48. // 闯红灯
  49. std::shared_ptr<run_red_light> check_run_red_light(pos_data& p);
  50. void put(traffic_light_group_ptr g)
  51. {
  52. m_vt_group.push_back(g);
  53. }
  54. void put(vt_traffic_group&& vc)
  55. {
  56. m_vt_group = vc;
  57. }
  58. int size()
  59. {
  60. return m_vt_group.size();
  61. }
  62. private:
  63. // 灯组
  64. vt_traffic_group m_vt_group;
  65. };
  66. // 避让规则
  67. struct avoidance_rule: rule{
  68. public:
  69. avoidance_rule(){}
  70. ~avoidance_rule(){}
  71. void handle_rule(pos_data& p);
  72. // 给车卡绑定路口灯组控制,并更改灯组中灯的颜色状态
  73. void insert(traffic_light_group_ptr g, pos_data& p, vt_traffic_group& vg, const int lc, const int lcr);
  74. // 改变点p定位附近灯组的状态,满足条件的灯状态改为lc,否改为lcr
  75. void change_group(const traffic_light_group_ptr& g, const point& p, const int& lc, const int& lcr);
  76. // 把车卡从灯组控制中解绑
  77. void erase(bool a, pos_data& p, vt_traffic_group& vg);
  78. // 根据车辆与灯组的位置关系,查找灯组
  79. vt_traffic_group find_group(const pos_data& p);
  80. vt_traffic_group find_group(const point& po, int aid, double v, const pos_data& p);
  81. // 两个红绿灯组中间是否有车
  82. bool get_vehicle(const pos_data& p, vt_traffic_group& vg);
  83. // 求坐标点与红绿灯组的距离
  84. bool is_different(traffic_light_group_ptr g, const point& p, const int& lc, const int& lcr);
  85. // 后续小车避让大车规则,只需要找到前方的两个红绿灯,找到两个对比一下之前的记录,如果灯组改变了,则修改,如果没变,则判断是否有小车,进行改变
  86. // 如果只找到一个红绿灯,查看是否含有记录,如果有,则不做任何处理
  87. bool find_vehicle_in_group(vt_traffic_group& vg, std::vector<pos_data>& vv);
  88. // 闯红灯
  89. std::shared_ptr<run_red_light> check_run_red_light(pos_data& p);
  90. // 将灯组放入指定区域内
  91. void put(traffic_light_group_ptr ptlg)
  92. {
  93. m_map_area_group[ptlg->m_area_id].push_back(ptlg);
  94. }
  95. void put(vt_traffic_group&& lhs)
  96. {
  97. for(const auto x : lhs){
  98. m_map_area_group[x->m_area_id].push_back(x);
  99. }
  100. }
  101. int size()
  102. {
  103. return m_map_area_group.size();
  104. }
  105. private:
  106. mp_traffic_group m_map_area_group;
  107. };
  108. using hashmap_light = std::unordered_map<int, traffic_light_ptr>;
  109. using hashmap_group = std::unordered_map<int, traffic_light_group_ptr>;
  110. using map_group = std::map<int, traffic_light_group_ptr>;
  111. #endif