area.cpp 15 KB

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