ant.h 8.1 KB

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