module_traffic_light_rule.h 5.2 KB

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