mine_business.cpp 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678
  1. #include <cmath>
  2. #include <sstream>
  3. #include <vector>
  4. #include <list>
  5. #include <array>
  6. #include <map>
  7. #include "mine_business.h"
  8. #include "log.h"
  9. #include "point.h"
  10. #include "db/db_api/CDBSingletonDefine.h"
  11. #include "db/db_tool.h"
  12. #include "common_tool.h"
  13. #include "ant.h"
  14. #include "ya_setting.h"
  15. #include "card_path.h"
  16. #include "card.h"
  17. #include "area.h"
  18. #include "event.h"
  19. struct card_sensor
  20. {
  21. card_sensor(int32_t wid,const point &p,const std::string &cid)
  22. :card_id(cid)
  23. ,sid(0)
  24. ,id(wid)
  25. ,bigger(-1),count(0),sum(0),ct(-1),stime(0),flag(false),is_alarm(false)
  26. {
  27. base_point=p;
  28. }
  29. std::string card_id;
  30. int32_t sid;
  31. int32_t id;
  32. std::vector<int> sensorId_list;
  33. point base_point;
  34. std::array<point,2> ant;
  35. int8_t bigger;
  36. uint32_t count,sum;
  37. uint16_t ct;
  38. uint64_t stime;
  39. bool flag,is_alarm;
  40. std::list<double> his_data;
  41. std::array<uint64_t,2> dist;
  42. void clear()
  43. {
  44. count=sum=0;stime=0;flag=false;
  45. }
  46. bool timeout()
  47. {
  48. time_t t=time(NULL);
  49. return flag && t-stime>10*60;
  50. }
  51. bool check_location_reversal(std::string & str)
  52. {
  53. time_t t=time(NULL);
  54. time_t tval= t-stime;
  55. bool f=false;
  56. if (tval !=0 && sum*1.0/tval > 0.8 && count*1.0/sum <0.2)
  57. f=true;
  58. char buf[1024]={0};
  59. sprintf(buf,"[reverse_alarm_checking]%s,count:%d,sum:%d,val:%ld,s:%.2f,v:%.2f,alarm:%d",
  60. card_id.c_str(),count,sum,tval,(sum*1.0/tval),(count*1.0/sum),f);
  61. str=buf;
  62. return f;
  63. }
  64. void make_reverse_condition(int16_t antid,uint16_t ct,double d)
  65. {
  66. dist[antid]=d;
  67. if(this->ct == ct){
  68. sum++;
  69. int b=-1;
  70. if (dist[0]>dist[1]) b=0 ;else b =1;
  71. if(b==bigger) count++; //合格的点
  72. }
  73. this->ct = ct;
  74. }
  75. void set(const point &p0,const point &p1,int id)
  76. {
  77. int8_t b=0;
  78. ant[0].set(p0);ant[1].set(p1);
  79. double d0=base_point.dist(p0);double d1=base_point.dist(p1);
  80. if(d0>d1)b=1;else b=0;
  81. if (bigger!=-1 && b!=bigger){
  82. count=sum=0;stime=time(0);
  83. }
  84. bigger=b;sid=id;
  85. }
  86. bool push(double d){
  87. bool f=true;
  88. his_data.push_back(d);
  89. if (his_data.size()==3){
  90. double da=0;
  91. for (const auto &d:his_data){
  92. if(da>d || d-da<0.004){f=false;break;}
  93. da=d;
  94. }
  95. his_data.pop_front();
  96. }
  97. else f=false;
  98. return f;
  99. }
  100. point &operator[](int i){return ant[i];}
  101. const point &operator[](int i)const {return ant[i];}
  102. void set_true(){flag=true;stime=time(NULL);}
  103. bool warning(){return flag;}
  104. bool empty(){return his_data.empty();}
  105. double back(){return his_data.back();}
  106. void clear_sensor(){clear();}
  107. int reader_id(){return sid;}
  108. void push_back(int32_t sensor_id){sensorId_list.push_back(sensor_id);}
  109. };
  110. struct card_sensor_mgr
  111. {
  112. void push(int32_t wid,int32_t sid,const point &p,const std::string & cardid)
  113. {
  114. std::shared_ptr<card_sensor> cs=nullptr;
  115. auto it=m_mgr.find(wid);
  116. if(it!=m_mgr.end())
  117. cs=it->second;
  118. else
  119. {
  120. cs=std::make_shared<card_sensor>(wid,p,cardid);
  121. m_mgr.insert({wid,cs});
  122. }
  123. cs->push_back(sid);
  124. }
  125. void for_each();
  126. void make_condition(int32_t antid,uint32_t ct,uint64_t tof,uint32_t sid);
  127. std::map<int32_t,std::shared_ptr<card_sensor>> m_mgr;
  128. };
  129. struct staffer_num_business
  130. {
  131. void record_staffer_num();
  132. void fetch_add(bool f)
  133. {
  134. if(f)
  135. m_staff_num++;
  136. m_staff_num_real++;
  137. }
  138. staffer_num_business()
  139. {
  140. reset();
  141. m_record_staffer_timeval = 0;
  142. }
  143. private:
  144. void reset(){m_staff_num=0;m_staff_num_real=0;}
  145. std::atomic<uint32_t> m_staff_num,m_staff_num_real;
  146. std::time_t m_record_staffer_timeval;
  147. };
  148. struct reverse_alarm_business
  149. {
  150. void load_sensor();
  151. void run_sensor();
  152. void make_condition(uint64_t type,uint32_t id,int32_t antid,uint32_t ct,uint64_t tof,uint32_t sid);
  153. private:
  154. std::map<uint64_t,std::shared_ptr<card_sensor_mgr>> m_sensor_mgr;
  155. };
  156. struct rear_end_collision_prevented_business
  157. {
  158. rear_end_collision_prevented_business()
  159. {
  160. _time=0;m_v.clear();
  161. }
  162. void clear(){m_v.clear();}
  163. void put(const std::shared_ptr<card_location_base>&c)
  164. {
  165. m_v.push_back(c);
  166. }
  167. bool rear_end_arg_algo(uint64_t u1,uint64_t u2);
  168. void handle_message();
  169. double get_absolute_distance(uint64_t c1,uint64_t c2);
  170. struct car_data
  171. {
  172. car_data()
  173. :_t(0),_arg(0x12345678)
  174. {}
  175. void push(uint64_t cid,const point &p,uint64_t t)
  176. {
  177. last_p=_p;_p=p;
  178. if (last_p.empty() || _p.empty())
  179. return;
  180. if (_p.dist(last_p)<0.5)
  181. return;
  182. if ( t-_t<5*1000)
  183. {
  184. _arg = std::arg(std::complex<double>(_p.x,_p.y)-std::complex<double>(last_p.x,last_p.y));
  185. line_v l(last_p,_p);_line=l;
  186. std::string card_id = tool_other::get_string_cardid(cid);
  187. log_info("[vehicle_alarm_arg ] %s,arg:%f (%.2f,%.2f)--(%.2f,%.2f)",card_id.c_str(),_arg,last_p.x,last_p.y,p.x,p.y);
  188. }
  189. _t=t;
  190. }
  191. point last_p,_p;
  192. line_v _line;
  193. uint64_t _t;
  194. double _arg;
  195. };
  196. struct vInfo
  197. {
  198. vInfo()
  199. {
  200. is_alarm=false;
  201. real_end_start_time=0;
  202. backfired_start_time=0;
  203. }
  204. void push(const std::string & c1, const std::string &c2)
  205. {
  206. m_cid[0]=c1;
  207. m_cid[1]=c2;
  208. std::sort(m_cid.begin(),m_cid.end());
  209. }
  210. std::string getKey() const
  211. {
  212. return m_cid[0]+"&"+m_cid[1];
  213. }
  214. bool is_alarm;
  215. std::array<std::string,2> m_cid;
  216. time_t real_end_start_time ;
  217. time_t backfired_start_time;
  218. };
  219. void make_arg(uint64_t cid, const point &p,uint64_t t)
  220. {
  221. m_map[cid].push(cid,p,t);
  222. }
  223. private:
  224. bool invalid_card(const std::shared_ptr<card_location_base> &c);
  225. time_t _time;
  226. std::vector<std::shared_ptr<card_location_base>> m_v;
  227. std::map<uint64_t,car_data> m_map;
  228. std::map<std::string,vInfo> m_CloserVehicle;
  229. };
  230. mine_business::mine_business()
  231. {
  232. m_staffer_num_ptr.reset(new staffer_num_business);
  233. m_reverse_alarm_ptr.reset(new reverse_alarm_business);
  234. m_rear_ended_ptr.reset(new rear_end_collision_prevented_business);
  235. }
  236. mine_business* mine_business::inst()
  237. {
  238. static mine_business mb;
  239. return &mb;
  240. }
  241. void mine_business::run_business()
  242. {
  243. record_staffer_num();
  244. handle_reverse_alarm();
  245. handle_rear_end();
  246. }
  247. void mine_business::fetch_add(bool f)
  248. {
  249. m_staffer_num_ptr->fetch_add(f);
  250. }
  251. void mine_business::record_staffer_num()
  252. {
  253. m_staffer_num_ptr->record_staffer_num();
  254. }
  255. void mine_business::load()
  256. {
  257. m_reverse_alarm_ptr->load_sensor();
  258. }
  259. void mine_business::handle_reverse_alarm()
  260. {
  261. m_reverse_alarm_ptr->run_sensor();
  262. }
  263. void mine_business::make_reverse_condition(uint64_t type,uint32_t id,int32_t antid,uint32_t ct,uint64_t tof,uint32_t sid)
  264. {
  265. m_reverse_alarm_ptr->make_condition(type,id,antid,ct,tof,sid);
  266. }
  267. ///rear ended collision...
  268. void mine_business::put(const std::shared_ptr<card_location_base> &c)
  269. {
  270. m_rear_ended_ptr->put(c);
  271. }
  272. void mine_business::make_arg(uint64_t cid,const point &p,uint64_t t)
  273. {
  274. m_rear_ended_ptr->make_arg(cid,p,t);
  275. }
  276. void mine_business::handle_rear_end()
  277. {
  278. m_rear_ended_ptr->handle_message();
  279. }
  280. void mine_business::clear_vehicle()
  281. {
  282. m_rear_ended_ptr->clear();
  283. }
  284. ///////staffer_num_business
  285. /**********************************
  286. //每两分钟把人员数量入库。
  287. //不往前端推送的人员,不算在数量范围内
  288. *********************************/
  289. void staffer_num_business::record_staffer_num()
  290. {
  291. static uint32_t min_num=0,max_num=0,min_num_real=0,max_num_real=0;
  292. std::time_t t = time(NULL);
  293. char ti[64] = { 0 };
  294. strftime(ti,sizeof(ti),"%Y/%m/%d %H:%M:%S",localtime(&t));
  295. std::string sti(ti);
  296. int minute = atoi(sti.substr(sti.find_first_of(':')+1,2).c_str());
  297. uint32_t a=m_staff_num.load();
  298. uint32_t ar=m_staff_num_real.load();
  299. if(m_record_staffer_timeval==0)
  300. {
  301. min_num=max_num=a;
  302. min_num_real=max_num_real=ar;
  303. m_record_staffer_timeval = t;
  304. }
  305. if(t-m_record_staffer_timeval>=120 && minute%2 == 0)
  306. {
  307. std::stringstream ss;
  308. ss<< "INSERT INTO his_staff_number(max_num,min_num,ave_num,max_num_real,min_num_real,ave_num_real) VALUES("
  309. <<max_num<<','<<min_num<<','<<std::lround((max_num+min_num)/2)<<','
  310. <<max_num_real<<','<<min_num_real<<','<<std::lround((max_num_real+min_num_real)/2)<<");";
  311. db_tool::PushAsync(ss.str().c_str());
  312. min_num=max_num=a;
  313. min_num_real=max_num_real=ar;
  314. m_record_staffer_timeval = t;
  315. }
  316. else
  317. {
  318. if (min_num>a)min_num = a;
  319. if (max_num<a)max_num = a;
  320. if (min_num_real>ar)min_num_real = ar;
  321. if (max_num_real<ar)max_num_real = ar;
  322. }
  323. reset();
  324. return;
  325. }
  326. //前端修改数据库表,dat_sensor dat_drivingface,dat_drivingface_vehicle的时候,需要加载.
  327. void reverse_alarm_business::load_sensor()
  328. {
  329. std::string sql = "SELECT sensor_id,data_source,work_face_id,v.vehicle_id,ve.card_id,d.base_point_x,d.base_point_y FROM dat_sensor ,dat_drivingface_vehicle v,dat_drivingface d,dat_vehicle_extend ve WHERE sensor_type_id = 1 AND work_face_id = v.drivingface_id AND work_face_id = d.drivingface_id AND ve.vehicle_id = v.vehicle_id;";
  330. std::string Error;
  331. YADB::CDBResultSet DBRes;
  332. sDBConnPool.Query(sql.c_str(),DBRes,Error);
  333. int nCount = DBRes.GetRecordCount( Error );
  334. if (nCount < 1)
  335. log_error("init_sensor..failed[%s]", sql.c_str());
  336. while ( DBRes.GetNextRecod(Error) )
  337. {
  338. int32_t sensor_id = 0;
  339. DBRes.GetField( "sensor_id",sensor_id, Error );
  340. int32_t data = 0;
  341. DBRes.GetField( "data_source",data, Error );
  342. int32_t workfaceid = 0;
  343. DBRes.GetField( "work_face_id",workfaceid, Error );
  344. std::string card_id;
  345. DBRes.GetField( "card_id",card_id, Error );
  346. double bx,by;
  347. DBRes.GetField( "base_point_x",bx, Error );
  348. DBRes.GetField( "base_point_y",by, Error );
  349. log_info("init sensor :workfaceid:%d,sensor_id:%d,data:%d,card:%s,(%.2f,%.2f)",workfaceid,sensor_id,data,card_id.c_str(),bx,by);
  350. if(data <= 0) continue;
  351. uint64_t cid = tool_other::card_id_to_u64(card_id);
  352. std::shared_ptr<card_sensor_mgr> tm=nullptr;
  353. auto iter = m_sensor_mgr.find(cid);
  354. if(iter != m_sensor_mgr.end())
  355. tm=iter->second;
  356. else
  357. {
  358. tm = std::make_shared<card_sensor_mgr>();
  359. m_sensor_mgr.insert({cid,tm});
  360. }
  361. point p(bx,by);
  362. tm->push(workfaceid,sensor_id,p,card_id);
  363. }
  364. }
  365. /************************************
  366. //获取传感器数据,从数据库中
  367. //每三分钟获取一次,判断其是否上升趋势。
  368. //如果上升趋势,则标识正在掘进中。开始判断反向
  369. ************************************/
  370. void reverse_alarm_business::run_sensor()
  371. {
  372. static time_t time_interval=0;
  373. time_t t = time(NULL);
  374. if (t-time_interval>3*60)
  375. {
  376. time_interval =t;
  377. for(const auto &x:m_sensor_mgr)
  378. x.second->for_each();
  379. }
  380. }
  381. void card_sensor_mgr::for_each()
  382. {
  383. for(const auto & cst:m_mgr)
  384. {
  385. auto cs = cst.second;
  386. if(cs->sensorId_list.empty())
  387. continue;
  388. char strsql[512]={0};
  389. snprintf(strsql,512, "SELECT data_value FROM his_sensor_data WHERE WHERE write_time > DATE_SUB(NOW(),INTERVAL 10 MINUTE) and sensor_id = %d ORDER BY write_time DESC LIMIT 3;",cs->sensorId_list[0]);
  390. std::string Error;
  391. YADB::CDBResultSet DBRes;
  392. sDBConnPool.Query(strsql,DBRes,Error);
  393. int nCount = DBRes.GetRecordCount( Error );
  394. if (nCount < 1)
  395. {
  396. log_warn("load_sensor_data..failed[%s]", strsql);
  397. continue;
  398. }
  399. double prenum=-1;
  400. double nrow=0;double sum=0;bool f=false;
  401. while ( DBRes.GetNextRecod(Error) )
  402. {
  403. double num = 0;
  404. DBRes.GetField( "data_value",num, Error );
  405. if (point::eq(num,0,1e-10))continue; //0异常数据抛掉
  406. if(point::eq(prenum,-1,1e-10)){ //如果没有参考数据,则判断,如果有历史数据,用历史,没有则用第一个数据。
  407. if(cs->empty()) prenum=num; else prenum=cs->back();
  408. }
  409. if (prenum-num>0.1){ //异常数据 如果之前存在正常数据则继续,如果没有则本次不作参考。0.1暂定
  410. if(cs->empty()){
  411. f=true;break;
  412. }
  413. else continue;
  414. }
  415. nrow++;sum+=num;
  416. }
  417. if (!f && nrow!=0){
  418. double result=sum/nrow;
  419. log_info("reverse_alarm_push %s,%.3f",cs->card_id.c_str(),result);
  420. if(cs->push(result)){//满足三个并且呈现上升趋势
  421. log_info("reverse_alarm_up %s",cs->card_id.c_str());
  422. if (!cs->warning())
  423. cs->set_true();//置true,主进程开始抓取数据。
  424. }
  425. }
  426. if (cs->timeout()){//时间满足,判断是否告警
  427. auto reader_it = sit_list::instance()->get(cs->reader_id());
  428. if (!reader_it){
  429. cs->clear_sensor();
  430. continue;
  431. }
  432. std::string msg;
  433. if(cs->check_location_reversal(msg) )//满足告警条件,查看是否已经存在告警,没有产生告警
  434. {
  435. log_info("reverse_alarm_create:%s",cs->card_id.c_str());
  436. //产生告警。
  437. //deal_readers_event(ET_READER_LOCATION_REVERSAL,true,reader_it->second);
  438. if(!cs->is_alarm)
  439. event_tool::instance()->handle_event(OT_DEVICE_READER,ET_READER_LOCATION_REVERSAL,cs->reader_id(),cs->count,cs->sum,cs->is_alarm=true);
  440. }
  441. else //不满足告警条件,查看是否已经存在告警,存在则取消告警。
  442. {
  443. log_info("reverse_alarm_delete:%s",cs->card_id.c_str());
  444. if(cs->is_alarm)
  445. event_tool::instance()->handle_event(OT_DEVICE_READER,ET_READER_LOCATION_REVERSAL,cs->reader_id(),cs->count,cs->sum,cs->is_alarm=false);
  446. //补
  447. //deal_readers_event(ET_READER_LOCATION_REVERSAL,false,reader_it->second);
  448. }
  449. log_info("%s",msg.c_str());
  450. cs->clear_sensor();//清除数据,重新判断
  451. }
  452. }
  453. }
  454. /*****************************************
  455. //当判断为反向后,则开始手机数据。
  456. //在规定的时间内,记录反向的数量以及双天线数量。
  457. //正常的数量n 总数量s 时长m(秒)
  458. //n/s<0.2 && s/m>0.8则标识天线反向
  459. ****************************************/
  460. void reverse_alarm_business::make_condition(uint64_t type,uint32_t id,int32_t antid,uint32_t ct,uint64_t tof,uint32_t sid)
  461. {
  462. uint64_t cid = tool_other::type_id_to_u64(type,id);
  463. auto it = m_sensor_mgr.find(cid);
  464. if(it != m_sensor_mgr.end())
  465. it->second->make_condition(antid,ct,tof,sid);
  466. }
  467. void card_sensor_mgr::make_condition(int32_t antid,uint32_t ct,uint64_t tof,uint32_t sid)
  468. {
  469. for(const auto x:m_mgr)
  470. {
  471. auto pdc =x.second;
  472. if (pdc->warning()){
  473. auto sit = sit_list::instance()->get(sid);
  474. point p0=(*sit)[0];point p1=(*sit)[1];
  475. if (!((*pdc)[0]==p0 && (*pdc)[1]==p1)){
  476. pdc->set(p0,p1,sid);
  477. log_info("[reverse_alarm_start]%s,bigger:%d",pdc->card_id.c_str(),pdc->bigger);
  478. }
  479. log_info("[reverse_alarm_working]%s,ct:%d,antid:%d,dist:%.2f",pdc->card_id.c_str(),ct,antid,tof);
  480. pdc->make_reverse_condition(antid,ct,tof);
  481. }
  482. }
  483. }
  484. bool rear_end_collision_prevented_business::invalid_card(const std::shared_ptr<card_location_base> &c)
  485. {
  486. bool f=false;
  487. uint64_t _now=time(0)*1000;
  488. uint64_t ti=c->time_();
  489. uint64_t t=_now>ti?_now-ti:ti-_now;
  490. if(t<45*1000 && !c->empty())
  491. f=true;
  492. return f;
  493. }
  494. void rear_end_collision_prevented_business::handle_message()
  495. {
  496. time_t now = time(0);
  497. if(now-_time>3)
  498. _time=now;
  499. else
  500. return;
  501. auto it=m_v.cbegin();
  502. for (;it!=m_v.cend();it++)
  503. {
  504. auto c=*it;
  505. if(!invalid_card(c))continue;
  506. double map_scale = c->get_area_tool()->m_scale;
  507. for (auto prv_it=std::next(it);prv_it!=m_v.cend();++prv_it)
  508. {
  509. auto c2=*prv_it;
  510. if(!invalid_card(c2))continue;
  511. double dis = (*c).dist(*c2)*map_scale;
  512. log_info("vehicle_alarm stpe3 : cid1:%d,cid2:%d (%.2f,%.2f),(%.2f,%.2f) %.2f,%f",c->m_id,c2->m_id,c->x,c->y,c2->x,c2->y,dis,map_scale);
  513. if(dis>CYaSetting::m_sys_setting.rear_end_d)
  514. continue;
  515. //判断反向行驶,平行行驶,背离行驶的车辆
  516. uint64_t u1=tool_other::type_id_to_u64(c->m_type,c->m_id);uint64_t u2=tool_other::type_id_to_u64(c2->m_type,c2->m_id);
  517. if (!rear_end_arg_algo(u1,u2))
  518. continue;
  519. //
  520. std::string card1=tool_other::type_id_to_str(c->m_type,c->m_id);std::string card2=tool_other::type_id_to_str(c2->m_type,c2->m_id);
  521. vInfo v;
  522. v.push(card1,card2);
  523. std::string cardid=v.getKey();
  524. if(m_CloserVehicle.find(cardid) == m_CloserVehicle.end())
  525. {
  526. m_CloserVehicle.insert(std::make_pair(cardid,v));
  527. log_info("vehicle_alarm_insert %s",cardid.c_str());
  528. }
  529. }
  530. }
  531. auto it_cv=m_CloserVehicle.begin();
  532. for (;it_cv != m_CloserVehicle.end();)
  533. {
  534. vInfo & vinfo = it_cv->second;
  535. std::string vvid = it_cv->first;
  536. uint64_t u1=tool_other::card_id_to_u64(vinfo.m_cid[0]);
  537. uint64_t u2=tool_other::card_id_to_u64(vinfo.m_cid[1]);
  538. uint64_t t=now*1000;
  539. uint64_t ct=m_map[u1]._t ;uint64_t rt = t>ct?t-ct:ct-t;
  540. uint64_t ct_=m_map[u2]._t; uint64_t rt_ = t>ct_?t-ct_:ct_-t;
  541. std::hash<std::string> hsh;
  542. uint32_t id = hsh(vvid);
  543. if (rt>45*1000 || rt_>45*1000 )
  544. {
  545. log_info("vehicle_alarm_time_ %s,%u",vvid.c_str(),id);
  546. if (vinfo.is_alarm){
  547. event_tool::instance()->handle_event(OT_CARD,ET_VEHICLE_REAR_END,id,0,0,false,DT_COMMON,vvid);
  548. }
  549. it_cv = m_CloserVehicle.erase(it_cv);
  550. continue;
  551. }
  552. auto c=card_list::instance()->get(u1);
  553. if(!c) continue;
  554. double map_scale = c->get_area_tool()->m_scale;
  555. double dis = get_absolute_distance(u1,u2)*map_scale;
  556. log_info("vehicle_alarm_distance %s %f",vvid.c_str(),dis);
  557. time_t tt = time(0);
  558. if (dis>CYaSetting::m_sys_setting.rear_end_d ||!rear_end_arg_algo(u1,u2))
  559. {
  560. if (vinfo.backfired_start_time==0)
  561. vinfo.backfired_start_time=tt;
  562. vinfo.real_end_start_time=0;
  563. if (tt-vinfo.backfired_start_time>CYaSetting::m_sys_setting.rear_end_t)
  564. {
  565. log_info("vehicle_alarm_backfired_timeout %s,%u",vvid.c_str(),id);
  566. if(vinfo.is_alarm){
  567. event_tool::instance()->handle_event(OT_CARD,ET_VEHICLE_REAR_END,id,CYaSetting::m_sys_setting.rear_end_d,dis,false,DT_COMMON,vvid);
  568. }
  569. it_cv = m_CloserVehicle.erase(it_cv);
  570. continue;
  571. }
  572. }
  573. else
  574. {
  575. vinfo.backfired_start_time =0;
  576. if (vinfo.real_end_start_time==0)
  577. vinfo.real_end_start_time=tt;
  578. if (tt-vinfo.real_end_start_time>CYaSetting::m_sys_setting.rear_end_t)
  579. {
  580. // debug_print_syslog(0,"vehicle_alarm_real_end_timeout %s",vvid.c_str());
  581. if (!vinfo.is_alarm)
  582. {
  583. log_info("vehicle_alarm_real_end_timeout_exec %s,%u",vvid.c_str(),id);
  584. event_tool::instance()->handle_event(OT_CARD,ET_VEHICLE_REAR_END,id,CYaSetting::m_sys_setting.rear_end_d,dis,true,DT_COMMON,vvid);
  585. vinfo.is_alarm = true;
  586. }
  587. }
  588. }
  589. ++it_cv;
  590. }
  591. }
  592. double rear_end_collision_prevented_business::get_absolute_distance(uint64_t c1,uint64_t c2)
  593. {
  594. point pp1=m_map[c1]._p;point pp2=m_map[c2]._p;
  595. double arg1=m_map[c1]._arg;double arg2=m_map[c2]._arg;
  596. point p1(pp1.x,-pp1.y);
  597. point p2(pp2.x,-pp2.y);
  598. if (fabs(arg1-arg2)<1e-10)
  599. return p1.dist(p2);
  600. std::stringstream ss;
  601. std::vector<point> v = card_path::inst().find_path(p1,p2);
  602. point pt = p1;double dis = 0;
  603. for (const auto & p:v)
  604. {
  605. dis += pt.dist(p);
  606. pt=p;
  607. }
  608. dis += pt.dist(p2);
  609. return dis;
  610. }
  611. bool rear_end_collision_prevented_business::rear_end_arg_algo(uint64_t u1,uint64_t u2)
  612. {
  613. point p_1=m_map[u1].last_p;point p_2=m_map[u2].last_p;
  614. double arg_1=m_map[u1]._arg;double arg_2=m_map[u2]._arg;
  615. line_v l_1=m_map[u1]._line;line_v l_2=m_map[u2]._line;
  616. std::string card1=tool_other::get_string_cardid(u1);std::string card2=tool_other::get_string_cardid(u2);
  617. if(p_1.empty() || p_2.empty())
  618. return false;
  619. log_info("[vehicle_alarm_begin_algo]%s&%s %f,%f (%s)(%s)--(%.2f,%.2f)(%.2f,%.2f)",card1.c_str(),card2.c_str(),arg_1,arg_2,l_1.to_string().c_str(),l_2.to_string().c_str(),p_1.x,p_1.y,p_2.x,p_2.y);
  620. if (point::eq(arg_1,0x12345678,1e-10) || point::eq(arg_2,0x12345678,1e-10))
  621. {
  622. log_info("[vehicle_alarm_invalid]%s&%s %f,%f",card1.c_str(),card2.c_str(),arg_1,arg_2);
  623. return false;
  624. }
  625. if (!point::eq(arg_1,0,1e-10))
  626. if (fabs(fabs(arg_1-arg_2)-3.141593)< 0.000005)
  627. {
  628. log_info("[vehicle_alarm_opposite]%s&%s",card1.c_str(),card2.c_str());
  629. return false;
  630. }
  631. if (point::eq(arg_1,arg_2,1e-10))
  632. {
  633. double arg = std::arg(std::complex<double>(p_1.x,p_1.y)-std::complex<double>(p_2.x,p_2.y));
  634. if (!(fabs(fabs(arg)-fabs(arg_1))<1e-10 || fabs(fabs(arg)+fabs(arg_2)-3.141593)< 0.000005))
  635. {
  636. log_info("[vehicle_alarm_parallel]%s&%s %f,%f()",card1.c_str(),card2.c_str(),arg,arg_1);
  637. return false;
  638. }
  639. }
  640. if(!point::eq(arg_1,arg_2,1e-10))
  641. {
  642. point p = l_1.line::crossing(l_2);
  643. if (p==l_1[1] || p==l_2[1])
  644. {
  645. log_info("[vehicle_alarm_point]%s&%s",card1.c_str(),card2.c_str());
  646. return true;
  647. }
  648. double arg1 = std::arg(std::complex<double>(p.x,p.y)-std::complex<double>(l_1[1].x,l_1[1].y));
  649. double arg2 = std::arg(std::complex<double>(p.x,p.y)-std::complex<double>(l_2[1].x,l_2[1].y));
  650. if (fabs(fabs(arg1-arg_1)-3.141593)<0.000005 && fabs(fabs(arg2-arg_2)-3.141593)<0.000005)
  651. {
  652. log_info(0,"[vehicle_alarm_backfired]%s&%s",card1.c_str(),card2.c_str());
  653. return false;
  654. }
  655. }
  656. log_info("[vehicle_alarm_end]%s&%s %f,%f",card1.c_str(),card2.c_str(),arg_1,arg_2);
  657. return true;
  658. }