card_base.cpp 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451
  1. #include <memory>
  2. #include <message.h>
  3. #include "card_message_handle.h"
  4. #include "card_person.h"
  5. #include "card_car.h"
  6. #include "config_file.h"
  7. #include "select_tool.h"
  8. #include "module_service/module_mgr.h"
  9. #include "websocket/wsClientMgr.h"
  10. #include "websocket/wsTimerThread.h"
  11. #include "three_rates.h"
  12. #include "his_location.h"
  13. #include "event.h"
  14. #include "module_service/module_call.h"
  15. #include "mine.h"
  16. #include "common_tool.h"
  17. #include "ant.h"
  18. #include "area.h"
  19. #include "loc_point.h"
  20. #include "loc_message.h"
  21. #include "module_service/module_traffic_light_manager.h"
  22. #include "db/db_tool.h"
  23. #include "tool_time.h"
  24. extern config_file config;
  25. card_location_base::card_location_base(const std::string&type,uint32_t id,uint16_t dis,int16_t t,int32_t deptid,int32_t level_id,uint32_t cid)
  26. :card(id, dis, t, deptid, level_id, cid)
  27. ,m_display_old(dis)
  28. {
  29. select_tool_manage::instance()->create_tool(type, m_sel_tool, m_smo_tool);
  30. m_his_location_card.reset(new location_card(m_id, m_type, cid));
  31. m_cb_pdoa.set_capacity(5);
  32. m_cb_tof.set_capacity(5);
  33. m_cb_point.set_capacity(5);
  34. for(int index = 0; index < 5; ++index){
  35. m_cb_pdoa.push_back(100);
  36. m_cb_tof.push_back(0);
  37. m_cb_point.push_back(point(0,0));
  38. }
  39. m_cb_stream_idx.set_capacity(2);
  40. m_cb_stream_idx.push_back(0);
  41. m_cb_stream_idx.push_back(0);
  42. }
  43. void card_location_base::do_status(int st)
  44. {
  45. time_t now = time(0);
  46. bool help_flag = false;
  47. if((m_help_bit & 1) && (st & STATUS_HELP))
  48. {
  49. // 1111111111
  50. // ^
  51. m_help_last_time = now;
  52. }
  53. else if((m_help_bit & 1) && (st & STATUS_HELP)==0)
  54. {
  55. // 11111111100000
  56. // ^
  57. m_help_bit<<=1;
  58. }
  59. else if((m_help_bit & 1)==0 && (st & STATUS_HELP))
  60. {
  61. // 00000000011111
  62. // ^
  63. if((m_help_bit&0x3)==2)
  64. {
  65. log_warn("handle_m_help,card_id:%d\n",m_id);
  66. help_flag=true;
  67. }
  68. m_help_last_time=now;
  69. m_help_bit<<=1;
  70. m_help_bit|=1;
  71. }
  72. else
  73. {
  74. // 11111111100000
  75. // ^
  76. if(now-m_help_last_time>60)
  77. {
  78. m_help_bit=0;
  79. }
  80. }
  81. if(!help_flag)
  82. {
  83. st = st & (0xFFFFFFFF ^ STATUS_HELP);
  84. }
  85. if((STATUS_POWER_LOWER_SERIOUS & st) != 0)
  86. {
  87. m_pwr_stat=STATUS_POWER_LOWER_SERIOUS;
  88. }
  89. else
  90. {
  91. m_pwr_stat=0;
  92. }
  93. module_mgr::do_status((STATUS_CARD)st, m_id, m_type);
  94. }
  95. //写入历史轨迹
  96. void card_location_base::make_his_location(uint64_t t,const point & pt,bool bclose /*= false*/)
  97. {
  98. int area_id = 0, map_id = 0, site_id = 0;
  99. double scale = 0.0;
  100. if(auto site_ptr = get_area_tool()->m_site)
  101. {
  102. area_id = site_ptr->m_area_id;
  103. map_id = site_ptr->m_map_id;
  104. site_id = site_ptr->m_id;
  105. scale = site_ptr->m_scale;
  106. }
  107. auto mine_ptr = get_mine_tool();
  108. if(m_time < mine_ptr->get_down_time())
  109. {
  110. return;
  111. }
  112. m_his_location_card->push(t, pt, area_id, map_id, site_id, bclose);
  113. m_his_location_card->insert(t, pt, area_id, map_id, site_id, scale);
  114. }
  115. //坐标点输入业务入口
  116. void card_location_base::on_location(const std::vector<point>&vp,const std::vector<loc_message> &lm )
  117. {
  118. loc_point pt = m_sel_tool->select_solution(vp, lm);
  119. //pt.y = pt.y;
  120. auto site_ptr = get_area_tool()->m_site;
  121. int sid = 0;
  122. if(site_ptr)
  123. sid = site_ptr->m_id;
  124. if(pt.m_useless)
  125. {
  126. x = tool_other::round(pt.x,3);
  127. y = tool_other::round(pt.y,3);
  128. double acc = lm[0].m_acc;
  129. m_acc = lm[0].m_acc;
  130. log_info("useful loc point: type=%d, card=%d, site=%d, ct=%d, timestamp=%llu, x=%f, y=%f, speed=%.2f, acc=%.2f",m_type,m_id,sid,m_ct,m_time,x,y, m_speed, acc);
  131. do_business(lm.front().m_sit, pt, acc);
  132. int val = (lm[0].m_rav?STATUS_HELP:STATUS_NORMAL);
  133. do_status(val);
  134. }
  135. else
  136. {
  137. log_warn("坐标不可用:site=%d, type=%d, card=%d, ct=%d, x=%f, y=%f", sid, m_type, m_id, m_ct, pt.x, pt.y);
  138. }
  139. }
  140. void card_location_base::on_message(zloop<task*>* loop, message_locinfo& loc,bool is_history)
  141. {
  142. m_ct = loc.m_card_ct;
  143. m_time = loc.m_time_stamp;
  144. auto site_ptr = sit_list::instance()->get(loc.m_site_id);
  145. if(!site_ptr)
  146. {
  147. log_warn("接收到分站的数据,site=%d,card=%d,ct=%d,但是分站未定义",loc.m_site_id,m_id,loc.m_card_ct);
  148. return;
  149. }
  150. auto area_tool=get_area_tool();
  151. area_tool->set_site(site_ptr);
  152. handle_message(loc.m_card_ct,loc.m_batty_status);
  153. if(site_ptr->is_up_site())
  154. {
  155. log_info("card=%d被井上分站[site=%d]收到",m_id,site_ptr->id());
  156. area_tool->on_point(shared_from_this(),point(1,1));
  157. this->site_hover(loc.m_site_id);
  158. }
  159. else
  160. {
  161. if(site_ptr->is_path_empty())
  162. {
  163. log_warn("接收到分站的数据,site=%d,card=%d,ct=%d,但是分站路径为空",site_ptr->id(),m_id,loc.m_card_ct);
  164. return;
  165. }
  166. m_message_handle->on_message(loop,loc,is_history);
  167. }
  168. }
  169. /*
  170. * tdoa 调用算法库定位
  171. * */
  172. void card_location_base::on_message(zloop<task*>* loop, message_tdoa_locinfo& loc, bool is_history)
  173. {
  174. log_info("[tdoa] start calc location.");
  175. m_ct = loc.m_card_msg.m_sync_num;
  176. auto site_ptr = sit_list::instance()->get(loc.m_site_msg.m_site_id);
  177. if(!site_ptr){
  178. log_warn("[tdoa] 接收到分站的数据:site=%d, card=%d, ct=%d, 但是分站未定义", loc.m_site_msg.m_site_id, m_id, loc.m_card_msg.m_time_stamp);
  179. return;
  180. }
  181. auto area_tool=get_area_tool();
  182. area_tool->set_site(site_ptr);
  183. handle_message(loc.m_card_msg.m_time_stamp, loc.m_card_msg.m_battery_status);
  184. if(site_ptr->is_up_site())
  185. {}
  186. else{
  187. m_message_handle->on_message(loop, loc, is_history);
  188. }
  189. }
  190. /*
  191. * pdoa 调用算法库定位
  192. *
  193. * */
  194. void card_location_base::on_message(zloop<task*>* loop, message_pdoa_locinfo& loc, bool is_history)
  195. {
  196. m_ct = loc.m_card_ct;
  197. m_time = loc.m_time_stamp;
  198. auto site_ptr = sit_list::instance()->get(loc.m_site_id);
  199. if(!site_ptr){
  200. log_warn("[pdoa] 接收到分站的数据:site=%d, card=%d, ct=%d, 但是分站未定义", loc.m_site_id, m_id, loc.m_card_ct);
  201. return;
  202. }
  203. auto area_tool=get_area_tool();
  204. area_tool->set_site(site_ptr);
  205. // 此条件用于解决井下有的基站不能送出电量值时,会将卡的电量值按0输出,这种情况,默认卡的电量为初始值或之前值
  206. //if(loc.m_batty_status > 0){
  207. m_battery_value = loc.m_batty_status; // 电量值
  208. //}
  209. handle_message(loc.m_card_ct, loc.m_batty_status);
  210. if(site_ptr->is_up_site()){
  211. log_info("card=%d被井上分站[site=%d]收到", m_id, site_ptr->id());
  212. area_tool->on_point(shared_from_this(), point(1,1));
  213. this->site_hover(loc.m_site_id);
  214. m_last_site_id = site_ptr->id();
  215. //m_last_down_stream_idx = site_ptr->m_down_stream_idx;
  216. m_cb_stream_idx.push_back(site_ptr->m_down_stream_idx);
  217. }
  218. else{
  219. char sql[1024] = {0};
  220. snprintf(sql, 1024, "insert into his_distance_reader(card_type, ident, reader_id, dist, dir, cur_time) values(%d, %d, %d, %.2f, %d, '%s')", loc.m_card_type, loc.m_card_id, loc.m_site_id, loc.m_tof*15.65*2.996*1E-4, (tool_other::get_pdoa(loc.m_poa, site_ptr->m_pdoa_offset)>=0?1:-1), tool_time::to_str(time(NULL)).c_str());
  221. db_tool::PushAsync(sql);
  222. log_info("[sql] %s", sql);
  223. m_message_handle->on_message(loop, loc, is_history);
  224. }
  225. }
  226. //前端推送位置函数.
  227. void card_location_base::upt_card_pos(sys::_CARD_POS_&cp, point &pt)
  228. {
  229. point _p;
  230. if(pt.empty())
  231. {
  232. _p = *this;
  233. pt = _p;
  234. }
  235. else
  236. _p = pt;
  237. cp.Type = m_type;
  238. cp.ID = m_id;
  239. cp.speed = abs(ceil(m_speed));
  240. cp.x = tool_other::round(_p.x,3);
  241. cp.y = tool_other::round(_p.y,3);
  242. cp.running_stat = m_stat;
  243. cp.dept_id = m_deptid;
  244. cp.display = m_display;
  245. cp.rec_time = m_time;
  246. cp.level_id = m_level_id;
  247. cp.battery_val = m_battery_value;
  248. if(m_pwr_stat > 0){
  249. cp.battery_stat = (m_pwr_stat<3?1:0);
  250. }
  251. cp.m_freq = m_freq;
  252. swsTimerThrd.upt_card_pos(cp);
  253. }
  254. void card_location_base::del_card_pos()
  255. {
  256. sys::_CARD_POS_ cp;
  257. cp.ID = m_id;
  258. cp.Type=m_type;
  259. swsTimerThrd.del_card_pos(cp);
  260. }
  261. int card_location_base::get_stat()
  262. {
  263. //盲区>呼救>呼叫>超时>超速>正常
  264. uint64_t now = time(0)*1000;
  265. uint64_t tlost=now>m_time?now-m_time:m_time-now;
  266. if(tlost>CARD_LOST_TIME_OUT)
  267. {
  268. // 人卡盲区: 当人卡丢失信号大于60s,判定人卡进入盲区
  269. return STATUS_LOST;
  270. }
  271. else if(auto ev_ptr = event_list::instance()->get_event_card(m_id, m_type, ET_CARD_HELP))
  272. {
  273. return (ES_DEAL_HELP == ev_ptr->m_status) ? STATUS_HELP_DEALED : STATUS_HELP;
  274. }
  275. else if(CALL_NONE != get_mine_tool()->m_status_call)
  276. {
  277. return STATUS_CALL;
  278. }
  279. else if(is_person())
  280. {
  281. if(event_list::instance()->get_event_card(m_id, m_type,ET_CARD_AREA_OVER_TIME_PERSON)||
  282. event_list::instance()->get_event_card(m_id, m_type,ET_CARD_OVER_TIME_PERSON))
  283. return STATUS_AREA_OVER_TIME;
  284. }
  285. else if(event_list::instance()->get_event_card(m_id, m_type, ET_CARD_OVER_SPEED))
  286. {
  287. return STATUS_OVER_SPEED;
  288. }
  289. return STATUS_NORMAL;
  290. }
  291. void card_location_base::clear()
  292. {
  293. // uint16_t m_display; //1显示0不显示,往前端推送
  294. m_speed=0; //速度
  295. m_stat=0; //运动静止状态
  296. //m_ct; //ct
  297. m_time=0; //时间戳
  298. //pdoa location info clear
  299. m_buff_size = 0;
  300. m_last_recv_time = 0;
  301. m_last_point = point(0,0);
  302. m_last_site_id = 0;
  303. m_last_site_dir = -1;
  304. m_last_ct = 0;
  305. m_last_dist = 0.0;
  306. m_pdoa_diff = m_last_pdoa_diff = 100.0;
  307. m_last_over_site = false;
  308. m_cache_nums = 0;
  309. m_cb_pdoa.clear();
  310. m_cb_tof.clear();
  311. m_cb_point.clear();
  312. }
  313. void card_location_base::put_three_rates(card_pos & cp)
  314. {
  315. if(!three_rates_flag)
  316. return;
  317. cp.rec_time = m_time;
  318. cp.type = m_type;
  319. cp.id = m_id;
  320. cp.identifier_id= m_cid;
  321. cp.running_stat = m_stat;
  322. cp.final_v = m_speed;
  323. cp.dpt_id = m_deptid;
  324. std::shared_ptr<area_tool> _areatool = get_area_tool();
  325. if(nullptr != _areatool && nullptr != _areatool->m_site)
  326. {
  327. cp.reader_x = _areatool->m_site->x;
  328. cp.reader_y = _areatool->m_site->y;
  329. cp.reader_id = _areatool->m_site->m_id;
  330. }
  331. log_info("three_rates:type:%d,id:%d,cid:%d",cp.type,cp.id,cp.identifier_id);
  332. three_rates::get_instance()->put(cp);
  333. }
  334. void card_location_base::put_traffic_light(card_pos& cp)
  335. {
  336. if(!traffic_light_flag){
  337. return;
  338. }
  339. light_message lm;
  340. lm.m_cmd = cmd_card_data;
  341. lm.m_pos.x = cp.x;
  342. lm.m_pos.y = cp.y;
  343. lm.m_pos.z = cp.z;
  344. lm.m_pos.m_card_id = m_id;
  345. lm.m_pos.m_type = m_type;
  346. lm.m_pos.m_site_id = cp.reader_id;
  347. auto site_ptr = get_area_tool()->m_site;
  348. if(site_ptr){
  349. lm.m_pos.m_area_id = site_ptr->m_area_id;
  350. }
  351. //lm.m_pos.m_bigger = 0;
  352. lm.m_pos.m_speed = m_speed;
  353. log_info("[traffic_light] put locate info into traffic light module, card_id=%d, ctype=%d, x=%.2f, y=%.2f, site_id=%d", m_id, m_type, x, y, cp.reader_id);
  354. traffic_light_manager::instance()->put(lm);
  355. }
  356. bool card_location_base::is_person() const
  357. {
  358. return tool_other::is_person(m_type);
  359. }
  360. bool card_location_base::is_vehicle() const
  361. {
  362. return tool_other::is_vehicle(m_type);
  363. }
  364. void card_location_base::set_base_data(uint32_t cid,uint16_t type,uint32_t deptid,int32_t level_id) {
  365. m_cid = cid;
  366. m_type = type;
  367. m_deptid = deptid;
  368. m_level_id = level_id;
  369. m_his_location_card->set_cid(cid);
  370. }
  371. card_location_base::~card_location_base()
  372. {
  373. }
  374. std::shared_ptr<card_location_base> card_location_base::make_person(const std::string&type,uint32_t cardid,uint16_t needdisplay,int16_t t,
  375. int32_t deptid,int32_t level_id,uint32_t cid,int wl,const std::string &sname,const std::string & dname,int worktype_id)
  376. {
  377. return std::make_shared<person>(type, cardid, needdisplay, t, deptid, level_id, cid, wl, sname, dname, worktype_id);
  378. }
  379. /*
  380. * @brief 创建车辆对象
  381. * @param const std::string& type
  382. * @param uint32_t cardid 卡id
  383. * @param uint16_t needdisplay 是否需要显示
  384. * @param int16_t t
  385. * @param int32_t deptid 部门id
  386. * @param int32_t categoryid
  387. * @param int type_id 卡类型id
  388. * @param int32_t level_id 职级id
  389. * @param uint32_t cid
  390. * @return 车辆对象
  391. * @note
  392. * @bug
  393. * @warning
  394. * */
  395. std::shared_ptr<card_location_base> card_location_base::make_car(const std::string&type, uint32_t cardid, uint16_t needdisplay, int16_t t,
  396. int32_t deptid, int32_t categoryid, int type_id,int32_t level_id,uint32_t cid)
  397. {
  398. return std::make_shared<car>(type, cardid, needdisplay, t, deptid, categoryid, type_id, level_id, cid);
  399. }