#include #include "card_car.h" #include "card_message_handle.h" #include "his_location.h" #include "area.h" #include "mine.h" #include "struct_def.h" #include "select_tool.h" #include "websocket/ws_common.h" #include "special_area.h" #include "common_tool.h" #include "tool_time.h" #include "mine_business.h" #include "loc_point.h" #include "module_service/module_call.h" #include "sys_setting.h" #include "event.h" car::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) :card_location_base(type,cardid,needdisplay,t,deptid,level_id,cid) ,m_vehicle_category_id(categoryid) ,m_vehicle_type_id(type_id) { m_message_handle.reset(new card_message_handle(this)); m_speeds.set_capacity(30); //m_his_location_card.reset(new location_vehicle(m_id,m_type,cid)); } car::~car(){} std::shared_ptr car::get_mine_tool() { return m_mine_tool; } void car::set_area_info(int mapid,double scale,int areaid,uint64_t t,int type) { m_area_tool->set_area_info(mapid, scale, areaid, *this, t, type); } /* * @brief * 车辆业务 * @param * const std::shared_ptr& site 基站对象 * const point& pt 车辆定位坐标 * double acc 加速度值 * @return * 无 * @note * @warning * @bug * */ void car::do_business(const std::shared_ptr&site,const point &pt,double acc,int cell_index) { m_acc = acc; m_area_tool->on_point(shared_from_this(),pt); m_timeval = m_time; handle_traffic_light(pt, site->m_id); if(CYaSetting::m_sys_setting.m_enable_anti_coll){ handle_anti_coll(pt, site->m_id, cell_index); } uint64_t id=tool_other::type_id_to_u64(m_type,m_id); mine_business::inst()->make_arg(id,pt,m_time); //超速告警业务 handle_over_speed(); } /* * @brief * 超速告警,频率为1hz,定位一秒一次; * 开始:连续30个定位点超过35km认为开始超速告警 * 结束:连续10个定位点小于35km认为结束超速告警 * @param * 无 * @return * @note * @warning * @bug * */ void car::handle_over_speed() { // 超速告警,频率为1hz,定位一秒一次; // 开始:连续30个定位点超过35km认为开始超速告警 // 结束:连续10个定位点小于35km认为结束超速告警 m_speeds.push_back(m_speed); if(m_speeds.size() < 30){ return; } bool status = true; for(size_t i = 0;i < m_speeds.size();i++){ if(m_speed < CYaSetting::m_sys_setting.over_speed){ status = false; } } log_info("CYaSetting::m_sys_setting.over_speed=%.2f.", CYaSetting::m_sys_setting.over_speed); uint64_t id = m_type; id = ((id<<32) | m_id); if(status){ // 产生告警 log_info("[v_over_speed] %d begin warning...", m_id); //event_tool::instance()->handle_event(OT_CARD, ET_CARD_OVER_SPEED, id, 0, 0, status); event_tool::instance()->handle_event(OT_CARD, ET_CARD_OVER_SPEED, id, m_cell_index, m_speed, status); } status = true; for(size_t i = 20;i < m_speeds.size();i++){ if (m_speed > CYaSetting::m_sys_setting.over_speed) { status = false; } } if(status){ // 结束告警 log_info("[v_over_speed] %d end warning...", m_id); event_tool::instance()->handle_event(OT_CARD, ET_CARD_OVER_SPEED, id, 0, 0, false); } } int car::get_vehicle_type_id() { return m_vehicle_type_id; } /* * @brief * 车辆防碰撞判断 * 车辆定位后,检查车辆附近(根据防碰撞的三个档位距离阈值)是否有人,有人则产生防碰撞告警 * 如果车辆在距离最大档位内没人,则结束告警; * 以车为单位,通知web端,进入一档二档三挡会将三个档位每个档位有多少人通知web端, * 当人从一档变为二档也会将人档位的变化发送给web端; * 发送告警的级别会根据档位的变化动态变化;产生一条告警 * 允许重复发送 * 在本方法中实现上述逻辑; * @param * const point& pt 车辆定位位置 * const int& sid * @return * 无 * @note * modified by zhuyf,2022-04-24 * @warning * @bug * */ void car::handle_anti_coll(const point& pt, const int& sid, int cell_index) { // 车卡下发最紧急的呼叫类型 std::map cd; // 人卡与车卡的距离,key为人卡id,value为距离 std::map cards; auto tmp_cards = card_list::instance()->m_map; log_info("[anti_coll] card'size = %d", tmp_cards.size()); double min_d = 9999999.9; double cur_v = 0.0; for(auto k : CYaSetting::m_sys_setting.mp_anti_collision){ //log_info("[anti_coll] key=%d, value=%.2f", k.first, k.second); for(auto& c : tmp_cards) { // 车卡不参与车车之间防碰撞 if(c.second->m_type == CT_VEHICLE){ continue; } // 司机卡不参与人车之间的防碰撞 if(c.second->m_id>=9000&&c.second->m_id<=9999){ continue; } // 避免历史定位数据的影响 uint64_t now = time(0)*1000; if(m_time - now > 60){ continue; } bool s = false; int d = (c.second->m_timeval >= m_timeval ? (c.second->m_timeval - m_timeval) : (m_timeval - c.second->m_timeval)) / 1000.0; s = (d <= 30); //float dist = pt.dist(*c.second); //float dist = pt.dist(c.second->m_v_point); float dist = fabs(cell_index - c.second->m_v_cell_index); // zmg if (false) { if (m_cid == 82) { if (m_cache_nums > 10 && m_cache_nums < 13) { dist = k.second - 1; } else { dist = k.second + 1; } } else if (m_cid == 10004) { if (m_cache_nums > 11 && m_cache_nums < 14) { dist = k.second - 1; } else { dist = k.second + 1; } } else { dist = k.second + 1; } } log_info("[anti_coll] vid=%d, pid=%d, dist=%.2f, cell_index=%d, c.second->m_v_cell_index=%d", m_id, c.second->m_id, dist, cell_index, c.second->m_v_cell_index); if(dist < k.second && s){ int call_level = 5 - k.first; log_info("[anti_coll] distance=%.3f, level=%d, thre_value=%.3f, time_diff=%d", dist, call_level, k.second, d); if(min_d > k.second){ min_d = k.second; cur_v = dist; } auto itc = cd.find(c.second->m_id); if(itc == cd.end()){ cd.insert(std::make_pair(c.second->m_id, dist)); }else{ itc->second = dist; } auto it = cards.find(c.second->m_id); if(it != cards.end()){ if(c.second->m_call_level > call_level){ c.second->m_call_level = call_level; } }else{ cards.insert(std::make_pair(c.second->m_id, call_card(c.second->m_id, c.second->m_type, call_level, CCT_CALL_APOINT, sid))); } log_info("[anti_coll] card_id=%d, ctype=%d, call_level=%d, call_type_id=%d, site_id=%d",c.second->m_id, c.second->m_type, call_level, CCT_CALL_APOINT, sid); } } } std::string desc = ""; uint64_t id = tool_other::type_id_to_u64(m_type, m_id); if(cards.size() == 0){ // delete event from event_list event_tool::instance()->handle_event(OT_CARD, ET_PERSON_VEHICLE_ANTI_COLLISION, id, 0, 0, false); }else{ size_t i = 0; desc = std::to_string(m_id) + "["; for(auto c : cd) { desc += std::to_string(c.first) + ","; //std::ostringstream buf; //buf<handle_event(OT_CARD, ET_PERSON_VEHICLE_ANTI_COLLISION, id, min_d, cur_v, true, DT_COMMON, desc); } if(cards.size() > 0){ // find the best emengency call int call_level = 6; for(auto c : cards){ if(c.second.call_level_id < call_level){ call_level = c.second.call_level_id; } } cards.insert(std::make_pair(m_id, call_card(m_id, 2, call_level, CCT_CALL_APOINT, sid))); module_call::instance()->send_anti_collision(cards); }else{ //log_info("[anti_coll] no card trigger anti collision rules."); return; } //module_call::instance()->send_anti_collision(cards); } /* * @brief 三率业务处理模块 * @param const point& pt 定位数据 * @return 无 * @note * @warning * @bug * */ void car::handle_three_rates(const point &pt) { card_pos cp; m_biz_stat = get_stat(); cp.biz_stat = m_biz_stat; cp.x = pt.x; cp.y = pt.y; cp.z = pt.z; cp.map_id = m_area_tool->get_mapid(); cp.vibration = m_acc; //put_three_rates(cp); } /* * @brief 红绿灯业务模块 * @param const point& p 定位数据 * @param const int& sid 分站id * @return 无 * @note * @warning * @bug * */ void car::handle_traffic_light(const point& p, const int& sid) { card_pos cp; cp.x = p.x; cp.y = p.y; cp.z = p.z; cp.biz_stat = get_stat(); cp.map_id = m_area_tool->get_mapid(); cp.vibration = m_acc; cp.reader_id = sid; put_traffic_light(cp); } void car::on_timer() { if(!empty()) make_package(); //1.找到73号卡,如果计数小于100,更新速度为40;计数大于100,更新速度为20 if (false) { if (m_cache_nums < 40) { m_cache_nums++; m_speed = 40; } else { m_speed = 20; } } //zmg if (false) { if (m_cid == 82) { if (m_cache_nums < 33) { m_cache_nums++; m_speed = 40; } else { m_speed = 20; } } if (m_cid == 10004) { if (m_cache_nums < 34) { if (m_cache_nums > 0) { m_speed = 40; } m_cache_nums++; } else { m_speed = 20; } } } log_info("[v_over_speed] card_id=10004, speed=%.2f", m_speed); handle_over_speed(); //2.调用业务处理 } int car::get_area() { int status = m_biz_stat; int special_id = -1; if(status == STATUS_LOST) { special_id = special_area_list::instance()->get_special_id(m_id,*this,m_vehicle_category_id); log_info("enter_special_area:%.2f,%2.f,id:%d,special_area_id:%d",x,y,m_id,special_id); } return special_id; } void car::make_package() { sys::_CARD_POS_ cp; loc_point pt = getSmoothPoint(); cp.area_info = m_area_tool->m_area_info; cp.map_id = m_area_tool->get_mapid(); cp.biz_stat = get_stat(); //cp.down_time = m_mine_tool->get_down_time(); cp.work_time = m_mine_tool->get_work_time(); cp.is_on_duty= m_mine_tool->is_on_duty(); cp.down_time = m_last_point.x; cp.z = m_last_point.y; cp.cell_index = m_cell_index; pt.x = m_pt.x; pt.y = m_pt.y; upt_card_pos(cp, pt); uint64_t _now = tool_time::now_to_ms(); pt.m_time = _now; make_his_location(pt.m_time, pt); uint64_t t = _now>m_timeval?_now-m_timeval:m_timeval-_now; if(t>10*1000) { m_area_tool->on_point(shared_from_this(),pt); m_biz_stat=get_stat(); } } void car::get_card(bool f) { if(f) mine_business::inst()->put(shared_from_this()); } loc_point car::getSmoothPoint() { loc_point lp = m_smo_tool->smooth_strategy(); //zmg //m_speed = lp.m_speed; //m_stat = lp.m_stat; lp.y = -lp.y; return lp; }