server-l-zmg/card_car.cpp

#include <sstream>
#include "card_car.h"
#include "card_message_handle.h"
#include "his_location.h"
#include "area.h"
#include "mine.h"
#include "three_rates.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 "ya_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_his_location_card.reset(new location_vehicle(m_id,m_type,cid));
}

car::~car(){}

std::shared_ptr<mine_tool> 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);
}

void car::do_business(const std::shared_ptr<site>&site,const point &pt,double acc)
{
	m_acc=acc;
	m_area_tool->on_point(shared_from_this(),pt);
	m_timeval = m_time;
    //log_info("[anti_coll] m_id = %d, m_timeval = %lld", m_id, m_timeval);
	handle_three_rates(pt);
    handle_traffic_light(pt);
    if(m_enable_anti_collision){
        handle_anti_coll(pt, site->m_id);
    }
	uint64_t id=tool_other::type_id_to_u64(m_type,m_id);
	mine_business::inst()->make_arg(id,pt,m_time);
}

int car::get_vehicle_type_id()
{
	return m_vehicle_type_id;
}

void car::handle_anti_coll(const point& pt, const int& sid)
{
    //log_info("[anti_coll] handle anti collision");   
    // 车卡下发最紧急的呼叫类型
    std::map<int, float> cd;    // 人卡与车卡的距离，key为人卡id，value为距离
    std::map<int, call_card> cards;
    auto tmp_cards = card_list::instance()->m_map; 

    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;
            }
            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 = ((c.second->m_timeval >= m_timeval ? (c.second->m_timeval - m_timeval) : (m_timeval - c.second->m_timeval)) /1000.0 <= 30);
            float dist = pt.dist(*c.second);
            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 = "";
    if(cards.size() == 0){
        // delete event from event_list
        event_tool::instance()->handle_event(OT_CARD, ET_PERSON_VEHICLE_ANTI_COLLISION, m_id, 0, 0, false);
    }else{
        size_t i = 0;
        for(auto c : cd)
        {
            desc += std::to_string(c.first);
            std::ostringstream buf;
            buf<<c.second;
            desc += "," + buf.str();
            if(i != (cards.size() - 1)){
                desc += ";";
            }
            ++i;
        }
        log_info("[anti_coll] the distance's list between person and vehicle : %s", desc.c_str());
        event_tool::instance()->handle_event(OT_CARD, ET_PERSON_VEHICLE_ANTI_COLLISION, m_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)));
    }else{
        log_info("[anti_coll] no card trigger anti collision rules.");
        return;
    } 

    module_call::instance()->send_anti_collision(cards);
}

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;	
	//const auto lm = m_area_tool->getLandmark();
    //cp.enter_time = std::get<0>(lm)*1000;
    //cp.area_id = std::get<3>(lm);
	cp.map_id = m_area_tool->get_mapid();
	cp.vibration = m_acc;
	put_three_rates(cp);
}

void car::handle_traffic_light(const point& p)
{
    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;
    put_traffic_light(cp);
}

void car::on_timer()
{
    if(!empty())
	    make_package();
}
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()
{
	YA::_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();
	upt_card_pos(cp,pt);
    make_his_location(pt.m_time,pt);
	uint64_t _now=tool_time::now_to_ms();
	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();
	m_speed = lp.m_speed;
	m_stat  = lp.m_stat;
	lp.y = -lp.y;
	return lp;
}