ant.h 8.6 KB

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