ant.h 9.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407
  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 <time.h>
  11. #include <sstream>
  12. #include <memory>
  13. #include <memory.h>
  14. #include <algorithm>
  15. #include <sstream>
  16. #include "log.h"
  17. #include "line.h"
  18. #include "point.h"
  19. #include "write-copy.h"
  20. #include "net-service.h"
  21. #include "common.h"
  22. #include <boost/circular_buffer.hpp>
  23. class client;
  24. class area;
  25. struct path
  26. {
  27. std::array<line_v,2> m_line;
  28. path()
  29. {
  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_line[i][0].z<< " cos:"<<m_line[i].cos()<<" sin:"<<m_line[i].sin()<<" | ";
  37. }
  38. return ss.str();
  39. }
  40. bool valid() 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 site_coverage_info{
  64. double m_distance; // 距离
  65. std::string m_cid; // 卡号
  66. uint64_t m_time; // 时间
  67. site_coverage_info()
  68. : m_distance(0.0)
  69. , m_cid("")
  70. , m_time(0)
  71. {}
  72. };
  73. //
  74. struct ant :point
  75. {
  76. std::array<path,2> m_path;
  77. int m_id;
  78. double m_angle = 0;
  79. boost::circular_buffer<double> m_cache_poa; // 缓存5个天线的相位差值
  80. ant()
  81. {
  82. m_cache_poa.set_capacity(5);
  83. }
  84. path & operator[](int i)
  85. {
  86. return m_path[i];
  87. }
  88. const path & operator[](int i) const
  89. {
  90. return m_path[i];
  91. }
  92. size_t size() const
  93. {
  94. return m_path.size();
  95. }
  96. void set_path(const std::vector<line_v>&v_line);
  97. void set_path(const std::vector<line_v>&v_line,std::vector<line_v>::const_iterator it);
  98. std::vector<point> getsol(const double &dist) const;
  99. bool phase_error();
  100. };
  101. struct site:point,std::enable_shared_from_this<site>
  102. {
  103. static algo_config g_config[];
  104. int m_algo; // TOF:0, TDOA:1, PDOA:2
  105. int m_num_dims; // 1维:1, 2维:2, 3维:3
  106. double m_scale = 2.0; // 地图比例尺
  107. point m_position;
  108. mutable double m_height=1.5;
  109. std::array<ant,2> m_ant;
  110. mutable double m_ant_dist=0;
  111. mutable double m_ant_dist_sum_new=0;
  112. mutable int m_ant_dist_cnt_new=0;
  113. ///分站位置 READER_TYPE_ID, 井上分站,井下分站
  114. int m_reader_type_id = 0;
  115. int m_map_id = 0;
  116. int m_area_id = 0;
  117. // 设备类型,分站、通信分站、交通灯等
  118. int m_device_type_id=0;
  119. // 是否为网络设备,0为can设备,1为网络设备
  120. int m_net_device_status;
  121. //pdoa
  122. double m_pdoa_offset = 0.0; // pdoa分站天线相位偏移量,90度的偏移值
  123. int m_pdoa_direction = 0; // pdoa分站天线1朝向
  124. std::shared_ptr<client> m_clt = nullptr;
  125. std::shared_ptr<area> m_area = nullptr;
  126. time_t m_time;
  127. time_t m_loc_time = time(0); // 基站定位时间
  128. // time_t m_rec_time; // 接收数据的时间
  129. // time_t m_lost_time; // 丢失时间
  130. // time_t m_last_send_time; // 最后向前端发送时间
  131. int m_id{-1};
  132. int m_cell_index{ -1 };
  133. // int m_tick_count; // 分站发生消息的计数器
  134. // unsigned char m_reader_dir; // 分站方向,对于大小分站适用
  135. // unsigned char m_relay_counts; // 大小分站经过中继数
  136. bool m_power_check_enable=false;//该分站是否启用交流掉电检测功能(告警功能)
  137. bool m_power_ac_down=false; //false=交流电供电状态
  138. bool m_path_empty;
  139. std::array<int,32> m_timeoff_count;
  140. std::array<site_coverage_info, 2> m_coverage; // 0为正向参数,1为负向参数
  141. int m_package_count=0;
  142. int m_special = 0;
  143. int m_down_stream_idx = 0;
  144. site(int id=-1);
  145. time_t m_site_time=0; //分站报文中的时间
  146. void set_site_time(time_t site_time)
  147. {
  148. m_site_time=site_time;
  149. }
  150. time_t last_site_time()const
  151. {
  152. return m_site_time;
  153. }
  154. int index()const;
  155. const algo_config&config()const;
  156. int id()const
  157. {
  158. return m_id;
  159. }
  160. void set_client(const std::shared_ptr<client>& clt)
  161. {
  162. if(m_clt != clt)
  163. m_clt = clt;
  164. m_time = time(0);
  165. }
  166. std::shared_ptr<client> get_client()
  167. {
  168. return m_clt;
  169. }
  170. bool is_up_site()
  171. {
  172. return READER_TYPE_ID_UP == m_reader_type_id;
  173. }
  174. bool is_abnormal_site()
  175. {
  176. bool f=false;
  177. double d=ant_dist();
  178. if(!is_up_site() &&(d<1e-5 && d>-1e-5) )
  179. f=true;
  180. return f;
  181. }
  182. void create_area();
  183. const std::shared_ptr<area> &get_area()const{return m_area;}
  184. void clear_event();
  185. point get_dstp(const point pt) const
  186. {
  187. point tmp;
  188. for(const auto & p : m_ant[0].m_path){
  189. for(int i=0;i<2;i++){
  190. if(!p[i].empty()){
  191. if(p[i].contain(pt,0.01)){
  192. tmp = p[i][0];
  193. }
  194. }
  195. }
  196. }
  197. if(tmp.empty())
  198. log_info("(%f,%f) can't find the point at [%d]",pt.x,pt.y,m_id);
  199. return tmp;
  200. }
  201. void count_ant_dist(double dist_tof1, double dist_tof2)const
  202. {
  203. if(dist_tof1<10 || dist_tof2<10)
  204. return;
  205. double dist = fabs(dist_tof1 - dist_tof2);
  206. if(dist>5)
  207. return;
  208. m_ant_dist_sum_new += dist;
  209. m_ant_dist_cnt_new++;
  210. if(m_ant_dist_cnt_new >= 2500)
  211. {
  212. m_ant_dist = m_ant_dist_sum_new / m_ant_dist_cnt_new;
  213. m_ant_dist_sum_new = 0;
  214. m_ant_dist_cnt_new = 0;
  215. }
  216. }
  217. double ant_dist()const
  218. {
  219. return m_ant[0].dist(m_ant[1]);
  220. }
  221. bool is_path_empty()const
  222. {
  223. return m_path_empty;
  224. }
  225. bool have_valid_path()const
  226. {
  227. return m_id != -1 && ant_dist() > 0.1;
  228. }
  229. std::string to_string()const
  230. {
  231. std::stringstream ss;
  232. ss<<"site_id:"<<m_id<<"x:"<<x<<" y: "<<y<<" scale:"<<m_scale;
  233. for(const auto&a:m_ant)
  234. {
  235. ss<<"<";
  236. for(const auto&p:a.m_path)
  237. {
  238. ss<<"{"<<p.to_str()<<"}";
  239. }
  240. ss<<">";
  241. }
  242. return ss.str();
  243. }
  244. const point&path(int i)const
  245. {
  246. static point p;
  247. if(i>=(int)m_ant[0].m_path.size())
  248. return p ;
  249. return m_ant[0].m_path[i].m_line[0][1];
  250. }
  251. void set_path(const std::vector<line_v>&v_line);
  252. std::vector<point> solving(int ant_id, double dist)const
  253. {
  254. const ant &a = m_ant[ant_id];
  255. if(dist < 50 && dist > 0)
  256. {
  257. if(dist < m_height)
  258. {
  259. m_height = dist;
  260. dist = 0;
  261. }
  262. else
  263. {
  264. dist = sqrt(dist*dist - m_height*m_height);
  265. }
  266. }
  267. return std::move(a.getsol(dist));
  268. }
  269. std::vector<point> solving_pdoa(const int& ant_id, double dist)const
  270. {
  271. const ant& a = m_ant[ant_id];
  272. //logn_info(3, "[pdoa] solving_pdoa, dist=%.4f, a.x=%.4f, a.y=%.4f", dist, a.x, a.y);
  273. return std::move(a.getsol(dist));
  274. }
  275. ant&operator[](int i)
  276. {
  277. return m_ant[i];
  278. }
  279. const ant&operator[](int i) const
  280. {
  281. return m_ant[i];
  282. }
  283. void set_ex()
  284. {
  285. if(-1 == m_id)
  286. {
  287. return;
  288. }
  289. if(m_ant[0]==m_ant[1])
  290. {
  291. log_warn("%d分站天线坐标相等.", m_id);
  292. }
  293. set( (m_ant[0].x+m_ant[1].x)/2,(m_ant[0].y+m_ant[1].y)/2);
  294. }
  295. void delete_antenna(int antidx)
  296. {
  297. m_ant[antidx].set(point(0,0));
  298. }
  299. /*
  300. 处理分站供电状态,交流供电时,ac_down=false,直流供电时,ac_down=true
  301. 目前只有大分站实现了这个功能,并且井下安装时是否接入了该电信号也不确定
  302. ,所以需要有张表定义某个ID是否需要告警
  303. */
  304. void on_power_status(bool ac_down); //电源状态
  305. void set_algo(int _algo)
  306. {
  307. m_algo = _algo;
  308. }
  309. double get_site_dist(const int& sid);
  310. void push_poa(const double& poa1, const double& poa2)
  311. {
  312. m_ant[0].m_cache_poa.push_back(poa1);
  313. m_ant[1].m_cache_poa.push_back(poa2);
  314. }
  315. };
  316. struct visit_site_status:visitor<std::shared_ptr<site>>
  317. {
  318. bool visit(std::shared_ptr<site> s);
  319. };
  320. struct sit_list:single_base<sit_list,int,std::shared_ptr<site>>
  321. {
  322. void load(const std::string &id)
  323. {
  324. int sid=-1;
  325. if(!id.empty())sid=std::stoi(id);
  326. read_sit_list(sid);
  327. read_ant_path(sid);
  328. }
  329. ///id=-1为初始化所有
  330. void load_from_db(const std::string&ids="")
  331. {
  332. init_site(ids);
  333. load(ids);
  334. }
  335. void read_sit_list(int id=-1);
  336. void read_ant_path(int id=-1);
  337. void init_site(const std::string &ids="");
  338. };
  339. struct sit_list_v :single_base<sit_list_v, int, std::shared_ptr<site>>
  340. {
  341. void load(const std::string &id)
  342. {
  343. int sid = -1;
  344. if (!id.empty())sid = std::stoi(id);
  345. read_sit_list(sid);
  346. read_ant_path(sid);
  347. }
  348. ///id=-1为初始化所有
  349. void load_from_db(const std::string&ids = "")
  350. {
  351. init_site(ids);
  352. load(ids);
  353. }
  354. void read_sit_list(int id = -1);
  355. void read_ant_path(int id = -1);
  356. void init_site(const std::string &ids = "");
  357. };
  358. #endif