1
0

card.cpp 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522
  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. virtual void do_business(const point &pt)
  167. {
  168. //区域
  169. m_area_tool->on_point(m_id,pt,m_speed,m_type);
  170. //考勤
  171. //
  172. }
  173. void set(ev::dynamic_loop * loop)
  174. {
  175. log_info("cardid_id %d",m_id);
  176. m_loop = loop;
  177. m_timer.set(*m_loop);
  178. m_timer.set<person,&person::on_timer>(this);
  179. m_timer.start(1,1);
  180. }
  181. void reset(std::shared_ptr<monkey_person> mp)
  182. {
  183. m_monkeyPerson = mp;
  184. }
  185. ~person(){}
  186. private:
  187. void on_timer()
  188. {
  189. YA::_CARD_POS_ cp;
  190. point pt = getSmoothPoint();
  191. const auto lm = m_area_tool->getLandmark();
  192. cp.enter_area_time = std::get<0>(lm);
  193. cp.rec_time = std::get<1>(lm);
  194. cp.map_id = std::get<2>(lm);
  195. cp.area_id = std::get<3>(lm);
  196. cp.landmark_id = std::get<4>(lm);
  197. cp.lm_direction = std::get<5>(lm);
  198. cp.landmark_dis=std::get<6>(lm);
  199. upt_card_pos(cp,pt);
  200. }
  201. point getSmoothPoint()
  202. {
  203. point pt;
  204. loc_point lp = m_smo_tool->smooth_strategy();
  205. m_speed = lp.m_speed;
  206. m_stat = lp.m_stat;
  207. pt.x = lp.x;
  208. pt.y = -lp.y;
  209. if(auto p = m_monkeyPerson.lock() )
  210. {
  211. if(p->is_on_bus())
  212. {
  213. m_stat = 7;
  214. pt = p->getPoint();
  215. }
  216. }
  217. return pt;
  218. }
  219. };
  220. struct car:card_location_base,private card_area
  221. {
  222. car(std::string type,uint32_t cardid,uint16_t needdisplay,int16_t t,int32_t deptid)
  223. :card_location_base(type,cardid,needdisplay,t,deptid)
  224. {
  225. m_message_handle=new card_message_handle(this);
  226. }
  227. virtual void do_business(const point &pt)
  228. {
  229. m_area_tool->on_point(m_id,pt,m_speed,m_type);
  230. }
  231. void set(ev::dynamic_loop * loop)
  232. {
  233. log_info("cardid_id %d",m_id);
  234. m_loop = loop;
  235. m_timer.set(*m_loop);
  236. m_timer.set<car,&car::on_timer>(this);
  237. m_timer.start(1,1);
  238. }
  239. ~car(){}
  240. private:
  241. void on_timer()
  242. {
  243. YA::_CARD_POS_ cp;
  244. point pt = getSmoothPoint();
  245. const auto lm = m_area_tool->getLandmark();
  246. cp.enter_area_time = std::get<0>(lm);
  247. cp.rec_time = std::get<1>(lm);
  248. cp.map_id = std::get<2>(lm);
  249. cp.area_id = std::get<3>(lm);
  250. cp.landmark_id = std::get<4>(lm);
  251. cp.lm_direction = std::get<5>(lm);
  252. cp.landmark_dis=std::get<6>(lm);
  253. //for now
  254. cp.is_on_duty=1;
  255. upt_card_pos(cp,pt);
  256. }
  257. point getSmoothPoint()
  258. {
  259. loc_point lp = m_smo_tool->smooth_strategy();
  260. m_speed = lp.m_speed;
  261. m_stat = lp.m_stat;
  262. lp.y = -lp.y;
  263. return lp;
  264. }
  265. };
  266. loc_tool_main one_ct_message_handle::m_loc_tool;
  267. uint64_t card_list::getId(uint32_t cardid,uint64_t type)
  268. {
  269. return type<<32|cardid;
  270. }
  271. void card_list::init_vehicle()
  272. {
  273. std::unordered_map<uint64_t,std::shared_ptr<card_location_base>> map;
  274. std::string strategy = config.get("person.strategy","car1");
  275. const char *sql = "SELECT ve.vehicle_id, ve.card_id, c.card_type_id, \
  276. ve.dept_id, ve.group_id, v.vehicle_type_id, vt.vehicle_level_id, \
  277. vt.is_railroad AS vt_is_railroad,ve.need_display ,ve.power_alarm,\
  278. vt.vehicle_category_id,v.bigger_car_flag,vc.over_speed \
  279. FROM dat_vehicle_extend ve \
  280. LEFT JOIN dat_vehicle v ON ve.vehicle_id = v.vehicle_id \
  281. LEFT JOIN dat_card c ON ve.card_id = c.card_id \
  282. LEFT JOIN dat_dept d ON ve.dept_id = d.dept_id \
  283. LEFT JOIN dat_group g ON ve.group_id = g.group_id \
  284. LEFT JOIN dat_vehicle_type vt ON v.vehicle_type_id = vt.vehicle_type_id \
  285. LEFT JOIN dat_vehicle_category vc ON vc.vehicle_category_id = vt.vehicle_category_id \
  286. WHERE c.card_type_id = 2 AND c.state_id = 0;";
  287. std::string Error;
  288. YADB::CDBResultSet DBRes;
  289. sDBConnPool.Query(sql,DBRes,Error);
  290. int nCount = DBRes.GetRecordCount( Error );
  291. if (nCount > 0)
  292. {
  293. log_info( "init_staffer. The record count=%d\n", nCount );
  294. while ( DBRes.GetNextRecod(Error) )
  295. {
  296. unsigned int vehicle_id = 0;
  297. DBRes.GetField( "vehicle_id",vehicle_id, Error );
  298. std::string card_id;
  299. DBRes.GetField( "card_id",card_id, Error );
  300. uint32_t vsid = atoi(card_id.substr(3).c_str());
  301. unsigned int card_type_id = 0;
  302. DBRes.GetField( "card_type_id",card_type_id, Error );
  303. int dept_id = 0;
  304. DBRes.GetField( "dept_id",dept_id, Error );
  305. int group_id = 0;
  306. DBRes.GetField( "group_id",group_id, Error );
  307. int vehicle_type_id = 0;
  308. DBRes.GetField( "vehicle_type_id",vehicle_type_id, Error );
  309. int vehicle_level_id = 0;
  310. DBRes.GetField( "vehicle_level_id",vehicle_level_id, Error );
  311. int need_display = 0;
  312. DBRes.GetField( "need_display",need_display, Error );
  313. int power_alarm = 0;
  314. DBRes.GetField( "power_alarm",power_alarm, Error );
  315. int vehicle_category_id = 0;
  316. DBRes.GetField( "vehicle_category_id",vehicle_category_id, Error );
  317. int bigger_car_flag= 0;
  318. DBRes.GetField( "bigger_car_flag",bigger_car_flag, Error );
  319. double over_speed= 0;
  320. DBRes.GetField( "over_speed",over_speed, Error );
  321. //for now
  322. vehicle_id = vsid;
  323. std::shared_ptr<card_location_base> clb = std::make_shared<car>(strategy,vehicle_id,need_display,card_type_id,dept_id);
  324. uint64_t cardid = getId(vehicle_id,2);
  325. 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());
  326. map.insert({cardid,clb});
  327. }
  328. }
  329. card_list::instance()->add(map);
  330. }
  331. void card_list::init_staffer()
  332. {
  333. std::unordered_map<uint64_t,std::shared_ptr<card_location_base>> map;
  334. std::string strategy = config.get("person.strategy","person1");
  335. const char *sql = "SELECT staff_id, s.card_id, c.card_type_id, s.dept_id, s.group_id, s.occupation_id, \
  336. ol.occupation_level_id,s.worktype_id,s.need_display \
  337. FROM dat_staff_extend s \
  338. LEFT JOIN dat_card c ON s.card_id = c.card_id \
  339. LEFT JOIN dat_occupation o ON s.occupation_id = o.occupation_id \
  340. LEFT JOIN dat_occupation_level ol ON ol.occupation_level_id = o.occupation_level_id \
  341. WHERE c.card_type_id = 1 AND s.duty_id = 0 AND c.state_id = 0;";
  342. std::string Error;
  343. YADB::CDBResultSet DBRes;
  344. sDBConnPool.Query(sql,DBRes,Error);
  345. int nCount = DBRes.GetRecordCount( Error );
  346. if (nCount > 0)
  347. {
  348. log_info( "init_staffer. The record count=%d\n", nCount );
  349. while ( DBRes.GetNextRecod(Error) )
  350. {
  351. unsigned int staff_id = 0;
  352. DBRes.GetField( "staff_id",staff_id, Error );
  353. std::string card_id;
  354. DBRes.GetField( "card_id",card_id, Error );
  355. uint32_t vsid = atoi(card_id.substr(3).c_str());
  356. unsigned int card_type_id = 0;
  357. DBRes.GetField( "card_type_id",card_type_id, Error );
  358. int dept_id = 0;
  359. DBRes.GetField( "dept_id",dept_id, Error );
  360. int group_id = 0;
  361. DBRes.GetField( "group_id",group_id, Error );
  362. int occupation_id = 0;
  363. DBRes.GetField( "occupation_id",occupation_id, Error );
  364. int occupation_level_id = 0;
  365. DBRes.GetField( "occupation_level_id",occupation_level_id, Error );
  366. int need_display = 0;
  367. DBRes.GetField( "need_display",need_display, Error );
  368. //for now;
  369. staff_id = vsid;
  370. std::shared_ptr<card_location_base> clb = std::make_shared<person>(strategy,staff_id,need_display,card_type_id,dept_id);
  371. uint64_t cardid = getId(staff_id,1);
  372. 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());
  373. map.insert({cardid,clb});
  374. }
  375. }
  376. card_list::instance()->add(map);
  377. }
  378. void card_list::init_card_from_db()
  379. {
  380. init_staffer();
  381. init_vehicle();
  382. }
  383. void card_list::on_message(zloop<task*> *loop,const message_locinfo&loc,bool is_history)
  384. {
  385. //std::shared_ptr<card_location_base>c=get(loc.m_card_id);
  386. uint64_t cardid = getId(loc.m_card_id,loc.m_card_type);
  387. const auto c=get(cardid);
  388. if(c==nullptr)
  389. {
  390. log_warn("数据库中未定义该卡的信息,card_id=%d", loc.m_card_id);
  391. return;
  392. }
  393. log_info("card message:site=%d,ant=%d,card=%d,tof=%lld,rav=%02X,acc=%02X,rssi=%d,stamp=%llu",
  394. 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);
  395. c->on_message(loop,loc,is_history);
  396. }
  397. //-----------------card_location_base..
  398. card_location_base::card_location_base(std::string type,uint32_t id,uint16_t dis,int16_t t,int32_t deptid)
  399. :card(id,dis,t,deptid)
  400. {
  401. select_tool_manage::instance()->create_tool(type,m_sel_tool,m_smo_tool);
  402. }
  403. void card_location_base::on_location(const std::vector<point>&vp,const std::vector<loc_message> &lm )
  404. {
  405. //ct timestamp;
  406. m_ct = lm[0].m_card_ct;
  407. m_time = lm[0].m_loc_time;
  408. loc_point pt = m_sel_tool->select_solution(vp,lm);
  409. pt.y=-pt.y;
  410. if(pt.m_useless)
  411. {
  412. x = pt.x;
  413. y = pt.y;
  414. 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);
  415. do_business(pt);
  416. }
  417. }
  418. void card_location_base::on_message(zloop<task*> * loop,const message_locinfo&loc,bool is_history)
  419. {
  420. if(m_loop == nullptr && loop != nullptr)
  421. set(loop);
  422. m_message_handle->on_message(loop,loc,is_history);
  423. }
  424. void card_location_base::upt_card_pos(YA::_CARD_POS_ &cp,const point &pt)
  425. {
  426. cp.x = pt.x;
  427. cp.y = pt.y;
  428. cp.z = pt.z;
  429. cp.Type=m_type;
  430. cp.ID = m_id;
  431. cp.speed = abs(ceil(m_speed));
  432. cp.running_stat = m_stat;
  433. cp.dept_id = m_deptid;
  434. cp.display=m_display;
  435. swsTimerThrd.upt_card_pos(cp);
  436. }
  437. card_location_base::~card_location_base()
  438. {
  439. if(m_message_handle == nullptr)
  440. delete m_message_handle;
  441. }
  442. template<> std::shared_ptr<card_list>
  443. single_base<card_list, uint64_t, std::shared_ptr<card_location_base>>::m_instance=std::make_shared<card_list>();