123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591 |
- #include <memory>
- #include <message.h>
- #include "card_message_handle.h"
- #include "card_person.h"
- #include "card_car.h"
- #include "config_file.h"
- #include "select_tool.h"
- #include "module_service/module_mgr.h"
- #include "websocket/wsClientMgr.h"
- #include "websocket/wsTimerThread.h"
- #include "three_rates.h"
- #include "his_location.h"
- #include "event.h"
- #include "module_service/module_call.h"
- #include "mine.h"
- #include "common_tool.h"
- #include "ant.h"
- #include "area.h"
- #include "loc_point.h"
- #include "loc_message.h"
- #include "module_service/module_traffic_light_manager.h"
- #include "db/db_tool.h"
- #include "tool_time.h"
- #include "tool_byte.h"
- extern config_file config;
- card_location_base::card_location_base(const std::string&type,uint32_t id,uint16_t dis,int16_t t,int32_t deptid,int32_t level_id,uint32_t cid)
- :card(id, dis, t, deptid, level_id, cid)
- ,m_display_old(dis)
- {
- select_tool_manage::instance()->create_tool(type, m_sel_tool, m_smo_tool);
- m_his_location_card.reset(new location_card(m_id, m_type, cid));
- m_cb_pdoa.set_capacity(5);
- m_cb_tof.set_capacity(5);
- m_cb_point.set_capacity(5);
- for(int index = 0; index < 5; ++index){
- m_cb_pdoa.push_back(100);
- m_cb_tof.push_back(0);
- m_cb_point.push_back(point(0,0));
- }
- m_cb_stream_idx.set_capacity(2);
- m_cb_stream_idx.push_back(0);
- m_cb_stream_idx.push_back(0);
- }
- void card_location_base::do_status(int st)
- {
- time_t now = time(0);
- bool help_flag = false;
- log_info("[help-battery] card_id=%d, help_bit=%d, status=%d", m_id, m_help_bit, st);
- // 呼救
- if((m_help_bit & 1) && (st & STATUS_HELP))
- {
- // 1111111111
- // ^
- m_help_last_time = now;
- }
- else if((m_help_bit & 1) && (st & STATUS_HELP)==0)
- {
- // 11111111100000
- // ^
- m_help_bit<<=1;
- }
- else if((m_help_bit & 1)==0 && (st & STATUS_HELP))
- {
- // 00000000011111
- // ^
- // 呼救开始
- if((m_help_bit&0x3)==2)
- {
- //log_warn("[help-battery] handle_m_help, card_id=%d",m_id);
- help_flag=true;
- }
- m_help_last_time = now;
- m_help_bit<<=1;
- m_help_bit|=1;
- log_info("[help-battery] begin help, card_id=%d, help_bit=%d, status=%d", m_id, m_help_bit, st);
- }
- else
- {
- // 11111111100000
- // ^
- // 呼救结束后持续1分钟
- if(now - m_help_last_time > 60)
- {
- m_help_bit = 0;
- log_info("[help-battery] end help, card_id=%d, help_bit=%d, status=%d", m_id, m_help_bit, st);
- }
- }
- /*if(!help_flag)
- {
- st = st & (0xFFFFFFFF ^ STATUS_HELP);
- }*/
- if((STATUS_POWER_LOWER_SERIOUS & st) != 0)
- {
- m_pwr_stat = STATUS_POWER_LOWER_SERIOUS;
- }
- else
- {
- m_pwr_stat = 0;
- }
- module_mgr::do_status((STATUS_CARD)st, m_id, m_type);
- }
- //写入历史轨迹
- void card_location_base::make_his_location(uint64_t t,const point & pt,bool bclose /*= false*/)
- {
- int area_id = 0, map_id = 0, site_id = 0;
- double scale = 0.0;
- if(auto site_ptr = get_area_tool()->m_site)
- {
- area_id = site_ptr->m_area_id;
- map_id = site_ptr->m_map_id;
- site_id = site_ptr->m_id;
- scale = site_ptr->m_scale;
- }
-
- auto mine_ptr = get_mine_tool();
- if(m_time < mine_ptr->get_down_time())
- {
- return;
- }
- m_his_location_card->push(t, pt, area_id, map_id, site_id, bclose);
- m_his_location_card->insert(t, pt, area_id, map_id, site_id, scale);
- }
- //坐标点输入业务入口
- void card_location_base::on_location(const std::vector<point>&vp, const std::vector<loc_message> &lm, bool is_v_map)
- {
- loc_point pt = m_sel_tool->select_solution(vp, lm);
- //pt.y = pt.y;
-
- auto site_ptr = get_area_tool()->m_site;
- int sid = 0;
- if(site_ptr)
- sid = site_ptr->m_id;
- if(pt.m_useless)
- {
- if (is_person())
- {
- if (!is_v_map)
- {
- x = tool_other::round(pt.x, 3);
- y = tool_other::round(pt.y, 3);
- }
- else
- {
- m_v_point.x = tool_other::round(pt.x, 3);
- m_v_point.y = tool_other::round(pt.y, 3);
- log_info("useful loc m_v_point: type=%d, card=%d, site=%d, ct=%d, timestamp=%llu, x=%f, y=%f, speed=%.2f, acc=%.2f", m_type, m_id, sid, m_ct, m_time, m_v_point.x, m_v_point.y, m_speed, lm[0].m_acc);
- return;
- }
- }
- else if (is_vehicle())
- {
- if (is_v_map)
- {
- x = tool_other::round(pt.x, 3);
- y = tool_other::round(pt.y, 3);
- }
- else
- {
- return;
- }
- }
- double acc = lm[0].m_acc;
- m_acc = lm[0].m_acc;
- log_info("useful loc point: type=%d, card=%d, site=%d, ct=%d, timestamp=%llu, x=%f, y=%f, speed=%.2f, acc=%.2f",m_type,m_id,sid,m_ct,m_time,x,y, m_speed, acc);
- do_business(lm.front().m_sit, pt, acc);
-
- // 呼救128,正常0
- int val = (lm[0].m_rav?STATUS_HELP:STATUS_NORMAL);
- if(m_battery_value > 3){
- val += STATUS_POWER_NORMAL;
- }else{
- val += STATUS_POWER_LOWER_SERIOUS;
- }
- log_info("[help-battery] card_id=%d, battery=%d, val=%d", m_id, m_battery_value, val);
- do_status(val);
- }
- else
- {
- log_warn("坐标不可用:site=%d, type=%d, card=%d, ct=%d, x=%f, y=%f", sid, m_type, m_id, m_ct, pt.x, pt.y);
- }
- }
- void card_location_base::on_message(zloop<task*>* loop, message_locinfo& loc,bool is_history)
- {
- m_ct = loc.m_card_ct;
- m_time = loc.m_time_stamp;
- auto site_ptr = sit_list::instance()->get(loc.m_site_id);
- if(!site_ptr)
- {
- log_warn("接收到分站的数据,site=%d,card=%d,ct=%d,但是分站未定义",loc.m_site_id,m_id,loc.m_card_ct);
- return;
- }
- auto area_tool=get_area_tool();
- area_tool->set_site(site_ptr);
- handle_message(loc.m_card_ct,loc.m_batty_status);
- if(site_ptr->is_up_site())
- {
- log_info("card=%d被井上分站[site=%d]收到",m_id,site_ptr->id());
- area_tool->on_point(shared_from_this(),point(1,1));
- this->site_hover(loc.m_site_id);
- }
- else
- {
- if(site_ptr->is_path_empty())
- {
- log_warn("接收到分站的数据,site=%d,card=%d,ct=%d,但是分站路径为空",site_ptr->id(),m_id,loc.m_card_ct);
- return;
- }
- m_message_handle->on_message(loop,loc,is_history);
- }
- }
- /*
- * tdoa 调用算法库定位
- * */
- void card_location_base::on_message(zloop<task*>* loop, message_tdoa_locinfo& loc, bool is_history)
- {
- log_info("[tdoa] start calc location.");
- m_ct = loc.m_card_msg.m_sync_num;
- auto site_ptr = sit_list::instance()->get(loc.m_site_msg.m_site_id);
-
- if(!site_ptr){
- log_warn("[tdoa] 接收到分站的数据:site=%d, card=%d, ct=%d, 但是分站未定义", loc.m_site_msg.m_site_id, m_id, loc.m_card_msg.m_time_stamp);
- return;
- }
-
- auto area_tool=get_area_tool();
- area_tool->set_site(site_ptr);
- handle_message(loc.m_card_msg.m_time_stamp, loc.m_card_msg.m_battery_status);
-
- if(site_ptr->is_up_site())
- {}
- else{
- m_message_handle->on_message(loop, loc, is_history);
- }
- }
- /*
- * pdoa 调用算法库定位
- *
- * */
- void card_location_base::on_message(zloop<task*>* loop, message_pdoa_locinfo& loc, bool is_history)
- {
- m_ct = loc.m_card_ct;
- m_time = loc.m_time_stamp;
- auto site_ptr = sit_list::instance()->get(loc.m_site_id);
- if(!site_ptr){
- log_warn("[pdoa] 接收到分站的数据:site=%d, card=%d, ct=%d, 但是分站未定义", loc.m_site_id, m_id, loc.m_card_ct);
- return;
- }
- site_ptr->m_loc_time = time(0);
- // 基站覆盖距离检测
- do_site_coverage(loc);
- auto area_tool=get_area_tool();
- area_tool->set_site(site_ptr);
- m_battery_value = loc.m_batty_status; // 电量值
- handle_message(loc.m_card_ct, loc.m_batty_status);
- if(site_ptr->is_up_site()){
- log_info("card=%d被井上分站[site=%d]收到", m_id, site_ptr->id());
- area_tool->on_point(shared_from_this(), point(1,1));
- this->site_hover(loc.m_site_id);
- m_last_site_id = site_ptr->id();
- //m_last_down_stream_idx = site_ptr->m_down_stream_idx;
- m_cb_stream_idx.push_back(site_ptr->m_down_stream_idx);
- }
- else{
- char sql[1024] = {0};
- snprintf(sql, 1024, "insert into his_distance_reader(card_type, ident, reader_id, dist, dir, cur_time) values(%d, %d, %d, %.2f, %d, '%s')", loc.m_card_type, loc.m_card_id, loc.m_site_id, loc.m_tof*15.65*2.996*1E-4, (tool_other::get_pdoa(loc.m_poa, site_ptr->m_pdoa_offset)>=0?1:-1), tool_time::to_str(time(NULL)).c_str());
- db_tool::PushAsync(sql);
- log_info("[sql] %s", sql);
-
- do_site_locate_event(loc);
- do_card_locate_event(loc);
-
- m_message_handle->on_message(loop, loc, is_history);
- }
- }
- //前端推送位置函数.
- void card_location_base::upt_card_pos(sys::_CARD_POS_&cp, point &pt)
- {
- point _p;
- if(pt.empty())
- {
- _p = *this;
- pt = _p;
- }
- else
- _p = pt;
-
- cp.Type = m_type;
- cp.ID = m_id;
- cp.speed = abs(ceil(m_speed));
- cp.x = tool_other::round(_p.x,3);
- cp.y = tool_other::round(_p.y,3);
- cp.running_stat = m_stat;
- cp.dept_id = m_deptid;
- cp.display = m_display;
- cp.rec_time = m_time;
- cp.level_id = m_level_id;
- cp.battery_val = m_battery_value;
- if(m_pwr_stat > 0){
- cp.battery_stat = (m_pwr_stat<3?1:0);
- }
- cp.m_freq = m_freq;
-
- swsTimerThrd.upt_card_pos(cp);
- }
- void card_location_base::del_card_pos()
- {
- sys::_CARD_POS_ cp;
- cp.ID = m_id;
- cp.Type=m_type;
- swsTimerThrd.del_card_pos(cp);
- }
- int card_location_base::get_stat()
- {
- //盲区>呼救>呼叫>超时>超速>正常
- uint64_t now = time(0)*1000;
- uint64_t tlost=now>m_time?now-m_time:m_time-now;
- if(tlost>CARD_LOST_TIME_OUT)
- {
- // 人卡盲区: 当人卡丢失信号大于60s,判定人卡进入盲区
- return STATUS_LOST;
- }
- else if(auto ev_ptr = event_list::instance()->get_event_card(m_id, m_type, ET_CARD_HELP))
- {
- return (ES_DEAL_HELP == ev_ptr->m_status) ? STATUS_HELP_DEALED : STATUS_HELP;
- }
- else if(CALL_NONE != get_mine_tool()->m_status_call)
- {
- return STATUS_CALL;
- }
- else if(is_person())
- {
- if(event_list::instance()->get_event_card(m_id, m_type,ET_CARD_AREA_OVER_TIME_PERSON)||
- event_list::instance()->get_event_card(m_id, m_type,ET_CARD_OVER_TIME_PERSON))
- return STATUS_AREA_OVER_TIME;
- }
- else if(event_list::instance()->get_event_card(m_id, m_type, ET_CARD_OVER_SPEED))
- {
- return STATUS_OVER_SPEED;
- }
- return STATUS_NORMAL;
- }
- void card_location_base::clear()
- {
- // uint16_t m_display; //1显示0不显示,往前端推送
- m_speed=0; //速度
- m_stat=0; //运动静止状态
- //m_ct; //ct
- m_time=0; //时间戳
- //pdoa location info clear
- m_buff_size = 0;
- m_last_recv_time = 0;
- m_last_point = point(0,0);
- m_last_site_id = 0;
- m_last_site_dir = -1;
- m_last_ct = 0;
- m_last_dist = 0.0;
- m_pdoa_diff = m_last_pdoa_diff = 100.0;
- m_last_over_site = false;
- m_cache_nums = 0;
- m_cb_pdoa.clear();
- m_cb_tof.clear();
- m_cb_point.clear();
- }
- void card_location_base::put_three_rates(card_pos & cp)
- {
- if(!three_rates_flag)
- return;
-
- cp.rec_time = m_time;
- cp.type = m_type;
- cp.id = m_id;
- cp.identifier_id= m_cid;
- cp.running_stat = m_stat;
- cp.final_v = m_speed;
- cp.dpt_id = m_deptid;
- std::shared_ptr<area_tool> _areatool = get_area_tool();
- if(nullptr != _areatool && nullptr != _areatool->m_site)
- {
- cp.reader_x = _areatool->m_site->x;
- cp.reader_y = _areatool->m_site->y;
- cp.reader_id = _areatool->m_site->m_id;
- }
- log_info("three_rates:type:%d,id:%d,cid:%d",cp.type,cp.id,cp.identifier_id);
- three_rates::get_instance()->put(cp);
- }
- void card_location_base::put_traffic_light(card_pos& cp)
- {
- if(!traffic_light_flag){
- return;
- }
- light_message lm;
- lm.m_cmd = cmd_card_data;
- lm.m_pos.x = cp.x;
- lm.m_pos.y = cp.y;
- lm.m_pos.z = cp.z;
- lm.m_pos.m_card_id = m_id;
- lm.m_pos.m_type = m_type;
- lm.m_pos.m_site_id = cp.reader_id;
- auto site_ptr = get_area_tool()->m_site;
- if(site_ptr){
- lm.m_pos.m_area_id = site_ptr->m_area_id;
- }
- //lm.m_pos.m_bigger = 0;
- lm.m_pos.m_speed = m_speed;
- log_info("[traffic_light] put locate info into traffic light module, card_id=%d, ctype=%d, x=%.2f, y=%.2f, site_id=%d", m_id, m_type, x, y, cp.reader_id);
- traffic_light_manager::instance()->put(lm);
- }
- bool card_location_base::is_person() const
- {
- return tool_other::is_person(m_type);
- }
- bool card_location_base::is_vehicle() const
- {
- return tool_other::is_vehicle(m_type);
- }
- void card_location_base::set_base_data(uint32_t cid,uint16_t type,uint32_t deptid,int32_t level_id) {
- m_cid = cid;
- m_type = type;
- m_deptid = deptid;
- m_level_id = level_id;
- m_his_location_card->set_cid(cid);
- }
- card_location_base::~card_location_base()
- {
- }
- std::shared_ptr<card_location_base> card_location_base::make_person(const std::string&type,uint32_t cardid,uint16_t needdisplay,int16_t t,
- int32_t deptid,int32_t level_id,uint32_t cid,int wl,const std::string &sname,const std::string & dname,int worktype_id)
- {
- return std::make_shared<person>(type, cardid, needdisplay, t, deptid, level_id, cid, wl, sname, dname, worktype_id);
- }
- /*
- * @brief 创建车辆对象
- * @param const std::string& type
- * @param uint32_t cardid 卡id
- * @param uint16_t needdisplay 是否需要显示
- * @param int16_t t
- * @param int32_t deptid 部门id
- * @param int32_t categoryid
- * @param int type_id 卡类型id
- * @param int32_t level_id 职级id
- * @param uint32_t cid
- * @return 车辆对象
- * @note
- * @bug
- * @warning
- * */
- std::shared_ptr<card_location_base> card_location_base::make_car(const std::string&type, uint32_t cardid, uint16_t needdisplay, int16_t t,
- int32_t deptid, int32_t categoryid, int type_id,int32_t level_id,uint32_t cid)
- {
- return std::make_shared<car>(type, cardid, needdisplay, t, deptid, categoryid, type_id, level_id, cid);
- }
- /*
- * @brief 基站覆盖距离检测
- * @param message_pdoa_locinfo& loc 卡数据
- * @return 无
- * @note
- * @bug
- * @warning
- * */
- void card_location_base::do_site_coverage(message_pdoa_locinfo& loc)
- {
- auto site_ptr = sit_list::instance()->get(loc.m_site_id);
- if(!site_ptr){
- log_warn("[pdoa] 接收到分站的数据:site=%d, card=%d, ct=%d, 但是分站未定义", loc.m_site_id, m_id, loc.m_card_ct);
- return;
- }
- double pdoa = tool_other::get_pdoa(loc.m_poa, site_ptr->m_pdoa_offset);
- double dist = loc.m_tof*15.65*2.996*1e-4;
- bool is_update = false;
- if(pdoa > 0){
- if(dist > site_ptr->m_coverage[0].m_distance){
- site_ptr->m_coverage[0].m_distance = dist;
- site_ptr->m_coverage[0].m_cid = tool_byte::to_cardid(loc.m_card_type, loc.m_card_id);
- site_ptr->m_coverage[0].m_time = time(0);
- is_update = true;
- }
- }else{
- if(dist > site_ptr->m_coverage[1].m_distance){
- site_ptr->m_coverage[1].m_distance = dist;
- site_ptr->m_coverage[1].m_cid = tool_byte::to_cardid(loc.m_card_type, loc.m_card_id);
- site_ptr->m_coverage[1].m_time = time(0);
- is_update = true;
- }
- }
- if(is_update){
- char sql[1024] = {0};
- snprintf(sql, 1024, "REPLACE INTO his_reader_coverage(reader_id, plus_dist, plus_card_id, plus_occur_time, minus_dist, minus_card_id, minus_occur_time, last_update) VALUES(%d,%.2f,'%s','%s',%.2f,'%s','%s','%s');", site_ptr->m_id, site_ptr->m_coverage[0].m_distance, site_ptr->m_coverage[0].m_cid.c_str(), tool_time::to_str(site_ptr->m_coverage[0].m_time).c_str(), site_ptr->m_coverage[1].m_distance, site_ptr->m_coverage[1].m_cid.c_str(), tool_time::to_str(site_ptr->m_coverage[1].m_time).c_str(), tool_time::to_str(time(0)).c_str());
- db_tool::PushAsync(sql);
- logn_info(2, "[sql] %s", sql);
- }
- }
- /*
- * @brief 卡定位异常检测
- * @param message_pdoa_locinfo& loc 卡数据
- * @return 无
- * @note
- * @bug
- * @warning
- * */
- void card_location_base::do_card_locate_event(const message_pdoa_locinfo& loc)
- {
- bool status = false;
- status = ((loc.m_tof == 0)?true:false);
- uint64_t id = tool_other::type_id_to_u64(m_type, m_id);
- event_tool::instance()->handle_event(OT_CARD, ET_CARD_LOCATE_ERROR, id, 0, 0, status);
- //log_info("[card-locate-event] card_id=%d, ct=%d, tof=%lld", m_id, m_ct, loc.m_tof);
- }
- /*
- * @brief 基站定位异常检测
- * @param message_pdoa_locinfo& loc 卡数据
- * @return 无
- * @note
- * @bug
- * @warning
- * */
- void card_location_base::do_site_locate_event(const message_pdoa_locinfo& loc)
- {
- //log_info("[site-locate-event] cur_ct=%d, ct=%d, m_last_ct=%d, m_last_site_id=%d, loc.m_site_id=%d", loc.m_card_ct, ct, m_last_ct, m_last_site_id, loc.m_site_id);
- if(m_last_ct <= 0 || m_last_site_id == 0){
- return;
- }
- if(loc.m_site_id != m_last_site_id){
- return;
- }
- int dt = 0;
- if(loc.m_card_ct > m_last_ct){
- dt = loc.m_card_ct - m_last_ct;
- }else{
- dt = 65535 + loc.m_card_ct - m_last_ct;
- }
-
- event_tool::instance()->handle_event(OT_DEVICE_READER, ET_READER_LONG_TIME_NO_POSITION, loc.m_site_id, 3, dt, (dt>=3));
- log_info("[site-locate-event] site_id=%d, card_id=%d, ct=%d, dt=%d", loc.m_site_id, m_id, loc.m_card_ct, dt);
- }
|