his_location.cpp 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334
  1. #include "his_location.h"
  2. #include "log.h"
  3. #include "tool_time.h"
  4. #include "card_path.h"
  5. #include "db_api/CDBSingletonDefine.h"
  6. #include <config_file.h>
  7. extern config_file config;
  8. uint32_t location_card::m_difftime=0;
  9. int location_card::m_distance=-1;
  10. location_card::location_card(uint32_t id,uint64_t type,uint32_t objid)
  11. :m_cardid(id)
  12. ,m_type(type)
  13. ,m_objid(objid)
  14. {
  15. init();
  16. if(location_card::m_distance==-1)
  17. {
  18. location_card::m_difftime=config.get("service.difftime",300);
  19. location_card::m_distance=config.get("service.distance",30);
  20. log_info("his_location_init:%u,%d",m_difftime,m_distance);
  21. }
  22. }
  23. void location_card::init()
  24. {
  25. m_areaid=-1;
  26. m_mapid=-1;
  27. m_siteid = -1;
  28. m_timestamp=0;
  29. m_p.set(0,0);
  30. std::queue<mini_data> tmp;
  31. m_d.swap(tmp);
  32. m_direct_index=0;
  33. last_timestamp=0;
  34. set_invalid();
  35. }
  36. void location_card::init_att(const point &pt,uint64_t time)
  37. {
  38. std::queue<mini_data> tmp;
  39. m_d.swap(tmp);
  40. m_d.emplace(pt,time);
  41. }
  42. void location_card::set_invalid()
  43. {
  44. m_arg=0x12345678;
  45. }
  46. bool location_card::is_valid()
  47. {
  48. return m_arg!=0x12345678;
  49. }
  50. double location_card::make_arg(const point &pt,const point &p)
  51. {
  52. log_info("his_location arg[%d],(%.2f,%.2f)--->(%.2f,%.2f)---->(%.2f,%.2f)",m_cardid,m_p.x,m_p.y,p.x,p.y,pt.x,pt.y);
  53. return std::arg(std::complex<double>(pt.x,pt.y)-std::complex<double>(p.x,p.y));
  54. }
  55. void location_card::set(const point &pt,uint64_t time)
  56. {
  57. m_timestamp=time;
  58. m_p.set(pt);
  59. init_att(pt,time);
  60. }
  61. bool location_card::line_changed(const point &pt)//,int &df)
  62. {
  63. if(!is_valid())
  64. return false;
  65. point p;
  66. if(m_d.empty())p=m_p; else p=m_d.back().p;
  67. if(point::eq(p.x,pt.x,0.2) && point::eq(p.y,pt.y,0.2)) return false;
  68. double dis1=m_p.dist(pt);
  69. if(dis1<2)return false;
  70. //double dis = p.dist(pt);
  71. double dis = m_p.dist(pt);
  72. double arg = make_arg(pt,m_p);
  73. //查看路径方向是否改变
  74. bool change_flag=(arg-m_arg > -1e-10 && arg-m_arg<1e-10);
  75. //change_flag为true,标识没有发生变化
  76. // if(change_flag)m_direct_index=0;
  77. log_info("his_location:line_changed:%d,%f,m_arg:%f,%s,%f,%f",m_cardid,arg,m_arg, change_flag?"same":"not same",m_arg-arg,dis);
  78. //if(dis<0.5 && fabs(fabs(arg)+fabs(m_arg)-3.141593)< 0.000005)
  79. // return false;
  80. //判断10次反向才做下一步动作
  81. // if(fabs(fabs(arg)+fabs(m_arg)-3.141593)< 0.000005)
  82. // {
  83. // if(++m_direct_index<=10)
  84. // {
  85. // df=1;return false;
  86. // }
  87. // }
  88. //return !point::eq(arg,m_arg,1e-10);
  89. return !change_flag;
  90. }
  91. bool location_card::is_speed_changed(const point& pt,uint64_t time)
  92. {
  93. bool flag = false;
  94. double v=0.0;
  95. point ps=m_d.back().p;
  96. if(ps.dist(pt)<0.1)return flag;
  97. if(m_d.size()>=4)
  98. {
  99. mini_data d1 = m_d.front();
  100. double dist = d1.p.dist(pt);
  101. double t = time-d1.time;
  102. v = dist/t*1000;
  103. m_d.pop();
  104. }
  105. m_d.emplace(pt,time);
  106. if(v<=0.1)
  107. return flag;
  108. double dist = m_p.dist(pt);
  109. double t = time - m_timestamp;
  110. double avge_speed= dist/t*1000;
  111. log_info("his_location cardid:%d:v:%.2f,avge_v:%.2f,(%.2f--%.2f)",m_cardid,v,avge_speed,0.7*avge_speed,1.3*avge_speed);
  112. if(v<(1-0.3)*avge_speed || v>(1+0.3)*avge_speed)
  113. flag=true;
  114. return flag;
  115. }
  116. bool location_card::time_out(const point &p,uint64_t time)
  117. {
  118. uint64_t t=last_timestamp==0?m_timestamp:last_timestamp;
  119. if(time-t>=30*1000 && m_p.dist(p)>0.1)
  120. return true;
  121. return false;
  122. }
  123. //区域是否发生变化
  124. bool location_card::is_area_changed(int new_areaid)
  125. {
  126. bool flag =false;
  127. if(m_areaid != new_areaid)
  128. {
  129. m_areaid = new_areaid;
  130. flag=true;
  131. }
  132. return flag;
  133. }
  134. //地图是否发生变化
  135. bool location_card::is_map_changed(int new_mapid)
  136. {
  137. bool flag =false;
  138. if(m_mapid != new_mapid)
  139. {
  140. m_mapid = new_mapid;
  141. flag=true;
  142. }
  143. return flag;
  144. }
  145. //分站是否发生变化
  146. bool location_card::is_site_changed(const int& new_siteid)
  147. {
  148. bool flag = false;
  149. if(m_siteid != new_siteid)
  150. {
  151. m_siteid = new_siteid;
  152. flag = true;
  153. }
  154. return flag;
  155. }
  156. void location_card::push(uint64_t timestamp,const point & p,int32_t areaid,int32_t mapid,int32_t siteid,bool bclose/* = false*/)
  157. {
  158. if (bclose) //卡移除后直接更新his_location
  159. {
  160. update(p,timestamp);
  161. init();
  162. return;
  163. }
  164. if(m_p.empty() || m_timestamp==0||m_areaid<0||m_mapid<0 || m_siteid < 0)
  165. {
  166. set(p,timestamp);
  167. m_areaid = areaid;
  168. m_mapid = mapid;
  169. m_siteid = siteid;
  170. m_d.emplace(p,timestamp);
  171. return ;
  172. }
  173. if(!is_valid())
  174. {
  175. //if(p==m_p)
  176. if(point::eq(p.x,m_p.x,0.2) && point::eq(p.y,m_p.y,0.2))
  177. {
  178. set(p,timestamp);
  179. log_info("his_location:%d New Point Too close.Point[%.2f,%.2f]",m_cardid,p.x,p.y);
  180. return ;
  181. }
  182. auto v=find_path(m_p,p);
  183. if(v.empty())
  184. m_arg=make_arg(p,m_p);
  185. else
  186. {
  187. log_info("his_location:more_abnormal_point....%d,(%.2f,%.2f)---(%.2f,%.2f)",m_cardid,m_p.x,m_p.y,p.x,p.y);
  188. handle_path(v,timestamp,true);
  189. set_invalid();
  190. return;
  191. }
  192. log_info("his_location:%d arg:%f",m_cardid,m_arg);
  193. insert();
  194. return;
  195. }
  196. bool flag=false;
  197. int iflag=0;
  198. //判断是否路径发生了变化
  199. //这里现在又判断,如果反向了也会返回true.但是不运作,依然走下面的逻辑就会有问题
  200. //比如速度
  201. flag=handle_message(p,timestamp);
  202. if(time_out(p,timestamp))
  203. if(!flag)iflag=1;
  204. if(is_speed_changed(p,timestamp))
  205. if(!flag)iflag=2;
  206. if(is_area_changed(areaid))
  207. if(!flag)iflag=3;
  208. if(is_map_changed(mapid))
  209. if(!flag)iflag=4;
  210. if(is_site_changed(siteid)){
  211. if(!flag)
  212. iflag=5;
  213. }
  214. log_info("his_location cardid:%d:%d",m_cardid,iflag);
  215. if(iflag)
  216. {
  217. update(p,timestamp,iflag);
  218. //set_invalid();
  219. if(iflag>1){
  220. set(p,timestamp);
  221. insert();
  222. }
  223. }
  224. }
  225. void location_card::insert()
  226. {
  227. //std::string tabName=getTabName();
  228. char nsql[512]={0};
  229. const char * sql = "replace into his_location (obj_id,card_type_id,ident,begin_time,map_id,area_id,begin_pt,direction,reader_id)"
  230. "values(%d,%d,%d,'%s',%d,%d,'%.2f,%.2f',%f,%d);";
  231. snprintf(nsql,512,sql,m_objid,m_type,m_cardid,tool_time::to_str(m_timestamp/1000).c_str(),m_mapid,m_areaid,m_p.x,m_p.y,m_arg,m_siteid);
  232. log_info("his_location[%d,%lu]:%s",m_cardid,m_timestamp,nsql);
  233. sDBConnPool.PushAsync(nsql);
  234. }
  235. void location_card::update(const point &p,uint64_t timestamp,int flag/*=0*/,int dflag/*=0*/)
  236. {
  237. //std::string tabName=getTabName();
  238. char nsql[512]={0};
  239. const char * sql = "update his_location set last_time='%s',speed=%.3f,direction=%f,location_flag=%d where obj_id=%d and begin_time='%s' and last_time is null;";
  240. double dist = m_p.dist(p);
  241. double t = (timestamp - m_timestamp)/1000;
  242. double avge_speed = dist/t;
  243. if(std::isnan(avge_speed)|| std::isinf(avge_speed))avge_speed=0;
  244. log_info("his_location_time[%d]:%d[%lu,%lu,%lu]",m_cardid,flag,last_timestamp,timestamp,m_timestamp);
  245. if(last_timestamp != 0)
  246. {
  247. const char * ss = "update his_location set last_time='%s',speed=%.3f,direction=%f,location_flag=%d where obj_id=%d and begin_time='%s' and last_time = '%s';";
  248. snprintf(nsql,512,ss,tool_time::to_str(timestamp/1000).c_str(),avge_speed,m_arg,dflag,m_objid,tool_time::to_str(m_timestamp/1000).c_str(),tool_time::to_str(last_timestamp/1000).c_str());
  249. }
  250. else
  251. snprintf(nsql,512,sql,tool_time::to_str(timestamp/1000).c_str(),avge_speed,m_arg,dflag,m_objid,tool_time::to_str(m_timestamp/1000).c_str());
  252. if(flag==1) last_timestamp=timestamp;
  253. else last_timestamp=0;
  254. log_info("his_location[%d]:%s[%lu,%lu]",m_cardid,nsql,timestamp,m_timestamp);
  255. sDBConnPool.PushAsync(nsql);
  256. }
  257. std::vector<point> location_card::find_path(const point &p1,const point &p2)
  258. {
  259. std::vector<point> rc=card_path::inst().find_path(point(p1.x,-p1.y),point(p2.x,-p2.y));
  260. return std::move(rc);
  261. }
  262. //virtual bool handle_message(const point &p,uint64_t timestamp)=0;
  263. bool location_card::handle_message(const point &p,uint64_t timestamp)
  264. {
  265. bool flag = false;
  266. //int df=0;
  267. if(line_changed(p))//,df))
  268. {
  269. flag = true;
  270. //std::vector<point> rc=find_path(m_d.back().p,p);
  271. std::vector<point> rc=find_path(m_p,p);
  272. if(rc.empty())
  273. {
  274. log_info("his_location:line_changed rc.empty() %d",m_cardid);
  275. update(m_d.back().p,m_d.back().time);
  276. set(m_d.back().p,m_d.back().time);
  277. }
  278. else
  279. {
  280. if(handle_path(rc,timestamp,false))
  281. return true;
  282. }
  283. //置m_arg非法
  284. set_invalid();
  285. }
  286. //if(df==1)flag=true;
  287. return flag;
  288. }
  289. bool location_card::handle_path(std::vector<point> &rc,uint64_t timestamp,bool flag)
  290. {
  291. double dis=0;point _p=m_p;
  292. std::for_each(rc.begin(),rc.end(),[&dis,&_p](point &pt){
  293. pt.y=-pt.y;dis+=_p.dist(pt);_p=pt;
  294. });
  295. uint64_t t=timestamp/1000 - m_timestamp/1000;
  296. if(t==0||dis<0.1)return true;
  297. double avge_speed= dis/t;
  298. //有拐点 盲区时间差 距离
  299. uint64_t difftime=t;int dflag=0;
  300. if(!m_d.empty()) difftime=timestamp/1000-(m_d.back().time)/1000;
  301. if(difftime>=location_card::m_difftime && dis>location_card::m_distance)
  302. {
  303. log_info("his_location[%d]:abnormal_line difftime:%lu,ltime:%u,dis:%.2f,limit_dis:%d",m_cardid,difftime,location_card::m_difftime,dis,location_card::m_distance);
  304. dflag=1;
  305. }
  306. for(const point & pp:rc)
  307. {
  308. m_arg=make_arg(pp,m_p);
  309. if(flag)insert();
  310. log_info("his_location[%d]:line_changed_x point(%.2f,%.2f)--circle point(%.2f,%.2f),speed:%.2f",m_cardid,m_p.x,m_p.y,pp.x,pp.y,avge_speed);
  311. double dist=m_p.dist(pp);uint64_t tt=dist/avge_speed*1000;
  312. uint64_t etime=m_timestamp+tt;
  313. update(pp,etime,0,dflag);
  314. set(pp,etime);
  315. flag=true;
  316. }
  317. return false;
  318. }