1
0

ant.h 7.3 KB

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