card.cpp 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524
  1. #include <memory>
  2. #include <log.h>
  3. #include <zloop.h>
  4. #include "select_tool.h"
  5. #include "loc_tool.h"
  6. #include <area.h>
  7. #include <site_area.h>
  8. #include <card.h>
  9. #include "config_file.h"
  10. #include "db_api/CDBConnPool.h"
  11. #include "websocket/wsTimerThread.h"
  12. #include "timestamp.h"
  13. #include "monkey_car/monkeycar_area.h"
  14. #include "monkey_car/monkeycar_person.h"
  15. extern config_file config;
  16. //一张卡一个ct的所有不同天线的信息
  17. struct one_ct_message_handle
  18. {
  19. static loc_tool_main m_loc_tool;
  20. ev::timer m_min_timer,m_max_timer;
  21. //loc_message.
  22. std::vector<loc_message> m_msg_list;
  23. card_location_base*m_card;
  24. const algo_config*m_ac=nullptr;
  25. int m_ct;
  26. bool m_min_timeout=false;
  27. ev::dynamic_loop * m_loop = nullptr;
  28. one_ct_message_handle(card_location_base*card)
  29. {
  30. m_card=card;
  31. m_ct=-1;
  32. }
  33. void reset()
  34. {
  35. m_ct=-1;
  36. m_min_timeout=false;
  37. m_msg_list.clear();
  38. }
  39. void on_min_timer()
  40. {
  41. m_min_timer.stop();
  42. if((int)m_msg_list.size()>=m_ac->best_msg_cnt)
  43. {
  44. m_max_timer.stop();
  45. calc_location();
  46. return;
  47. }
  48. m_min_timeout=true;
  49. }
  50. void on_max_timer()
  51. {
  52. m_max_timer.stop();
  53. calc_location();
  54. }
  55. void set(ev::dynamic_loop * loop)
  56. {
  57. m_loop = loop;
  58. m_min_timer.set(*m_loop);
  59. m_min_timer.set<one_ct_message_handle,&one_ct_message_handle::on_min_timer>(this);
  60. m_max_timer.set(*m_loop);
  61. m_max_timer.set<one_ct_message_handle,&one_ct_message_handle::on_max_timer>(this);
  62. }
  63. void on_message(ev::dynamic_loop *loop,const message_locinfo&loc)
  64. {
  65. if(m_loop == nullptr && loop!=nullptr)
  66. set(loop);
  67. else if(loop == nullptr)
  68. return;
  69. if(!m_msg_list.empty()&& m_ct!=loc.m_card_ct)
  70. {
  71. m_msg_list.clear();
  72. }
  73. auto sitPtr = sit_list::instance()->get(loc.m_site_id);
  74. if(sitPtr==nullptr)
  75. {
  76. log_warn("分站信息缺失,SitId:%d",loc.m_site_id);
  77. return;
  78. }
  79. const site &s=*(sit_list::instance()->get(loc.m_site_id));
  80. if(m_msg_list.empty())
  81. {
  82. m_ct=loc.m_card_ct;
  83. m_ac=&s.config();
  84. m_min_timeout=false;
  85. //这里构造loc_message 保存数据
  86. m_msg_list.push_back(loc_message(s,loc.m_tof,loc.m_time_stamp,loc.m_card_id,
  87. loc.m_card_ct,loc.m_card_type,loc.m_ant_id,loc.m_rav,loc.m_acc,
  88. loc.m_sync_ct,loc.m_rssi));
  89. //启动本CT的最小、最大两个定时器
  90. m_min_timer.start(m_ac->min_wait_time);
  91. m_max_timer.start(m_ac->min_wait_time);
  92. return;
  93. }
  94. m_msg_list.push_back(loc_message(s,loc.m_tof,loc.m_time_stamp,loc.m_card_id,
  95. loc.m_card_ct,loc.m_card_type,loc.m_ant_id,loc.m_rav,loc.m_acc,
  96. loc.m_sync_ct,loc.m_rssi));
  97. if(m_min_timeout && (int)m_msg_list.size()>=m_ac->best_msg_cnt)
  98. {
  99. calc_location();
  100. m_max_timer.stop();
  101. }
  102. }
  103. void calc_location()
  104. {
  105. auto v = m_msg_list;
  106. std::vector<point> rc=std::move(m_loc_tool.calc_location(v));
  107. if(!rc.empty()) m_card->on_location(std::move(rc),v);
  108. reset();
  109. }
  110. };
  111. struct card_message_handle
  112. {
  113. card_location_base*m_card;
  114. std::array<one_ct_message_handle*,16> m_ct_list;
  115. card_message_handle(card_location_base*card)
  116. {
  117. m_card=card;
  118. for(size_t i=0;i<m_ct_list.size();i++)
  119. {
  120. m_ct_list[i]=new one_ct_message_handle(card);
  121. }
  122. }
  123. ~card_message_handle()
  124. {
  125. for(auto&it:m_ct_list)
  126. {
  127. delete it;
  128. }
  129. }
  130. void on_message(zloop<task*> * loop,const message_locinfo&loc,bool is_history)
  131. {
  132. if(is_history)
  133. {
  134. log_warn("%s","当前代码没有处理历史消息记录。");
  135. return;
  136. }
  137. if(loc.m_batty_status == 2)
  138. {
  139. m_card->do_status(STA_TYPE::STATUS_LOW_POWER);
  140. }
  141. else if(loc.m_callinfo == 0x80)
  142. {
  143. m_card->do_status(STA_TYPE::STATUS_HELP);
  144. }
  145. m_ct_list[loc.m_card_ct&(m_ct_list.size()-1)]->on_message(loop,loc);
  146. }
  147. };
  148. struct card_area
  149. {
  150. card_area()
  151. {
  152. m_site_area.reset(new site_area_hover);
  153. m_area_tool.reset(new area_tool);
  154. }
  155. std::shared_ptr<site_area_hover> m_site_area=nullptr;
  156. std::shared_ptr<area_tool> m_area_tool=nullptr;
  157. };
  158. struct person:card_location_base,private card_area
  159. {
  160. std::weak_ptr<monkey_person> m_monkeyPerson;
  161. person(std::string type,uint32_t cardid,uint16_t needdisplay,int16_t t,int32_t deptid)
  162. :card_location_base(type,cardid,needdisplay,t,deptid)
  163. {
  164. m_message_handle = new card_message_handle(this);
  165. }
  166. void on_message(zloop<task*> * loop,const message_locinfo&loc,bool is_history)
  167. {
  168. m_message_handle->on_message(loop,loc,is_history);
  169. }
  170. virtual void do_business(const point &pt)
  171. {
  172. //区域
  173. m_area_tool->on_point(m_id,pt,m_speed,m_type);
  174. //考勤
  175. //
  176. }
  177. void set(ev::dynamic_loop * loop)
  178. {
  179. log_info("cardid_id %d",m_id);
  180. m_loop = loop;
  181. m_timer.set(*m_loop);
  182. m_timer.set<person,&person::on_timer>(this);
  183. m_timer.start(1,1);
  184. }
  185. void reset(std::shared_ptr<monkey_person> mp)
  186. {
  187. m_monkeyPerson = mp;
  188. }
  189. ~person(){}
  190. private:
  191. void on_timer()
  192. {
  193. YA::_CARD_POS_ cp;
  194. point pt = getSmoothPoint();
  195. const auto lm = m_area_tool->getLandmark();
  196. cp.enter_area_time = std::get<0>(lm);
  197. cp.rec_time = std::get<1>(lm);
  198. cp.map_id = std::get<2>(lm);
  199. cp.area_id = std::get<3>(lm);
  200. cp.landmark_id = std::get<4>(lm);
  201. cp.lm_direction = std::get<5>(lm);
  202. cp.landmark_dis=std::get<6>(lm);
  203. upt_card_pos(cp,pt);
  204. }
  205. point getSmoothPoint()
  206. {
  207. point pt;
  208. loc_point lp = m_smo_tool->smooth_strategy();
  209. m_speed = lp.m_speed;
  210. m_stat = lp.m_stat;
  211. pt.x = lp.x;
  212. pt.y = -lp.y;
  213. if(auto p = m_monkeyPerson.lock() )
  214. {
  215. if(p->is_on_bus())
  216. {
  217. m_stat = 7;
  218. pt = p->getPoint();
  219. }
  220. }
  221. return pt;
  222. }
  223. };
  224. struct car:card_location_base,private card_area
  225. {
  226. car(std::string type,uint32_t cardid,uint16_t needdisplay,int16_t t,int32_t deptid)
  227. :card_location_base(type,cardid,needdisplay,t,deptid)
  228. {
  229. m_message_handle=new card_message_handle(this);
  230. }
  231. virtual void do_business(const point &pt)
  232. {
  233. m_area_tool->on_point(m_id,pt,m_speed,m_type);
  234. }
  235. void set(ev::dynamic_loop * loop)
  236. {
  237. log_info("cardid_id %d",m_id);
  238. m_loop = loop;
  239. m_timer.set(*m_loop);
  240. m_timer.set<car,&car::on_timer>(this);
  241. m_timer.start(1,1);
  242. }
  243. ~car(){}
  244. private:
  245. void on_timer()
  246. {
  247. YA::_CARD_POS_ cp;
  248. point pt = getSmoothPoint();
  249. const auto lm = m_area_tool->getLandmark();
  250. cp.enter_area_time = std::get<0>(lm);
  251. cp.rec_time = std::get<1>(lm);
  252. cp.map_id = std::get<2>(lm);
  253. cp.area_id = std::get<3>(lm);
  254. cp.landmark_id = std::get<4>(lm);
  255. cp.lm_direction = std::get<5>(lm);
  256. cp.landmark_dis=std::get<6>(lm);
  257. //for now
  258. cp.is_on_duty=1;
  259. upt_card_pos(cp,pt);
  260. }
  261. point getSmoothPoint()
  262. {
  263. loc_point lp = m_smo_tool->smooth_strategy();
  264. m_speed = lp.m_speed;
  265. m_stat = lp.m_stat;
  266. lp.y = -lp.y;
  267. return lp;
  268. }
  269. };
  270. loc_tool_main one_ct_message_handle::m_loc_tool;
  271. uint64_t card_list::getId(uint32_t cardid,uint64_t type)
  272. {
  273. return type<<32|cardid;
  274. }
  275. void card_list::init_vehicle()
  276. {
  277. std::unordered_map<uint64_t,std::shared_ptr<card_location_base>> map;
  278. std::string strategy = config.get("person.strategy","car1");
  279. const char *sql = "SELECT ve.vehicle_id, ve.card_id, c.card_type_id, \
  280. ve.dept_id, ve.group_id, v.vehicle_type_id, vt.vehicle_level_id, \
  281. vt.is_railroad AS vt_is_railroad,ve.need_display ,ve.power_alarm,\
  282. vt.vehicle_category_id,v.bigger_car_flag,vc.over_speed \
  283. FROM dat_vehicle_extend ve \
  284. LEFT JOIN dat_vehicle v ON ve.vehicle_id = v.vehicle_id \
  285. LEFT JOIN dat_card c ON ve.card_id = c.card_id \
  286. LEFT JOIN dat_dept d ON ve.dept_id = d.dept_id \
  287. LEFT JOIN dat_group g ON ve.group_id = g.group_id \
  288. LEFT JOIN dat_vehicle_type vt ON v.vehicle_type_id = vt.vehicle_type_id \
  289. LEFT JOIN dat_vehicle_category vc ON vc.vehicle_category_id = vt.vehicle_category_id \
  290. WHERE c.card_type_id = 2 AND c.state_id = 0;";
  291. std::string Error;
  292. YADB::CDBResultSet DBRes;
  293. sDBConnPool.Query(sql,DBRes,Error);
  294. int nCount = DBRes.GetRecordCount( Error );
  295. if (nCount > 0)
  296. {
  297. log_info( "init_staffer. The record count=%d\n", nCount );
  298. while ( DBRes.GetNextRecod(Error) )
  299. {
  300. unsigned int vehicle_id = 0;
  301. DBRes.GetField( "vehicle_id",vehicle_id, Error );
  302. std::string card_id;
  303. DBRes.GetField( "card_id",card_id, Error );
  304. uint32_t vsid = atoi(card_id.substr(3).c_str());
  305. unsigned int card_type_id = 0;
  306. DBRes.GetField( "card_type_id",card_type_id, Error );
  307. int dept_id = 0;
  308. DBRes.GetField( "dept_id",dept_id, Error );
  309. int group_id = 0;
  310. DBRes.GetField( "group_id",group_id, Error );
  311. int vehicle_type_id = 0;
  312. DBRes.GetField( "vehicle_type_id",vehicle_type_id, Error );
  313. int vehicle_level_id = 0;
  314. DBRes.GetField( "vehicle_level_id",vehicle_level_id, Error );
  315. int need_display = 0;
  316. DBRes.GetField( "need_display",need_display, Error );
  317. int power_alarm = 0;
  318. DBRes.GetField( "power_alarm",power_alarm, Error );
  319. int vehicle_category_id = 0;
  320. DBRes.GetField( "vehicle_category_id",vehicle_category_id, Error );
  321. int bigger_car_flag= 0;
  322. DBRes.GetField( "bigger_car_flag",bigger_car_flag, Error );
  323. double over_speed= 0;
  324. DBRes.GetField( "over_speed",over_speed, Error );
  325. //for now
  326. vehicle_id = vsid;
  327. std::shared_ptr<card_location_base> clb = std::make_shared<car>(strategy,vehicle_id,need_display,card_type_id,dept_id);
  328. uint64_t cardid = getId(vehicle_id,2);
  329. log_info("cardId:%llu,vehicle_id:%d dept_id:%d,need_display:%d---cardid:%s",cardid,vehicle_id,dept_id,need_display,card_id.c_str());
  330. map.insert({cardid,clb});
  331. }
  332. }
  333. card_list::instance()->add(map);
  334. }
  335. void card_list::init_staffer()
  336. {
  337. std::unordered_map<uint64_t,std::shared_ptr<card_location_base>> map;
  338. std::string strategy = config.get("person.strategy","person1");
  339. const char *sql = "SELECT staff_id, s.card_id, c.card_type_id, s.dept_id, s.group_id, s.occupation_id, \
  340. ol.occupation_level_id,s.worktype_id,s.need_display \
  341. FROM dat_staff_extend s \
  342. LEFT JOIN dat_card c ON s.card_id = c.card_id \
  343. LEFT JOIN dat_occupation o ON s.occupation_id = o.occupation_id \
  344. LEFT JOIN dat_occupation_level ol ON ol.occupation_level_id = o.occupation_level_id \
  345. WHERE c.card_type_id = 1 AND s.duty_id = 0 AND c.state_id = 0;";
  346. std::string Error;
  347. YADB::CDBResultSet DBRes;
  348. sDBConnPool.Query(sql,DBRes,Error);
  349. int nCount = DBRes.GetRecordCount( Error );
  350. if (nCount > 0)
  351. {
  352. log_info( "init_staffer. The record count=%d\n", nCount );
  353. while ( DBRes.GetNextRecod(Error) )
  354. {
  355. unsigned int staff_id = 0;
  356. DBRes.GetField( "staff_id",staff_id, Error );
  357. std::string card_id;
  358. DBRes.GetField( "card_id",card_id, Error );
  359. uint32_t vsid = atoi(card_id.substr(3).c_str());
  360. unsigned int card_type_id = 0;
  361. DBRes.GetField( "card_type_id",card_type_id, Error );
  362. int dept_id = 0;
  363. DBRes.GetField( "dept_id",dept_id, Error );
  364. int group_id = 0;
  365. DBRes.GetField( "group_id",group_id, Error );
  366. int occupation_id = 0;
  367. DBRes.GetField( "occupation_id",occupation_id, Error );
  368. int occupation_level_id = 0;
  369. DBRes.GetField( "occupation_level_id",occupation_level_id, Error );
  370. int need_display = 0;
  371. DBRes.GetField( "need_display",need_display, Error );
  372. //for now;
  373. staff_id = vsid;
  374. std::shared_ptr<card_location_base> clb = std::make_shared<person>(strategy,staff_id,need_display,card_type_id,dept_id);
  375. uint64_t cardid = getId(staff_id,1);
  376. log_info("cardId:%llu,staff_id:%d dept_id:%d,need_display:%d--c-ard:%s",cardid,staff_id,dept_id,need_display,card_id.c_str());
  377. map.insert({cardid,clb});
  378. }
  379. }
  380. card_list::instance()->add(map);
  381. }
  382. void card_list::init_card_from_db()
  383. {
  384. init_staffer();
  385. init_vehicle();
  386. }
  387. void card_list::on_message(zloop<task*> *loop,const message_locinfo&loc,bool is_history)
  388. {
  389. //std::shared_ptr<card_location_base>c=get(loc.m_card_id);
  390. uint64_t cardid = getId(loc.m_card_id,loc.m_card_type);
  391. const auto c=get(cardid);
  392. if(c==nullptr)
  393. {
  394. log_warn("数据库中未定义该卡的信息,card_id=%d", loc.m_card_id);
  395. return;
  396. }
  397. log_info("card message:site=%d,ant=%d,card=%d,tof=%lld,rav=%02X,acc=%02X,rssi=%d,stamp=%llu",
  398. loc.m_site_id,loc.m_ant_id,loc.m_card_id,loc.m_tof,loc.m_rav,loc.m_acc,loc.m_rssi,loc.m_time_stamp);
  399. c->on_message(loop,loc,is_history);
  400. }
  401. //-----------------card_location_base..
  402. card_location_base::card_location_base(std::string type,uint32_t id,uint16_t dis,int16_t t,int32_t deptid)
  403. :card(id,dis,t,deptid)
  404. {
  405. select_tool_manage::instance()->create_tool(type,m_sel_tool,m_smo_tool);
  406. }
  407. void card_location_base::on_location(const std::vector<point>&vp,const std::vector<loc_message> &lm )
  408. {
  409. //ct timestamp;
  410. m_ct = lm[0].m_card_ct;
  411. m_time = lm[0].m_loc_time;
  412. loc_point pt = m_sel_tool->select_solution(vp,lm);
  413. pt.y=-pt.y;
  414. if(pt.m_useless)
  415. {
  416. x = pt.x;
  417. y = pt.y;
  418. log_info("card_id:%d,ct:%d,timestamp:%llu, loc_point,x:%.2f,y:%.2f ",m_id,m_ct,m_time,pt.x,pt.y);
  419. do_business(pt);
  420. }
  421. }
  422. void card_location_base::on_message(zloop<task*> * loop,const message_locinfo&loc,bool is_history)
  423. {
  424. if(m_loop == nullptr && loop != nullptr)
  425. set(loop);
  426. m_message_handle->on_message(loop,loc,is_history);
  427. }
  428. void card_location_base::upt_card_pos(YA::_CARD_POS_ &cp,const point &pt)
  429. {
  430. cp.x = pt.x;
  431. cp.y = pt.y;
  432. cp.z = pt.z;
  433. cp.Type=m_type;
  434. cp.ID = m_id;
  435. cp.speed = abs(ceil(m_speed));
  436. cp.running_stat = m_stat;
  437. cp.dept_id = m_deptid;
  438. cp.display=m_display;
  439. swsTimerThrd.upt_card_pos(cp);
  440. }
  441. card_location_base::~card_location_base()
  442. {
  443. }
  444. template<> std::shared_ptr<card_list>
  445. single_base<card_list, uint64_t, std::shared_ptr<card_location_base>>::m_instance=std::make_shared<card_list>();