area.cpp 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585
  1. #include <memory>
  2. #include <write-copy.h>
  3. #include "db_api/CDBSingletonDefine.h"
  4. #include "log.h"
  5. #include <area.h>
  6. #include "point.h"
  7. #include "tool_time.h"
  8. #include "common_tool.h"
  9. #include "db_tool.h"
  10. #include "monkey_car/monkeycar_area.h"
  11. #include "landmark.h"
  12. #include "area_business.h"
  13. #include <boost/algorithm/string/split.hpp>
  14. #include <boost/algorithm/string/classification.hpp>
  15. #include "area_business.h"
  16. #include "site_area.h"
  17. #include "card.h"
  18. #include "tool_time.h"
  19. #include "websocket/ws_common.h"
  20. #include "websocket/wsClientMgr.h"
  21. #include "ant.h"
  22. //template<> std::shared_ptr<area_list> single_base<area_list, int, std::shared_ptr<area>>::m_instance=std::make_shared<area_list>();
  23. struct underground_area:area
  24. {
  25. underground_area(int id,int limit_count_person, int limit_time_person,double scale,int32_t mapid,int32_t type)
  26. :area(id,limit_count_person,limit_time_person,scale,mapid,type)
  27. {
  28. }
  29. virtual bool in_area(const std::shared_ptr<site>&s,const std::shared_ptr<card_location_base>&c, const point & p,int &sarid)
  30. {
  31. return s&&!s->is_up_site();
  32. }
  33. };
  34. struct special_area:area
  35. {
  36. special_area(int id,int limit_count_person, int limit_time_person,double scale,int32_t mapid,int32_t type)
  37. :area(id,limit_count_person,limit_time_person,scale,mapid,type)
  38. {}
  39. virtual bool in_area(const std::shared_ptr<site>&s,const std::shared_ptr<card_location_base>&c, const point & p,int &sarid)
  40. {
  41. bool f=false;
  42. int id = c->get_area();
  43. if(id == m_id)
  44. {
  45. f=true;
  46. sarid=m_id;
  47. }
  48. return f;
  49. }
  50. //推入特殊区域的是否需要其他信息
  51. virtual void on_enter(const std::shared_ptr<area_hover>&a,const std::shared_ptr<card_location_base>&c)
  52. {
  53. area::on_enter(a, c);
  54. YA::_CARD_POS_ cp;
  55. cp.area_id = m_id;
  56. swsClientMgr.SendSpecialAreaProcess(cp);
  57. }
  58. };
  59. area::area(int id,int limit_count_person, int limit_time_person,double scale,int32_t mapid,int32_t type)
  60. :m_id(id)
  61. ,m_area_type(type)
  62. ,m_limit_person_second(limit_time_person)
  63. ,m_limit_person_count(limit_count_person)
  64. ,m_scale(scale)
  65. ,m_mapid(mapid)
  66. ,m_person_count(0)
  67. ,m_vehicle_count(0)
  68. {
  69. m_area_business_list=area_business::get_instance_list(m_area_type);
  70. m_event_person_count = false;
  71. m_event_vehicle_count = false;
  72. }
  73. void area::on_hover(const std::shared_ptr<area_hover>&a,const std::shared_ptr<card_location_base>&c)
  74. {
  75. a->m_last_time=tool_time::now_to_ms();
  76. a->m_last_point=*c;
  77. for(const auto &i:m_area_business_list)
  78. {
  79. auto &x=a->get_business_data(i->area_business_type());
  80. i->on_hover(a,c,x);
  81. }
  82. }
  83. void area::on_load_his(const std::shared_ptr<area_hover>&a,const std::shared_ptr<card_location_base>&c)
  84. {
  85. a->m_enter_time=tool_time::now_to_ms();
  86. a->m_enter_point=*c;
  87. for(const auto &i:m_area_business_list)
  88. {
  89. auto &x=a->get_business_data(i->area_business_type());
  90. i->on_load_his(a,c,x);
  91. }
  92. }
  93. void area::on_enter(const std::shared_ptr<area_hover>&a,const std::shared_ptr<card_location_base>&c)
  94. {
  95. log_info("on_enter..%d areaId:%d",c->m_id,m_id);
  96. a->m_enter_time=tool_time::now_to_ms();
  97. a->m_enter_point=*c;
  98. for(const auto &i:m_area_business_list)
  99. {
  100. auto &x=a->get_business_data(i->area_business_type());
  101. i->on_enter(a,c,x);
  102. }
  103. }
  104. void area::on_load_his(const std::shared_ptr<area_hover>&a,const std::shared_ptr<card_location_base>&c)
  105. {
  106. log_info("on_load_his..%d areaId:%d",c->m_id,m_id);
  107. //a->m_last_time=tool_time::now_to_ms();
  108. a->m_last_point=*c;
  109. for(const auto &i:m_area_business_list)
  110. {
  111. auto &x=a->get_business_data(i->area_business_type());
  112. i->on_load_his(a,c,x);
  113. }
  114. }
  115. void area::on_leave(const std::shared_ptr<area_hover>&a,const std::shared_ptr<card_location_base>&c)
  116. {
  117. log_info("on_leave..%d areaId:%d",c->m_id,m_id);
  118. a->m_last_time=tool_time::now_to_ms();
  119. a->m_last_point=*c;
  120. for(const auto &i:m_area_business_list)
  121. {
  122. auto &x=a->get_business_data(i->area_business_type());
  123. i->on_leave(a,c,x);
  124. }
  125. }
  126. bool area::in_area(const std::shared_ptr<site>&s,const std::shared_ptr<card_location_base>&c, const point & p,int & sarid)
  127. {
  128. if(m_bound.empty())
  129. return false;
  130. int counter = 0;
  131. double xinters;
  132. point p1,p2;
  133. p1 = m_bound[0];
  134. int size = m_bound.size();
  135. for (int i=1;i<= size;i++) {
  136. p2 = m_bound[i%size];
  137. if (p.y > std::min(p1.y,p2.y)) {
  138. if (p.y <= std::max(p1.y,p2.y)) {
  139. if (p.x <= std::max(p1.x,p2.x)) {
  140. if (p1.y != p2.y) {
  141. xinters = (p.y-p1.y)*(p2.x-p1.x)/(p2.y-p1.y)+p1.x;
  142. if (p1.x == p2.x || p.x <= xinters)
  143. counter++;
  144. }
  145. }
  146. }
  147. }
  148. p1 = p2;
  149. }
  150. return (counter % 2 == 0) ? false : true;
  151. }
  152. area_list::area_list()
  153. {
  154. }
  155. void area_list::init_monkeycar_area(int id)
  156. {
  157. std::string sql = "SELECT a.area_id, a.name, a.map_id, a.area_type_id, a.path, c.scale,\
  158. over_count_person, over_count_vehicle, over_time_person, over_time_vehicle,\
  159. over_speed_vehicle, is_attendance ,b.monkeycar_coordinate,b.monkeycar_speed,a.business_type \
  160. FROM dat_area a ,dat_monkeycar_base_info b ,dat_map c\
  161. where a.area_id = b.monkeycar_base_info_id and a.map_id = c.map_id";
  162. if(-1 == id)
  163. {
  164. sql.append(";");
  165. }
  166. else
  167. {
  168. sql.append(" AND a.area_id=");
  169. sql.append(std::to_string(id));
  170. sql.append(";");
  171. log_info("基础数据 monkeycar area 增加或修改区域 sql=%s", sql.c_str());
  172. }
  173. std::string Error;
  174. YADB::CDBResultSet DBRes;
  175. sDBConnPool.Query(sql.c_str(),DBRes,Error);
  176. int nCount = DBRes.GetRecordCount( Error );
  177. if (nCount < 1)
  178. {
  179. log_error("基础数据 monkeycar area 增加或修改失败,数据库中找不到: area_id=%d", id);
  180. return ;
  181. }
  182. std::unordered_map<int,std::shared_ptr<area>> map;
  183. while ( DBRes.GetNextRecod(Error) )
  184. {
  185. int area_id = 0;
  186. DBRes.GetField( "area_id",area_id, Error );
  187. int map_id = 0;
  188. DBRes.GetField( "map_id",map_id, Error );
  189. unsigned int area_type_id = 0;
  190. DBRes.GetField( "area_type_id",area_type_id, Error );
  191. int over_count_person = 0;
  192. DBRes.GetField( "over_count_person",over_count_person, Error );
  193. int over_count_vehicle = 0;
  194. DBRes.GetField( "over_count_vehicle",over_count_vehicle, Error );
  195. int over_time_person = 0;
  196. DBRes.GetField( "over_time_person",over_time_person, Error );
  197. int over_time_vehicle = 0;
  198. DBRes.GetField( "over_time_vehicle",over_time_vehicle, Error );
  199. std::string path;
  200. DBRes.GetField( "path",path, Error );
  201. double monkeycar_speed = 0;
  202. DBRes.GetField( "monkeycar_speed",monkeycar_speed, Error );
  203. std::string monkeycar_coor;
  204. DBRes.GetField( "monkeycar_coordinate",monkeycar_coor, Error );
  205. double scale=0;
  206. DBRes.GetField( "scale",scale, Error );
  207. uint32_t b_type =0;
  208. DBRes.GetField( "business_type",b_type, Error );
  209. log_info("monkeycar area init_area : id:%d,path:%s",area_id, path.c_str());
  210. if(-1 == id)
  211. {
  212. std::shared_ptr<db_area> da = std::make_shared<db_area>();
  213. da->m_default_speed = monkeycar_speed;
  214. da->m_point = init_path(monkeycar_coor);
  215. std::shared_ptr<area> ap = std::make_shared<monkey_area>(da,area_id,over_count_person, over_time_person,scale,map_id,b_type);
  216. ap->update(over_count_person, over_time_person,scale,map_id,area_type_id, over_count_vehicle,over_time_vehicle);
  217. ap->m_bound=init_path(path);
  218. for(const auto &p : ap->m_bound)
  219. log_info("point:monkey:area_id:%d--x:%.2f,y:%.2f",area_id,p.x,p.y);
  220. for(const auto &p : da->m_point)
  221. log_info("point:monkey_coor:area_id:%d--x:%.2f,y:%.2f",area_id,p.x,p.y);
  222. map.insert({area_id,ap});
  223. }
  224. else
  225. {
  226. //这里后续需要把猴车得信息传递过去
  227. std::shared_ptr<db_area> da = std::make_shared<db_area>();
  228. da->m_default_speed = monkeycar_speed;
  229. da->m_point = init_path(monkeycar_coor);
  230. std::shared_ptr<area> ap = std::make_shared<monkey_area>(da,area_id,over_count_person, over_time_person,scale,map_id,b_type);
  231. if(auto area_=area_list::instance()->get(id))
  232. area_=ap;
  233. else
  234. area_list::instance()->add(area_id,ap);
  235. ap->m_bound=init_path(path);
  236. ap->update(over_count_person, over_time_person,scale,map_id,area_type_id, over_count_vehicle,over_time_vehicle);
  237. for(const auto &p : ap->m_bound)
  238. log_info("point:monkey:area_id:%d--x:%.2f,y:%.2f",area_id,p.x,p.y);
  239. for(const auto &p : da->m_point)
  240. log_info("point:monkey_coor:area_id:%d--x:%.2f,y:%.2f",area_id,p.x,p.y);
  241. log_info("基础数据 monkeycar area增加或修改区域成功:区域id:%d,over_count_person:%d over_time_person:%d,\
  242. scale:%.2f,map_id:%d,area_type_id:%d,over_count_vehicle:%d,over_time_vehicle:%d",
  243. id,over_count_person, over_time_person,scale,map_id,area_type_id,
  244. over_count_vehicle,over_time_vehicle);
  245. }
  246. }
  247. if(-1 == id)
  248. {
  249. log_info( "monkeycar area init_area. The record count=%d\n", nCount );
  250. area_list::instance()->add(map);
  251. }
  252. }
  253. std::shared_ptr<area> area_list::create(int type,int id,int limit_count_person, int limit_time_person,double scale,int32_t mapid,int32_t b_type)
  254. {
  255. if(type==AREA_TYPE_FORBIDDEN)
  256. {
  257. return std::make_shared<special_area>(id,limit_count_person,limit_time_person,scale,mapid,b_type);
  258. }
  259. else if(type == AREA_TYPE_DOWNMINE)
  260. {
  261. return std::make_shared<underground_area>(id,limit_count_person,limit_time_person,scale,mapid,b_type);
  262. }
  263. else
  264. {
  265. return std::make_shared<area>(id,limit_count_person,limit_time_person,scale,mapid,b_type);
  266. }
  267. }
  268. void area_list::init_from_db(int id/*=-1*/)
  269. {
  270. std::string sql = "SELECT a.area_id, a.name, a.map_id, a.area_type_id, a.path,b.scale, \
  271. over_count_person, over_count_vehicle, over_time_person, over_time_vehicle, \
  272. over_speed_vehicle, is_attendance,business_type, a.is_work_area\
  273. FROM dat_area a,dat_map b\
  274. where a.map_id = b.map_id and area_id not in \
  275. (select monkeycar_base_info_id from dat_monkeycar_base_info)";
  276. if(-1 == id)
  277. {
  278. sql.append(";");
  279. }
  280. else
  281. {
  282. sql.append(" AND s.area_id=");
  283. sql.append(std::to_string(id));
  284. sql.append(";");
  285. log_info("基础数据 增加或修改区域 sql=%s", sql.c_str());
  286. }
  287. std::string Error;
  288. YADB::CDBResultSet DBRes;
  289. sDBConnPool.Query(sql.c_str(),DBRes,Error);
  290. int nCount = DBRes.GetRecordCount( Error );
  291. if (nCount < 1)
  292. {
  293. log_error("基础数据 增加或修改失败,数据库中找不到: area_id=%d:%s", id,sql.c_str());
  294. return ;
  295. }
  296. std::unordered_map<int,std::shared_ptr<area>> map;
  297. while ( DBRes.GetNextRecod(Error) )
  298. {
  299. int area_id = 0;
  300. DBRes.GetField( "area_id",area_id, Error );
  301. int map_id = 0;
  302. DBRes.GetField( "map_id",map_id, Error );
  303. unsigned int area_type_id = 0;
  304. DBRes.GetField( "area_type_id",area_type_id, Error );
  305. int over_count_person = 0;
  306. DBRes.GetField( "over_count_person",over_count_person, Error );
  307. int over_count_vehicle = 0;
  308. DBRes.GetField( "over_count_vehicle",over_count_vehicle, Error );
  309. int over_time_person = 0;
  310. DBRes.GetField( "over_time_person",over_time_person, Error );
  311. int over_time_vehicle = 0;
  312. DBRes.GetField( "over_time_vehicle",over_time_vehicle, Error );
  313. double over_speed_vehicle=0;
  314. DBRes.GetField( "over_speed_vehicle",over_speed_vehicle, Error );
  315. std::string path;
  316. DBRes.GetField( "path",path, Error );
  317. double scale = 0;
  318. DBRes.GetField( "scale",scale, Error );
  319. uint32_t b_type =0;
  320. DBRes.GetField( "business_type",b_type, Error );
  321. int is_work_area = 0;
  322. DBRes.GetField( "is_work_area",is_work_area, Error );
  323. log_info("init_area : id:%d,path:%s",area_id, path.c_str());
  324. if(-1 == id)
  325. {
  326. std::shared_ptr<area> ap = create(area_type_id,area_id,over_count_person,over_time_person, scale,map_id,b_type);
  327. ap->m_limit_vehicle_second = over_time_vehicle;
  328. ap->m_limit_vehicle_count = over_count_vehicle;
  329. ap->m_over_speed_vehicle = over_speed_vehicle;
  330. ap->m_is_work_area = is_work_area;
  331. ap->m_bound=init_path(path);
  332. for(const auto &p : ap->m_bound)
  333. log_info("point:area_id:%d--x:%.2f,y:%.2f",area_id,p.x,p.y);
  334. map.insert({area_id,ap});
  335. }
  336. else
  337. {
  338. auto tmp_ptr = area_list::instance()->get(id);
  339. if(!tmp_ptr)
  340. {
  341. tmp_ptr = create(area_type_id,area_id,over_count_person,over_time_person, scale,map_id,b_type);
  342. area_list::instance()->add(id, tmp_ptr);
  343. }
  344. tmp_ptr->update(over_count_person, over_time_person,scale,map_id,area_type_id, over_count_vehicle,over_time_vehicle);
  345. tmp_ptr->m_bound=init_path(path);
  346. tmp_ptr->m_over_speed_vehicle = over_speed_vehicle;
  347. tmp_ptr->m_is_work_area = is_work_area;
  348. for(const auto &p : tmp_ptr->m_bound)
  349. log_info("point:area_id:%d--x:%.2f,y:%.2f",area_id,p.x,p.y);
  350. log_info("基础数据 增加或修改区域成功:区域id:%d,over_count_person:%d over_time_person:%d,scale:%.2f,map_id:%d\
  351. ,area_type_id:%d,over_count_vehicle:%d,over_time_vehicle:%d",
  352. id,over_count_person, over_time_person,scale,map_id,area_type_id,
  353. over_count_vehicle,over_time_vehicle);
  354. }
  355. }
  356. if(-1 == id)
  357. {
  358. log_info( "init_area. The record count=%d\n", nCount );
  359. area_list::instance()->add(map);
  360. }
  361. init_monkeycar_area(id);
  362. }
  363. std::vector<point> area_list::init_path(std::string &str)
  364. {
  365. if(str.empty())
  366. log_error("area path empty()...");
  367. std::vector<point> vp;
  368. std::vector<std::string> vs;
  369. std::vector<std::string> vs1;
  370. boost::split(vs,str,boost::is_any_of("ML ;"));
  371. for(auto & s:vs)
  372. {
  373. if(s.empty())
  374. continue;
  375. boost::split(vs1,s,boost::is_any_of(","));
  376. if(vs1.size()!=2)
  377. log_error("area path data Error.pls check data table.");
  378. vp.emplace_back(atof(vs1[0].c_str()),atof(vs1[1].c_str()));
  379. }
  380. return std::move(vp);
  381. }
  382. std::vector<std::shared_ptr<area>> area_list::get_area(const std::shared_ptr<site> s,const std::shared_ptr<card_location_base> &c,const point&pt,int & sarid)
  383. {
  384. std::vector<std::shared_ptr<area>> ret;
  385. auto map = area_list::instance()->m_map;
  386. for(const auto &a:map)
  387. if(a.second->in_area(s,c,pt,sarid))
  388. ret.push_back(a.second);
  389. if(s)
  390. ret.push_back(s->get_area());
  391. //区域覆盖不完全地图,很多车辆人行驶在地图外,如何确认.
  392. return std::move(ret);
  393. }
  394. area_hover::area_hover(std::shared_ptr<area>&area,const point&pt)
  395. :m_area(area)
  396. {
  397. m_enter_time=m_last_time=tool_time::now_to_ms();
  398. m_enter_point=m_last_point=pt;
  399. }
  400. void area_tool::on_point(const std::shared_ptr<site>&s,const std::shared_ptr<card_location_base>& c,const point&pt)
  401. {
  402. if (nullptr == s || nullptr == c)
  403. {
  404. return;
  405. }
  406. log_info("on_point...cardid:%d,type:%d",c->m_id,c->m_type);
  407. int special_area=-1;
  408. std::vector<std::shared_ptr<area>> areas=area_list::instance()->get_area(s,c, pt,special_area);
  409. if(special_area != -1)
  410. {
  411. areas.clear();
  412. auto area_=area_list::instance()->get(special_area);
  413. areas.push_back(area_);
  414. }
  415. else
  416. std::sort(areas.begin(),areas.end(),[](const std::shared_ptr<area>&l,const std::shared_ptr<area>&r){
  417. return l->id()<r->id();
  418. });
  419. auto c1=m_hover_list.begin(),ce=m_hover_list.end();
  420. auto a1=areas.begin() ,ae=areas.end();
  421. std::vector<std::shared_ptr<area_hover>> nlist;
  422. while (c1!=ce && a1!=ae)
  423. {
  424. if ((*c1)->id()<(*a1)->id())
  425. {
  426. (*c1)->m_area->on_leave(*c1, c);
  427. ++c1;
  428. }
  429. else if ((*a1)->id()<(*c1)->id())
  430. {
  431. nlist.push_back(std::make_shared<area_hover>(*a1,pt));
  432. (*a1)->on_enter(nlist.back(),c);
  433. ++a1;
  434. }
  435. else
  436. {
  437. nlist.push_back(*c1);
  438. (*c1)->m_area->on_hover(*c1,c);
  439. ++c1,++a1;
  440. }
  441. }
  442. while(c1!=ce)
  443. {
  444. (*c1)->m_area->on_leave(*c1, c);
  445. ++c1;
  446. }
  447. while(a1!=ae)
  448. {
  449. nlist.push_back(std::make_shared<area_hover>(*a1,pt));
  450. (*a1)->on_enter(nlist.back(),c);
  451. ++a1;
  452. }
  453. m_hover_list=std::move(nlist);
  454. //更新到数据库
  455. std::string strAreaInfo = "";
  456. for (std::vector<std::shared_ptr<area_hover>>::iterator itvec = m_hover_list.begin(); itvec != m_hover_list.end(); ++itvec)
  457. {
  458. if ((*itvec)->id() >= 0)
  459. {
  460. char tmpArea[128] = {0};
  461. snprintf(tmpArea, 128, "%d,%lu|", (*itvec)->id(), (*itvec)->m_enter_time);
  462. strAreaInfo += tmpArea;
  463. }
  464. }
  465. char sql[1024] = {0};
  466. snprintf(sql, 1024, "REPLACE INTO rt_location (card_id, site_id, x, y, z, state, area_info) VALUES (%lu, %d, %lf, %lf, %lf, 0, '%s');",
  467. tool_other::type_id_to_u64(c->m_type, c->m_id), s->id(), pt.x, pt.y, pt.z, strAreaInfo.c_str());
  468. db_tool::PushAsync(sql);
  469. }
  470. void area_tool::on_leave(const std::shared_ptr<card_location_base>& c)
  471. {
  472. for(auto& t:m_hover_list)
  473. {
  474. t->m_area->on_leave(t, c);
  475. }
  476. }
  477. void area_tool::set_area_info(int mapid,double scale,int areaid,const point &pt,uint64_t t,int type)
  478. {
  479. if(0==type)
  480. {
  481. m_mapid = mapid;
  482. m_scale=scale;
  483. set_area_info(mapid,areaid,pt,t);
  484. }
  485. else if(1==type)
  486. {
  487. set_area_info(mapid,areaid,pt,t);
  488. }
  489. else if(2==type)
  490. {
  491. auto it =m_area_info.find(areaid);
  492. if(it != m_area_info.end())
  493. m_area_info.erase(it);
  494. }
  495. else
  496. {
  497. log_info("wrong type..");
  498. }
  499. }
  500. void area_tool::set_area_info(int mapid,int areaid,const point &pt,uint64_t t)
  501. {
  502. auto lm = Landmark_list::instance()->get(mapid,areaid,pt);
  503. int landmark_id = std::get<0>(lm);
  504. int landmark_dir = std::get<1>(lm);
  505. double landmark_dis = std::get<2>(lm)*m_scale;
  506. log_info("landmark:%d %d %.2f,(%.2f,%.2f),%f",landmark_id,landmark_dir,landmark_dis,pt.x,pt.y,m_scale);
  507. std::tuple<int,int,int,double,uint64_t> tinfo=std::make_tuple(areaid,landmark_id,landmark_dir,landmark_dis,t);
  508. m_area_info[areaid].swap(tinfo);
  509. }