ant.h 9.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393
  1. /**
  2. * 分站数据结构 site_list
  3. */
  4. #ifndef _ANT_LIST_HPP_
  5. #define _ANT_LIST_HPP_
  6. #include <math.h>
  7. #include <array>
  8. #include <deque>
  9. #include <tuple>
  10. #include <memory>
  11. #include <memory.h>
  12. #include <algorithm>
  13. #include <sstream>
  14. #include "log.h"
  15. #include "line.h"
  16. #include "point.h"
  17. #include "write-copy.h"
  18. #include"net-service.h"
  19. #include"common.h"
  20. class client;
  21. class area;
  22. struct path
  23. {
  24. std::array<line_v,2> m_line;
  25. std::array<double,2> m_slope;
  26. path()
  27. {
  28. for(auto &d:m_slope)
  29. d=0;
  30. }
  31. std::string to_str() const
  32. {
  33. std::stringstream ss;
  34. for(int i=0;i<2;i++)
  35. {
  36. ss<<"line:" <<m_line[i].to_string()<<"slope:"<<m_slope[i]<< " cos:"<<m_line[i].cos()<<" sin:"<<m_line[i].sin()<<" | ";
  37. }
  38. return ss.str();
  39. }
  40. bool vaild() const
  41. {
  42. return !m_line[0].empty();
  43. }
  44. line_v & operator[](int i)
  45. {
  46. return m_line[i];
  47. }
  48. const line_v & operator[](int i) const
  49. {
  50. return m_line[i];
  51. }
  52. };
  53. //?
  54. struct algo_config
  55. {
  56. const char*desc;
  57. int min_msg_cnt;
  58. int best_msg_cnt;
  59. double min_wait_time;
  60. double max_wait_time;
  61. };
  62. //
  63. struct ant :point
  64. {
  65. int m_id;
  66. std::vector<path> m_path;
  67. path & operator[](int i)
  68. {
  69. return m_path[i];
  70. }
  71. const path & operator[](int i) const
  72. {
  73. return m_path[i];
  74. }
  75. size_t size() const
  76. {
  77. return m_path.size();
  78. }
  79. std::vector<point> getsol(const double &dist) const
  80. {
  81. std::vector<point> v;
  82. for(const auto & p : m_path)
  83. {
  84. double d = dist;
  85. if(p.vaild())
  86. {
  87. point pt;
  88. if(dist <= p.m_line[0].length() || (dist > p.m_line[0].length() && p.m_line[1].empty()))
  89. {
  90. d += d*p.m_slope[0];
  91. pt = point(p.m_line[0][0].x + d*p.m_line[0].cos() , p.m_line[0][0].y + d*p.m_line[0].sin());
  92. }
  93. else
  94. {
  95. d -= p.m_line[0].length();
  96. d += d*p.m_slope[1];
  97. pt = point(p.m_line[1][0].x+d*p.m_line[1].cos(),p.m_line[1][0].y+d*p.m_line[1].sin());
  98. }
  99. v.push_back(pt);
  100. //std_info("get_sol:x:%.2f,y:%.2f",pt.x,pt.y);
  101. }
  102. //else
  103. // std_error("ant[%d]::getsol empty path..",);
  104. }
  105. return std::move(v);
  106. }
  107. };
  108. struct site:point,std::enable_shared_from_this<site>
  109. {
  110. static algo_config g_config[];
  111. int m_algo; //TOF:0,TDOA:1
  112. int m_num_dims; //1维:0,2维:1,3维:2
  113. double m_scale = 2.0; // 地图比例尺
  114. point m_position;
  115. mutable double m_height=1.5;
  116. int m_id;
  117. bool m_path_empty;
  118. std::array<ant,2> m_ant;
  119. mutable double m_ant_dist=0;
  120. mutable double m_ant_dist_sum_new=0;
  121. mutable int m_ant_dist_cnt_new=0;
  122. ///分站位置 READER_TYPE_ID
  123. int m_reader_type_id = 0;
  124. int m_map_id = 0;
  125. int m_area_id = 0;
  126. /// 设备类型,分站、通信分站、交通灯等
  127. int m_device_type_id=0;
  128. /// 指定分站定位类型:一维定位,二维定位,三维定位
  129. int m_dimension=0;
  130. std::shared_ptr<client> m_clt=nullptr;
  131. std::shared_ptr<area> m_area=nullptr;
  132. time_t m_time;
  133. time_t m_rec_time; // 接收数据的时间
  134. time_t m_lost_time; // 丢失时间
  135. time_t m_last_send_time; // 最后向前端发送时间
  136. unsigned char m_reader_dir; // 分站方向,对于大小分站适用
  137. unsigned char m_relay_counts; // 大小分站经过中继数
  138. int m_tick_count; // 分站发生消息的计数器
  139. bool m_power_check_enable=false;//该分站是否启用交流掉电检测功能(告警功能)
  140. bool m_power_ac_down=false; //false=交流电供电状态
  141. site(int id=-1);
  142. char m_timestamp[8]={0};
  143. bool check_timestamp(const char*time)
  144. {
  145. //秒、分、时、天、周、月、年, 脑残的设计
  146. char buf[6];
  147. buf[0]=time[6];
  148. buf[1]=time[5];
  149. buf[2]=time[3];
  150. buf[3]=time[2];
  151. buf[4]=time[1];
  152. buf[5]=time[0];
  153. if(memcmp(m_timestamp,buf,6)<=0)
  154. {
  155. memcpy(m_timestamp,buf,6);
  156. return true;
  157. }
  158. return false;
  159. }
  160. int index()const;
  161. const algo_config&config()const;
  162. int id()const
  163. {
  164. return m_id;
  165. }
  166. void set_client(std::shared_ptr<client>& clt)
  167. {
  168. if(m_clt != clt)
  169. m_clt = clt;
  170. m_time=time(0);
  171. }
  172. std::shared_ptr<client> get_client()
  173. {
  174. return m_clt;
  175. }
  176. bool is_up_site()
  177. {
  178. return READER_TYPE_ID_UP == m_reader_type_id;
  179. }
  180. void create_area();
  181. const std::shared_ptr<area>& get_area()const{return m_area;}
  182. point get_dstp(const point pt) const
  183. {
  184. point tmp;
  185. for(const auto & p : m_ant[0].m_path)
  186. {
  187. for(int i=0;i<2;i++)
  188. {
  189. if(!p[i].empty())
  190. {
  191. if(p[i].contain(pt,0.01))
  192. {
  193. //if(i==0)
  194. // return *this;
  195. //else
  196. tmp = p[i][0];
  197. }
  198. }
  199. }
  200. }
  201. return tmp;
  202. }
  203. void count_ant_dist(double dist_tof1, double dist_tof2)const
  204. {
  205. if(dist_tof1<10 || dist_tof2<10)
  206. return;
  207. double dist = fabs(dist_tof1 - dist_tof2);
  208. if(dist>5)
  209. return;
  210. m_ant_dist_sum_new += dist;
  211. m_ant_dist_cnt_new++;
  212. if(m_ant_dist_cnt_new >= 2500)
  213. {
  214. m_ant_dist = m_ant_dist_sum_new / m_ant_dist_cnt_new;
  215. m_ant_dist_sum_new = 0;
  216. m_ant_dist_cnt_new = 0;
  217. }
  218. }
  219. void swap()
  220. {
  221. auto v0 = m_ant[0].m_path;
  222. auto v1 = m_ant[1].m_path;
  223. std::copy (std::begin(v0),std::end(v0),std::back_inserter(m_ant[1].m_path));
  224. std::copy (std::begin(v1),std::end(v1),std::back_inserter(m_ant[0].m_path));
  225. }
  226. double ant_dist()const
  227. {
  228. return m_ant[0].dist(m_ant[1]);
  229. }
  230. bool is_path_empty()const
  231. {
  232. return m_path_empty;
  233. }
  234. bool have_valid_path()const
  235. {
  236. return m_id != -1 && ant_dist() > 0.1;
  237. }
  238. std::string to_string()const
  239. {
  240. std::stringstream ss;
  241. ss<<"site_id:"<<m_id<<"x:"<<x<<" y: "<<y<<" scale:"<<m_scale;
  242. for(const auto a:m_ant)
  243. {
  244. ss<<"<";
  245. for(const auto p:a.m_path)
  246. {
  247. ss<<"{"<<p.to_str()<<"}";
  248. }
  249. ss<<">";
  250. }
  251. return ss.str();
  252. }
  253. const point&path(int i)const
  254. {
  255. static point p;
  256. if(i>=(int)m_ant[0].m_path.size())
  257. return p ;
  258. return m_ant[0].m_path[i].m_line[0][1];
  259. }
  260. std::vector<point> solving(int ant_id, double dist)const
  261. {
  262. const ant &a = m_ant[ant_id];
  263. if(dist<50 && dist>0)
  264. {
  265. if(dist<m_height)
  266. {
  267. m_height=dist;
  268. dist=0;
  269. }
  270. else
  271. {
  272. dist=sqrt(dist*dist-m_height*m_height);
  273. }
  274. }
  275. return std::move(a.getsol(dist));
  276. }
  277. ant operator[](int i)
  278. {
  279. return m_ant[i];
  280. }
  281. const ant operator[](int i) const
  282. {
  283. return m_ant[i];
  284. }
  285. void set_ex()
  286. {
  287. if(-1 == m_id)
  288. {
  289. return;
  290. }
  291. if(m_ant[0]==m_ant[1])
  292. {
  293. log_warn("%d分站天线坐标相等.", m_id);
  294. }
  295. set( (m_ant[0].x+m_ant[1].x)/2,(m_ant[0].y+m_ant[1].y)/2);
  296. }
  297. void deal_path()
  298. {
  299. if(m_id==-1)
  300. return;
  301. swap();
  302. if((path(0).empty() && path(1).empty()))
  303. return;
  304. m_path_empty=false;
  305. for(auto &a:m_ant)
  306. for(auto &p:a.m_path)
  307. {
  308. if(!p.m_line[0].empty())
  309. {
  310. point px = p.m_line[0].line::projection(a);
  311. p.m_line[0]=line_v(px,p.m_line[0][1]);
  312. }
  313. }
  314. //std_info("%s",sit_ptr->to_string().c_str());
  315. log_info("%s",to_string().c_str());
  316. //std_info("%f----%f",sit_ptr->x,sit_ptr->y);
  317. }
  318. void delete_antenna(int antidx)
  319. {
  320. m_ant[antidx].m_path.clear();
  321. m_ant[antidx].m_id=0;
  322. point pt;
  323. m_ant[antidx].set(pt);
  324. }
  325. void clear_path()
  326. {
  327. m_ant[0].m_path.clear();
  328. m_ant[1].m_path.clear();
  329. }
  330. /*
  331. 处理分站供电状态,交流供电时,ac_down=false,直流供电时,ac_down=true
  332. 目前只有大分站实现了这个功能,并且井下安装时是否接入了该电信号也不确定
  333. ,所以需要有张表定义某个ID是否需要告警
  334. */
  335. void on_power_status(bool ac_down);//电源状态
  336. };
  337. struct visit_site_status:visitor<std::shared_ptr<site>>
  338. {
  339. bool visit(std::shared_ptr<site> s);
  340. };
  341. struct sit_list:single_base<sit_list,int,std::shared_ptr<site>>
  342. {
  343. void load()
  344. {
  345. read_sit_list(-1);
  346. read_ant_path(-1);
  347. }
  348. ///id=-1为初始化所有
  349. void load_from_db(int id=-1)
  350. {
  351. init_site(id);
  352. load();
  353. }
  354. void read_sit_list(int id);
  355. void read_ant_path(int id);
  356. void init_site(int id);
  357. };
  358. #endif