card_car.cpp 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196
  1. #include "card_car.h"
  2. #include "card_message_handle.h"
  3. #include "his_location.h"
  4. #include "area.h"
  5. #include "mine.h"
  6. #include "three_rates.h"
  7. #include "select_tool.h"
  8. #include "websocket/ws_common.h"
  9. #include "special_area.h"
  10. #include "common_tool.h"
  11. #include "tool_time.h"
  12. #include "mine_business.h"
  13. #include "loc_point.h"
  14. #include "module_service/module_call.h"
  15. #include "ya_setting.h"
  16. car::car(const std::string&type,uint32_t cardid,uint16_t needdisplay,int16_t t,int32_t deptid,
  17. int32_t categoryid, int type_id,int32_t level_id,uint32_t cid)
  18. :card_location_base(type,cardid,needdisplay,t,deptid,level_id,cid)
  19. ,m_vehicle_category_id(categoryid)
  20. ,m_vehicle_type_id(type_id)
  21. {
  22. m_message_handle.reset(new card_message_handle(this));
  23. //m_his_location_card.reset(new location_vehicle(m_id,m_type,cid));
  24. }
  25. car::~car(){}
  26. std::shared_ptr<mine_tool> car::get_mine_tool()
  27. {
  28. return m_mine_tool;
  29. }
  30. void car::set_area_info(int mapid,double scale,int areaid,uint64_t t,int type)
  31. {
  32. m_area_tool->set_area_info(mapid,scale,areaid,*this,t,type);
  33. }
  34. void car::do_business(const std::shared_ptr<site>&site,const point &pt,double acc)
  35. {
  36. m_acc=acc;
  37. m_area_tool->on_point(shared_from_this(),pt);
  38. m_timeval = m_time;
  39. log_info("[anti_coll] m_id = %d, m_timeval = %lld", m_id, m_timeval);
  40. handle_three_rates(pt);
  41. handle_traffic_light(pt);
  42. if(m_enable_anti_collision){
  43. handle_anti_coll(pt, site->m_id);
  44. }
  45. uint64_t id=tool_other::type_id_to_u64(m_type,m_id);
  46. mine_business::inst()->make_arg(id,pt,m_time);
  47. }
  48. int car::get_vehicle_type_id()
  49. {
  50. return m_vehicle_type_id;
  51. }
  52. void car::handle_anti_coll(const point& pt, const int& sid)
  53. {
  54. log_info("[anti_coll] handle anti collision");
  55. // 车卡下发最紧急的呼叫类型
  56. std::map<int, call_card> cards;
  57. auto tmp_cards = card_list::instance()->m_map;
  58. for(auto k : CYaSetting::m_sys_setting.mp_anti_collision){
  59. log_info("[anti_coll] key=%d, value=%.2f", k.first, k.second);
  60. for(auto c : tmp_cards)
  61. {
  62. if(c.second->m_type == CT_VEHICLE){
  63. continue;
  64. }
  65. bool s = false;
  66. int d = (c.second->m_timeval >= m_timeval ? (c.second->m_timeval - m_timeval) : (m_timeval - c.second->m_timeval)) / 1000.0;
  67. s = ((c.second->m_timeval >= m_timeval ? (c.second->m_timeval - m_timeval) : (m_timeval - c.second->m_timeval)) /1000.0 <= 30);
  68. log_info("[anti_coll] distance=%.3f, thre_value=%.3f, time_diff=%d", pt.dist(*c.second), k.second, d);
  69. if(pt.dist(*c.second) < k.second && s){
  70. auto it = cards.find(c.second->m_id);
  71. if(it != cards.end()){
  72. if(c.second->m_call_level < k.first + 3){
  73. c.second->m_call_level = k.first + 3;
  74. }
  75. }else{
  76. log_info("[anti_coll] card_id=%d, ctype=%d, call_level=%d, call_type_id=%d, site_id=%d",c.second->m_id, c.second->m_type, k.first, CCT_CALL_APOINT, sid);
  77. cards.insert(std::make_pair(c.second->m_id, call_card(c.second->m_id, c.second->m_type, k.first, CCT_CALL_APOINT, sid)));
  78. }
  79. }
  80. }
  81. }
  82. if(cards.size() > 0){
  83. // find the best emengency call
  84. int call_level = 6;
  85. for(auto c : cards){
  86. if(c.second.call_level_id < call_level){
  87. call_level = c.second.call_level_id;
  88. }
  89. }
  90. cards.insert(std::make_pair(m_id, call_card(m_id, 2, call_level, CCT_CALL_APOINT, sid)));
  91. }else{
  92. log_info("[anti_coll] no card trigger anti collision rules.");
  93. return;
  94. }
  95. module_call::instance()->send_anti_collision(cards);
  96. }
  97. void car::handle_three_rates(const point &pt)
  98. {
  99. card_pos cp;
  100. m_biz_stat = get_stat();
  101. cp.biz_stat = m_biz_stat;
  102. cp.x = pt.x;
  103. cp.y = pt.y;
  104. cp.z = pt.z;
  105. //const auto lm = m_area_tool->getLandmark();
  106. //cp.enter_time = std::get<0>(lm)*1000;
  107. //cp.area_id = std::get<3>(lm);
  108. cp.map_id = m_area_tool->get_mapid();
  109. cp.vibration = m_acc;
  110. put_three_rates(cp);
  111. }
  112. void car::handle_traffic_light(const point& p)
  113. {
  114. card_pos cp;
  115. cp.x = p.x;
  116. cp.y = p.y;
  117. cp.z = p.z;
  118. cp.map_id = m_area_tool->get_mapid();
  119. cp.vibration = m_acc;
  120. put_traffic_light(cp);
  121. }
  122. void car::on_timer()
  123. {
  124. if(!empty())
  125. make_package();
  126. }
  127. int car::get_area()
  128. {
  129. int status = m_biz_stat;
  130. int special_id = -1;
  131. if(status == STATUS_LOST)
  132. {
  133. special_id = special_area_list::instance()->get_special_id(m_id,*this,m_vehicle_category_id);
  134. log_info("enter_special_area:%.2f,%2.f,id:%d,special_area_id:%d",x,y,m_id,special_id);
  135. }
  136. return special_id;
  137. }
  138. void car::make_package()
  139. {
  140. YA::_CARD_POS_ cp;
  141. loc_point pt = getSmoothPoint();
  142. cp.area_info=m_area_tool->m_area_info;
  143. cp.map_id =m_area_tool->get_mapid();
  144. int32_t biz_stat=m_biz_stat;
  145. cp.biz_stat=biz_stat;
  146. cp.down_time = m_mine_tool->get_down_time();
  147. cp.work_time = m_mine_tool->get_work_time();
  148. uint32_t on_duty=0;
  149. // if(m_mine_tool->m_is_attendance)
  150. on_duty=m_mine_tool->is_on_duty();
  151. cp.is_on_duty=on_duty;
  152. upt_card_pos(cp,pt);
  153. make_his_location(pt.m_time,pt);
  154. uint64_t _now=tool_time::now_to_ms();
  155. uint64_t t=_now>m_timeval?_now-m_timeval:m_timeval-_now;
  156. if(t>10*1000)
  157. {
  158. m_area_tool->on_point(shared_from_this(),pt);
  159. m_biz_stat=get_stat();
  160. }
  161. // if(biz_stat==STATUS_LOST && special_id != -1 && m_display==1)
  162. // {
  163. // cp.area_id = special_id;
  164. // swsClientMgr.SendSpecialAreaProcess(cp);
  165. // }
  166. }
  167. void car::get_card(bool f)
  168. {
  169. if(f)
  170. mine_business::inst()->put(shared_from_this());
  171. }
  172. loc_point car::getSmoothPoint()
  173. {
  174. loc_point lp = m_smo_tool->smooth_strategy();
  175. m_speed = lp.m_speed;
  176. m_stat = lp.m_stat;
  177. lp.y = -lp.y;
  178. return lp;
  179. }