Hu Chunming / vpt_ascend

#include "MultiSourceProcess.h"
#include "../common/logger.hpp"

#include <string>
#include <queue>
#include <mutex>
#include <chrono>
#include <thread>

#include "../decoder/interface/DecoderManager.h"
#include "../decoder/interface/utiltools.hpp"
#include "../helpers/time_helper.hpp"
#include "../helpers/os_helper.hpp"
#include "../helpers/gen_json.hpp"
#include "../helpers/img_util.h"

#include "../reprocessing_module/save_snapshot_reprocessing.h"

#include "macro_definition.h"
#include "SourceSingleton.hpp"

#include "../util/vpc_util.h"
#include "../util/common_tool.h"

#include "ErrorInfo.h"

// #define VEHICLE_MULTI_BOXES

using namespace std;

map<int, algo_type> index_to_algo_type = {{0, algorithm_type_t::HUMAN_SNAPSHOT},
                                          {1, algorithm_type_t::NONMOTOR_VEHICLE_SNAPSHOT},
                                          {2, algorithm_type_t::NONMOTOR_VEHICLE_SNAPSHOT},
                                          {3, algorithm_type_t::NONMOTOR_VEHICLE_SNAPSHOT},
                                          {4, algorithm_type_t::VEHICLE_SNAPSHOT},
                                          {5, algorithm_type_t::VEHICLE_SNAPSHOT},
                                          {6, algorithm_type_t::VEHICLE_SNAPSHOT},
                                          {7, algorithm_type_t::VEHICLE_SNAPSHOT},
                                          {8, algorithm_type_t::VEHICLE_SNAPSHOT},
                                          {9, algorithm_type_t::FACE_SNAPSHOT}};


struct decode_cbk_userdata{
  string task_id;
  void* opaque;
  void* opaque1;
};


/**
 * 注意： gpuFrame 在解码器设置的显卡上，后续操作要十分注意这一点，尤其是多线程情况
 * */
void post_decod_cbk(const void * userPtr, DeviceMemory* devFrame){
    decode_cbk_userdata* ptr = (decode_cbk_userdata*)userPtr;
    if (ptr!= nullptr)
    {
        CMultiSourceProcess* _this = (CMultiSourceProcess*)ptr->opaque;
        if(nullptr != _this){
            _this->decoded_cbk(devFrame);
        }
    }
}

void decode_finished_cbk(const void * userPtr){
    decode_cbk_userdata* ptr = (decode_cbk_userdata*)userPtr;
    if (ptr!= nullptr)
    {
        CMultiSourceProcess* _this = (CMultiSourceProcess*)ptr->opaque;
        if(nullptr != _this){
            _this->task_finished(ptr->task_id);
        }
    }
    delete ptr;
    ptr = nullptr;
}

CMultiSourceProcess::CMultiSourceProcess(){
  m_timing_snapshot_thread = nullptr;
}

CMultiSourceProcess::~CMultiSourceProcess(){
}

int CMultiSourceProcess::InitAlgorthim(tsl_aiplatform_param vptParam){

  set_default_logger(LogLevel(vptParam.log_level), "multi_source_process", vptParam.log_path, vptParam.log_mem, vptParam.log_mem);
  LOG_INFO("编译时间：{} {}", __DATE__, __TIME__);

  SourceSingleton::getInstance();

  skip_frame_ = 5; 
  m_batch_size = 20;

  m_devId = vptParam.gpuid;

  VPTProcess_PARAM vparam;
  vparam.gpuid = m_devId;
  vparam.max_batch = m_batch_size;
  vparam.threshold = 0.4;

  aclrtSetDevice(m_devId);

  int ret = vpt_process.init(vparam);
  if (ret < 0){
    return ret;
  }

  m_algorthim_region_leave.init(vptParam.gpuid, algorithm_type_t::HUMAN_LEAVE_REGION);
  m_algorthim_region_dismiss.init(vptParam.gpuid, algorithm_type_t::HUMAN_REGION_DISMISS);
  m_algorthim_region_fastmoving.init(vptParam.gpuid, algorithm_type_t::HUMAN_REGION_FAST_MOVING);

  m_human_gather.init(algorithm_type_t::HUMAN_GATHER);
  m_human_density.init(algorithm_type_t::HUMAN_DENSITY);
  m_human_region_gather.init(algorithm_type_t::HUMAN_REGION_GATHER);
  m_vehicle_gather.init(algorithm_type_t::VEHICLE_GATHER);

  m_task_param_manager = task_param_manager::getInstance();
  m_snapshot_reprocessing = new snapshot_reprocessing(m_devId);
  m_save_snapshot_reprocessing = new save_snapshot_reprocessing(m_devId);

  VPCUtil* pVpcUtil = VPCUtil::getInstance();
  pVpcUtil->init(m_devId);

	m_pAlgorthimThread = new thread([](void* arg) {
		CMultiSourceProcess* process = (CMultiSourceProcess*)arg ;
        process->algorthim_process_thread();
		return (void*)0;
	}
	, this);

  m_timing_snapshot_thread = new std::thread(
        [](void* arg)
        {
            CMultiSourceProcess* _this=(CMultiSourceProcess*)arg;
            if(_this != nullptr){
              _this->timing_snapshot_thread();
            }else{
              LOG_ERROR("定时抓拍线程启动失败 !");
            }
            return (void*)0;
        }, this);
        
  if(nullptr == m_timing_snapshot_thread){
      LOG_ERROR("定时抓拍线程启动失败 !");
  }

  LOG_INFO("InitAlgorthim succeed !");

  return 0;
}

#ifdef POST_USE_RABBITMQ
/* MQ队列的初始化 */
int CMultiSourceProcess::AddMqConn(mq_type_t mq_type, rabbitmq_conn_params_t mq_conn_param) {
  /* 初始化MQ队列 */
  if (!mq_manager_->add_conn(mq_type, mq_conn_param)) {
    LOG_ERROR("Connection MQ failed, ip: {} port: {} uname: {} passwd: {}", mq_conn_param.ip, mq_conn_param.port,
              mq_conn_param.uname, mq_conn_param.passwd);
    return MQ_CONN_ERROR;
  }

  /* 为报警类 绑定回调 传入mq_manager_.publish 内部直接调用*/
  if (mq_type_t::ALARM_MQ == mq_type) {
    if (m_save_snapshot_reprocessing!= nullptr) {
      m_save_snapshot_reprocessing->set_callback(
        std::bind(&mq::Manager::publish, mq_manager_, mq_type, std::placeholders::_1, true));
    }
    

    m_algorthim_region_leave.set_callback(
          std::bind(&mq::Manager::publish, mq_manager_, mq_type, std::placeholders::_1, true));

    m_algorthim_region_dismiss.set_callback(
      std::bind(&mq::Manager::publish, mq_manager_, mq_type, std::placeholders::_1, true));

    m_algorthim_region_fastmoving.set_callback(
      std::bind(&mq::Manager::publish, mq_manager_, mq_type, std::placeholders::_1, true));
  }
    

  return SUCCESS;
}

#endif

/* 获取任务的状态 MQ返回 */
int CMultiSourceProcess::GetTaskStatus(const string taskID) {

  DecoderManager* pDecManager = DecoderManager::getInstance();

  std::vector<std::string> taskids;
  std::vector<int> statues;
  int sta = 0;
  if(pDecManager->isPausing(taskID)){
    taskids.emplace_back(taskID);
    statues.emplace_back(2);
    sta = 2;
  } else if(pDecManager->isRunning(taskID)){
    taskids.emplace_back(taskID);
    statues.emplace_back(1);
    sta = 1;
  } else if(pDecManager->isFinished(taskID)){
    taskids.emplace_back(taskID);
    statues.emplace_back(0);
    sta = 0;
  }

#ifdef POST_USE_RABBITMQ
  if (!taskids.empty()) {
    auto json_str = helpers::gen_json::gen_task_status_json(taskids, statues);
    mq_manager_->publish(mq_type_t::GET_TASK_MQ, json_str.c_str(),true);
  }
#endif

  return sta;
}

bool CMultiSourceProcess::AddTask(task_param _cur_task_param){
    DecoderManager* pDecManager = DecoderManager::getInstance();

    const char* task_id = _cur_task_param.task_id;

    MgrDecConfig config;
    config.name = task_id;
    config.cfg.uri = _cur_task_param.ipc_url;
    config.cfg.post_decoded_cbk = post_decod_cbk;
    config.cfg.decode_finished_cbk = decode_finished_cbk;
    config.cfg.force_tcp = true;  // rtsp用tcp
    config.cfg.gpuid = to_string(m_devId);
    config.cfg.skip_frame = skip_frame_;

    if (1 == _cur_task_param.dec_type){
      config.cfg.port = _cur_task_param.port;
      config.dec_type = DECODER_TYPE_GB28181;
      config.cfg.uri = task_id;
      if(_cur_task_param.protocal == 0){
        // 指定用udp协议
        config.cfg.force_tcp = false;
      }
      config.cfg.request_stream_cbk = _cur_task_param.gb28181_request_stream_callback ;
    }else if (2 == _cur_task_param.dec_type){
      config.dec_type = DECODER_TYPE_DVPP;
    }else {
        config.dec_type = DECODER_TYPE_FFMPEG;
    }
    
    AbstractDecoder* dec = pDecManager->createDecoder(config);
    if (!dec){
        return false;
    }

    decode_cbk_userdata* userPtr = new decode_cbk_userdata;
    userPtr->task_id = string(task_id);
    userPtr->opaque = this;
    userPtr->opaque1 = dec;
    pDecManager->setPostDecArg(config.name, userPtr);
    pDecManager->setFinishedDecArg(config.name, userPtr);
    
    // pDecManager->setDecKeyframe(config.name, true); // 只对关键帧解码
    

    // 保存新添加任务的配置参数
    m_task_param_manager->add_task_param(task_id, _cur_task_param);

    int input_image_width = 0;
    int input_image_height = 0;
    pDecManager->getResolution(config.name, input_image_width, input_image_height);
    LOG_INFO("task_id: {} width: {} height:{}", task_id, input_image_width, input_image_height);

     // 所有参数都准备好之后再启动解码
    bool bStart = pDecManager->startDecodeByName(config.name);
    if (!bStart){
      LOG_INFO("started task {} failed!", config.name);
      pDecManager->closeDecoderByName(config.name);
      return false;
    }

    // 人车物跟踪
    if (task_has_vpt_algor(task_id))
      vpt_process.addTaskTracker(task_id, 1, 1, skip_frame_);

    m_FinishedTaskMtx.lock();
    m_FinishedTaskMap[task_id] = false;
    m_FinishedTaskMtx.unlock();

    auto algor_map = m_task_param_manager->get_task_other_param(task_id);
    if (algor_map != nullptr){
      /* 如果开启了行人 机动车非法闯入功能 生成闯入区域mask */
      if (algor_map->find(algorithm_type_t::PEDESTRIAN_TRESPASS) != algor_map->end()) {
        pedestrian_vehicle_trespass_.pedestrianvehicletrespass_init_region(
            task_id, algorithm_type_t::PEDESTRIAN_TRESPASS, input_image_width, input_image_height);
      }

      if (algor_map->find(algorithm_type_t::VEHICLE_TRESPASS) != algor_map->end()) {
        pedestrian_vehicle_trespass_.pedestrianvehicletrespass_init_region(
            task_id, algorithm_type_t::VEHICLE_TRESPASS, input_image_width, input_image_height);
      }

      // 设置定时截图的时间间隔
      auto algor = algor_map->find(algorithm_type_t::VIDEO_TIMING_SNAPSHOT);
      if(algor != algor_map->end()){
        task_param_manager::algo_param_type_t_* cur_task_params = algor->second;
        if(cur_task_params){
          int frame_stride = ((algor_config_video_timing_snapshot*)cur_task_params->algor_param)->frame_stride;
          LOG_INFO("task {} snap time interval: {} s", config.name, frame_stride);
          // 单位是ms, 乘以 1000 编成s
          dec->setSnapTimeInterval(frame_stride * 1000);
        }
      }
    }
    
    LOG_INFO("started task {} successed!", config.name);

    return true;
}

bool CMultiSourceProcess::task_has_vpt_algor(const std::string &task_id){
    //! TODO: create enum iterator.
    auto algor_map = m_task_param_manager->get_task_other_param(task_id);
    if (algor_map == nullptr)
      return false;

    return (algor_map->find(algorithm_type_t::HUMAN_GATHER) != algor_map->end() ||
            algor_map->find(algorithm_type_t::HUMAN_SNAPSHOT) != algor_map->end() ||
            algor_map->find(algorithm_type_t::NONMOTOR_VEHICLE_SNAPSHOT) != algor_map->end() ||
            algor_map->find(algorithm_type_t::SMOKING_DET) != algor_map->end() ||
            algor_map->find(algorithm_type_t::NO_REFLECTIVE_CLOTHING) != algor_map->end() ||
            algor_map->find(algorithm_type_t::NO_SAFETY_HELMET) != algor_map->end() ||
            algor_map->find(algorithm_type_t::CALL_PHONE_DET) != algor_map->end() ||
            algor_map->find(algorithm_type_t::VEHICLE_SNAPSHOT) != algor_map->end() ||
            algor_map->find(algorithm_type_t::TAKEAWAY_MEMBER_CLASSIFICATION) != algor_map->end() ||
            algor_map->find(algorithm_type_t::PEDESTRIAN_FALL) != algor_map->end() ||
            algor_map->find(algorithm_type_t::PEDESTRIAN_FIGHT) != algor_map->end() ||
            algor_map->find(algorithm_type_t::PEDESTRIAN_RETROGRADE) != algor_map->end() ||
            algor_map->find(algorithm_type_t::VEHICLE_RETROGRADE) != algor_map->end() ||
            algor_map->find(algorithm_type_t::PEDESTRIAN_TRESPASS) != algor_map->end() ||
            algor_map->find(algorithm_type_t::VEHICLE_TRESPASS) != algor_map->end());
}

void CMultiSourceProcess::decoded_cbk(DeviceMemory* devFrame){

  do{
    if(m_bfinish){
      break;
    }
    m_DataListMtx.lock();
    if(m_RgbDataList.size() >= 30){
      m_DataListMtx.unlock();
      std::this_thread::sleep_for(std::chrono::milliseconds(3));
      continue;
    }
    m_RgbDataList.push_back(devFrame);
    m_DataListMtx.unlock();
    break;
  }while (true);
}

void CMultiSourceProcess::task_finished(const string task_id){

  std::lock_guard<std::mutex> l(m_FinishedTaskMtx);

  m_FinishedTaskMap[task_id] = true;

  LOG_INFO("task {} finished!", task_id);
}

bool CMultiSourceProcess::PauseTask(const string taskID){
    return false;
}

bool CMultiSourceProcess::RestartTask(const string taskID){
    return false;
}

bool CMultiSourceProcess::FinishTask(const string taskID){
    DecoderManager* pDecManager = DecoderManager::getInstance();
    return pDecManager->closeDecoderByName(taskID);
}

int CMultiSourceProcess::SnapShot(task_param param){
    return 0;
}

void CMultiSourceProcess::CloseAllTask(){
    m_bfinish = true;

    DecoderManager* pDecManager = DecoderManager::getInstance();
    pDecManager->closeAllDecoder();
    
    if(m_pAlgorthimThread){
        m_pAlgorthimThread->join();
        m_pAlgorthimThread = nullptr;
    }

    if(m_timing_snapshot_thread != nullptr && m_timing_snapshot_thread->joinable()){
      m_timing_snapshot_thread->join();
      m_timing_snapshot_thread = nullptr;
    }

    m_DataListMtx.lock();
    while (!m_RgbDataList.empty()){
        DeviceMemory* gpuMem = m_RgbDataList.front();
        delete gpuMem;
        gpuMem = nullptr;
        m_RgbDataList.pop_front();
    }
    m_DataListMtx.unlock();

    int size = m_RgbDataList.size();
    bool bEmpty = m_RgbDataList.empty();
    
    LOG_INFO("CloseAllTask exit.");
}

void CMultiSourceProcess::clear_finished_task(){// 清理已经结束的任务

  std::lock_guard<std::mutex> l1(m_FinishedTaskMtx);
  std::lock_guard<std::mutex> l2(m_DataListMtx);

  for (auto iter_finished = m_FinishedTaskMap.begin(); iter_finished!=m_FinishedTaskMap.end(); ){
    if(iter_finished->second){
      // 解码已经结束
      // 判断数据对列中是否还有数据
      string task_id = iter_finished->first;
      bool bFinished = true;
      for (auto iter = m_RgbDataList.begin(); iter!=m_RgbDataList.end(); ++ iter){
        DeviceMemory* gpuMem = *iter;
        if(task_id == gpuMem->getId()){
          bFinished = false;
          break;
        }
      }

      if (bFinished){
        // 解码器已经结束，且数据队列中没有改任务的数据，则做最后任务清理工作
        finish_task(task_id,false);
        iter_finished = m_FinishedTaskMap.erase(iter_finished);
        continue;
      }
    }

    ++ iter_finished;
  }
}

bool CMultiSourceProcess::finish_task(const string taskID, const bool delete_snapshot){

  // 任务结束，关闭跟踪
  if (!vpt_process.finishTaskTracker(taskID))
    LOG_ERROR("Finish VPT Tracker failed, task_id: {}", taskID);

#ifdef POST_USE_RABBITMQ
  auto json_str = helpers::gen_json::gen_office_task_heart_beat_json({taskID});
  mq_manager_->publish(mq_type_t::HEART_BEAT_MQ, json_str.c_str(), true);
#endif

#ifdef WITH_SECOND_PROCESS
  pedestrian_vehicle_retrograde_.force_release_result(taskID); //221024 byzsh
#endif

  m_TotalObjMtx.lock();
  for(auto ss = m_total_obj_info.begin(); ss != m_total_obj_info.end(); ) {
		if (strcmp(ss->first.video_id.c_str(), taskID.c_str()) == 0) {
			vector<sy_point>().swap(ss->second.center_points);
			m_total_obj_info.erase(ss++);
		}
		else ss++;
	}
  m_TotalObjMtx.unlock();

  m_task_param_manager->delete_task_param(taskID);

  return true;
}

int CMultiSourceProcess::algorthim_process_thread(){
    LOG_INFO("algorthim_process_thread start...");

    ACL_CALL(aclrtSetDevice(m_devId), ACL_ERROR_NONE, 1);
    aclrtContext ctx;
    ACL_CALL(aclrtCreateContext(&ctx, m_devId), ACL_ERROR_NONE, 1);

    while (true){
        if(m_bfinish){
            break;
        }

        clear_finished_task();

        vector<DeviceMemory*> vec_gpuMem;
        m_DataListMtx.lock();
        while (!m_RgbDataList.empty()){
            DeviceMemory* gpuMem = m_RgbDataList.front();
            if(gpuMem->getMem() == nullptr){
              // 错误数据，直接删除
              delete gpuMem;
              gpuMem = nullptr;
              LOG_WARN("mem is null");
            } else {
              vec_gpuMem.push_back(gpuMem);
            }
            m_RgbDataList.pop_front();
            if(vec_gpuMem.size() >= m_batch_size){
                break;
            }
        }
        m_DataListMtx.unlock();

        if(vec_gpuMem.size() <= 0){
            std::this_thread::sleep_for(std::chrono::milliseconds(3));
            continue;
        }

        aclrtSetCurrentContext(ctx);
        algorthim_vpt(vec_gpuMem);

        for(int i=0;i < vec_gpuMem.size(); i++){
            DeviceMemory* mem = vec_gpuMem[i];
            if(mem->getSize() <= 0){
              continue;
            }
            delete mem;
            mem = nullptr;
        }
        vec_gpuMem.clear();

    }
    
    aclrtDestroyContext(ctx);

    LOG_INFO("algorthim_process_thread exit.");

    return 0;
}

int CMultiSourceProcess::algorthim_vpt(vector<DeviceMemory*> vec_gpuMem){

    vector<string> vpt_interest_task_id;
    vector<sy_img> vpt_interest_imgs;
    vector<DeviceMemory*> vec_vptMem;
    for (int i = 0; i < vec_gpuMem.size(); i++) {
        DeviceMemory* mem = vec_gpuMem[i];
        if (!task_has_vpt_algor(mem->getId())){
            continue;
        }

        sy_img img;
        img.w_ = mem->getWidth();
        img.h_ = mem->getHeight();
        img.c_ = mem->getChannel();
        img.data_ = mem->getMem();
        vpt_interest_imgs.push_back(img);
        vpt_interest_task_id.push_back(mem->getId());
        vec_vptMem.push_back(mem);
    }

    /* 待检测的图片不为空 开始检测 */
    if (!vpt_interest_imgs.empty()) {
      vector<vector<int>> deleteObjectID;
      deleteObjectID.resize(vpt_interest_task_id.size());
      vector<vector<onelevel_det_result>> unUsedResult;
      vector<onelevel_det_result> vptResult(0);

      /* 一级检测器，内部已完成跟踪操作 */
      vpt_process.process_gpu(vpt_interest_imgs.data(), vpt_interest_task_id, vptResult, deleteObjectID, unUsedResult); // do det & track.

      gather_process(vec_vptMem, vptResult, algorithm_type_t::HUMAN_GATHER); // modified by zsh
      gather_process(vec_vptMem, vptResult, algorithm_type_t::HUMAN_DENSITY);
      gather_process(vec_vptMem, vptResult, algorithm_type_t::HUMAN_REGION_GATHER);
      gather_process(vec_vptMem, vptResult, algorithm_type_t::VEHICLE_GATHER);

      m_snapshot_reprocessing->screen_effective_snapshot(vptResult); 

#ifndef VEHICLE_MULTI_BOXES
      /* 快照优选（内部可实现不同的快照优选策略） */
      m_snapshot_reprocessing->update_bestsnapshot(vec_vptMem, vptResult, deleteObjectID);
      /*  for snapshot algorithm. 轨迹结束目标 做最后的结果返回（当前返回算法结果+快照保存路径）*/
      vehicle_snapshot(vpt_interest_task_id, deleteObjectID);
#else
      algorithm_vehicle_relult(vec_vptMem, vptResult, deleteObjectID);

      send_locus_finished_msg(vpt_interest_task_id, deleteObjectID);
#endif

// #ifdef WITH_SECOND_PROCESS
    /* for pedestrian safety det. 行人安全分析算法模块 */
    // algorthim_pedestrian_safety(vpt_interest_task_id, vpt_interest_imgs,vptResult);

    // 逆行
    algorthim_retrograde(vpt_interest_task_id, vec_vptMem, vptResult);
    retrograde_snapshot(vpt_interest_task_id, deleteObjectID);
    // 闯入
    algorthim_trespass(vpt_interest_task_id, vec_vptMem, vptResult, deleteObjectID);
    trespass_snapshot(vpt_interest_task_id, deleteObjectID);

// #endif

    m_algorthim_region_leave.process(vec_vptMem, vptResult, deleteObjectID);
    m_algorthim_region_dismiss.process(vec_vptMem, vptResult, deleteObjectID);
    m_algorthim_region_fastmoving.process(vec_vptMem, vptResult, deleteObjectID);

    cross_line_process(vec_vptMem, vptResult, algorithm_type_t::HUMAN_CROSSING_LINE);
    cross_line_process(vec_vptMem, vptResult, algorithm_type_t::HUMAN_CLIMB);
    cross_line_process(vec_vptMem, vptResult, algorithm_type_t::VEHICLE_ILLEGAL_CROSSING_LINE);

    wander_detect(vec_vptMem, vptResult, algorithm_type_t::HUMAN_LINGER);
    wander_detect(vec_vptMem, vptResult, algorithm_type_t::VEHICLE_ILLEGAL_PARKING);
    // 轨迹记录
    trace_record(vec_vptMem, vptResult);

      if(vptResult.size() > 0){
          cout << vptResult[0].obj_count<< endl;
      }
      vptResult.clear();
      unUsedResult.clear();
      deleteObjectID.clear();
    }

    vec_vptMem.clear();
    vpt_interest_task_id.clear();
    vpt_interest_imgs.clear();

    return 0;
}

// 轨迹记录
void CMultiSourceProcess::trace_record(vector<DeviceMemory*>& vec_gpuMem, vector<onelevel_det_result>& vptResult) {

  for (size_t bidx = 0; bidx < vec_gpuMem.size(); bidx++){
    DeviceMemory* gpuMem = vec_gpuMem[bidx];
    string task_id = gpuMem->getId();

    for (int c = 0; c < vptResult[bidx].obj_count; c++) {    
      //计算检测框坐标中心点
      sy_point center_point;
      center_point.x_ = vptResult[bidx].obj[c].left + (vptResult[bidx].obj[c].right - vptResult[bidx].obj[c].left) * 0.5;
      // center_point.y_ = vptResult[bidx].obj[c].top + (vptResult[bidx].obj[c].bottom - vptResult[bidx].obj[c].top) * 0.85; 
      center_point.y_ = vptResult[bidx].obj[c].bottom;  // 越线检测以脚越线为标准

      OBJ_KEY new_obj = { task_id, vptResult[bidx].obj[c].id };
      m_TotalObjMtx.lock();
      auto it = m_total_obj_info.find(new_obj);
      if (it == m_total_obj_info.end())
      {
        m_total_obj_info[new_obj].last_frame_nb = gpuMem->getFrameNb();
	      m_total_obj_info[new_obj].last_ts = gpuMem->getTimesstamp();
      }
      m_total_obj_info[new_obj].index = vptResult[bidx].obj[c].index;
      m_total_obj_info[new_obj].center_points.push_back(center_point);
      m_TotalObjMtx.unlock();
    }
  }
}

int CMultiSourceProcess::algorithm_vehicle_relult(vector<DeviceMemory*> vec_devMem, vector<onelevel_det_result>& vptResult, vector<vector<int>>& delete_object_id) {
  
  vector<multi_obj_data_t> results = m_snapshot_reprocessing->get_vehicle_snapshot(vec_devMem, vptResult, skip_frame_);

  VPCUtil* pVPCUtil = VPCUtil::getInstance();
  for (auto &result : results) {
    if(result.objs.size() <= 0){
      continue;
    }
    auto task_id = result.task_id;
    auto task_other_params = m_task_param_manager->get_task_other_param(task_id);
    const auto &algor_other_params = task_other_params->find(algorithm_type_t::VEHICLE_SNAPSHOT);
    if (algor_other_params == task_other_params->end()) {
      LOG_ERROR("[Error] taskId {} not found algor {}", task_id.c_str(), (int)algorithm_type_t::VEHICLE_SNAPSHOT);
      continue;
    }
    const algor_basic_config_param_t *basic_param = algor_other_params->second->basic_param;

    std::string cur_timestamp_ms =  std::to_string(helpers::timer::get_cur_time_ms());
    const std::string fpath_origin = basic_param->result_folder + helpers::os::sep + task_id + "_" +
                                  std::to_string(result.objs.size()) + "_" + std::to_string(result.id) + "_" + cur_timestamp_ms + ".jpg";

    ImgSaveInfo saveInfo;
    saveInfo.file_path = fpath_origin;
    saveInfo.img_info = VPCUtil::vpc_devMem2vpcImg(result.memPtr);
    m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(saveInfo);

    vector<vpc_img_info> vec_obj_info_list = pVPCUtil->crop_batch(result.memPtr, result.objs);
    if(vec_obj_info_list.size() != result.objs.size()){
      LOG_ERROR("vpc_crop size error !");
      VPCUtil::vpc_imgList_release(vec_obj_info_list);
      continue;
    }

    // 保存抠图并发MQ
    for(int i =0; i < result.objs.size(); i++){
      video_object_info obj = result.objs[i];

      std::string cur_timestamp_ms = std::to_string(helpers::timer::get_cur_time_ms());
      const std::string fpath_roi = basic_param->result_folder_little + helpers::os::sep + task_id + "_" +
                              std::to_string(obj.object_id) + "_" + cur_timestamp_ms + ".jpg";
        
      video_object_snapshot new_obj_ss_info;
      new_obj_ss_info.analysisRes = nullptr;
      new_obj_ss_info.object_id = obj.object_id;
      new_obj_ss_info.obj_info.set_data(obj.index, obj.confidence, obj.left, obj.top, obj.right, obj.bottom);
      strcpy(new_obj_ss_info.task_id, task_id.c_str());
      strcpy(new_obj_ss_info.video_image_path, fpath_origin.c_str());
      strcpy(new_obj_ss_info.snapshot_image_path, fpath_roi.c_str());
      new_obj_ss_info.nFinished = 0;
      string json_str = helpers::gen_json::gen_multi_obj_json(algorithm_type_t::VEHICLE_SNAPSHOT, new_obj_ss_info);

      ImgSaveInfo save_info;
      save_info.file_path = fpath_roi;
      save_info.img_info = vec_obj_info_list[i];
      save_info.json_str = json_str;
      m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(save_info);

      OBJ_KEY obj_key{task_id, obj.object_id};
      // 保存有轨迹的object记录，轨迹结束时需要发消息
      std::lock_guard<std::mutex> l(m_total_mutex);
			m_total_snapshot_info_multi_object.insert(obj_key);
    }

    vec_obj_info_list.clear();
  }

  return 0;
}

void CMultiSourceProcess::send_locus_finished_msg(vector<string>& vpt_interest_task_id, vector<vector<int>> deleteObjectID){
  auto task_iter = vpt_interest_task_id.begin();

  for (int i = 0; i < deleteObjectID.size(); i++, ++task_iter) // loop taskId.
  {
    string task_id = *task_iter;
    for (int &j : deleteObjectID[i]) // loop algor type.
    {
      OBJ_KEY obj_key = {task_id, j};

      auto task_param_ptr = m_task_param_manager->get_task_algor_param(task_id);

      // 该路任务开启了抓拍功能 开始抓拍保存；若未开启抓拍，清空显存资源
      if (task_param_ptr->vehicle_algors.find(algorithm_type_t::VEHICLE_SNAPSHOT) != task_param_ptr->vehicle_algors.end()) {
        std::lock_guard<std::mutex> l(m_total_mutex);
        if (m_total_snapshot_info_multi_object.find(obj_key) != m_total_snapshot_info_multi_object.end()) {
          video_object_snapshot new_obj_ss_info;
          new_obj_ss_info.object_id = j;
          new_obj_ss_info.nFinished = 1;
          strcpy(new_obj_ss_info.task_id, task_id.c_str());
          string json_str = helpers::gen_json::gen_multi_obj_json(algorithm_type_t::VEHICLE_SNAPSHOT, new_obj_ss_info);
          // 通知结束的轨迹
          ImgSaveInfo save_info;
          save_info.json_str = json_str;
          m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(save_info);

          m_total_snapshot_info_multi_object.erase(obj_key);
        }
      }
    }
  }
}

// for snapshot algorithm. 轨迹结束目标 做最后的结果返回（当前返回算法结果+快照保存路径）
void CMultiSourceProcess::vehicle_snapshot(vector<string>& vpt_interest_task_id, vector<vector<int>> deleteObjectID) {
  auto task_iter = vpt_interest_task_id.begin();

  for (int i = 0; i < deleteObjectID.size(); i++, ++task_iter) // loop taskId.
  {
    for (int &j : deleteObjectID[i]) // loop algor type.
    {
      OBJ_KEY obj_key = {*task_iter, j};
      // 该路任务开启了抓拍功能 开始抓拍保存；若未开启抓拍，清空显存资源
      vehicle_locus_finished(obj_key);
    }
  }
}

void CMultiSourceProcess::vehicle_locus_finished(const OBJ_KEY obj_key) {
  auto task_param_ptr = m_task_param_manager->get_task_algor_param(obj_key.video_id);
  auto task_other_param_ptr = m_task_param_manager->get_task_other_param(obj_key.video_id);

  // 该路任务开启了抓拍功能 开始抓拍保存；若未开启抓拍，清空显存资源
  if ((task_param_ptr->human_algors.find(algorithm_type_t::HUMAN_SNAPSHOT) == task_param_ptr->human_algors.end() &&
       task_param_ptr->vehicle_algors.find(algorithm_type_t::VEHICLE_SNAPSHOT) != task_param_ptr->vehicle_algors.end() &&
       task_param_ptr->nonmotor_vehicle_algors.find(algorithm_type_t::NONMOTOR_VEHICLE_SNAPSHOT) != task_param_ptr->nonmotor_vehicle_algors.end())) {
    return;
  }

  map<OBJ_KEY, OBJ_VALUE> _total_snapshot_info = m_snapshot_reprocessing->get_total_snapshot_info();

  LOG_DEBUG("_total_snapshot_info size: {}", _total_snapshot_info.size());

  if (_total_snapshot_info.find(obj_key) == _total_snapshot_info.end()) {
    return;
  }

  const OBJ_VALUE obj_value = _total_snapshot_info[obj_key];
  auto task_other_param = m_task_param_manager->get_task_other_params()[obj_key.video_id];

  auto algor_type = index_to_algo_type[obj_value.index.index];

  auto algor_param = (algor_config_param_snapshot *)task_other_param[algor_type]->algor_param;
  if (obj_value.confidence <= algor_param->threshold) {
    LOG_DEBUG("Snapshot conf filter ({} vs {})", obj_value.confidence, algor_param->threshold);
    // 删除记录，同时释放显存
    m_snapshot_reprocessing->release_finished_locus_snapshot(obj_key.video_id, obj_key.obj_id, true); 
    return;
  }

  const algor_basic_config_param_t *cur_param = task_other_param[algor_type]->basic_param;

  // 原图
  std::string cur_timestamp_ms =  std::to_string(helpers::timer::get_cur_time_ms());
  std::string fpath_origin = std::string(cur_param->result_folder) + helpers::os::sep + obj_key.video_id + "_" +
                              std::to_string(obj_key.obj_id) + "_" + cur_timestamp_ms + ".jpg";
                                
  ImgSaveInfo origin_save_info;
  origin_save_info.file_path = fpath_origin;
  origin_save_info.img_info = obj_value.snapShot;
  origin_save_info.obj_rect = obj_value.obj_pos;
  m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(origin_save_info);

  {
    // 抠图
    string json_str = "";
    std::string cur_timestamp_ms =  std::to_string(helpers::timer::get_timestamp<std::chrono::milliseconds>());
    string object_file_name = std::string(cur_param->result_folder_little) + helpers::os::sep + obj_key.video_id + "_" +
                          std::to_string(obj_key.obj_id) + "_" + cur_timestamp_ms + ".jpg";

#ifdef POST_USE_RABBITMQ
    video_object_snapshot new_obj_ss_info;
    new_obj_ss_info.analysisRes = nullptr;
    new_obj_ss_info.object_id = obj_key.obj_id;
    new_obj_ss_info.obj_info.set_data(obj_value.index.index, obj_value.confidence, obj_value.obj_pos.left_,
                                      obj_value.obj_pos.top_, obj_value.obj_pos.left_ + obj_value.obj_pos.width_,
                                      obj_value.obj_pos.top_ + obj_value.obj_pos.height_);
    strcpy(new_obj_ss_info.task_id, obj_key.video_id.c_str());
    strcpy(new_obj_ss_info.video_image_path, fpath_origin.c_str());
    strcpy(new_obj_ss_info.snapshot_image_path, object_file_name.c_str());
    json_str = helpers::gen_json::gen_snapshot_json(algor_type, new_obj_ss_info);
#endif
                                  
    ImgSaveInfo obj_save_info;
    obj_save_info.file_path = object_file_name;
    obj_save_info.img_info = obj_value.snapShotLittle;
    obj_save_info.json_str = json_str;
    m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(obj_save_info);
  }
  
  // 仅删除记录，显存会在保存线程中删除
  m_snapshot_reprocessing->release_finished_locus_snapshot(obj_key.video_id, obj_key.obj_id, false); 

}

void CMultiSourceProcess::timing_snapshot_thread(){
  LOG_INFO("timing_snapshot_thread start.");

  jpegUtil.jpeg_init(m_devId);

  DecoderManager* pDecManager = DecoderManager::getInstance();
  while(!m_bfinish){
    vector<DeviceMemory*> vec_devMem = pDecManager->timing_snapshot_all();
    for (auto devMem : vec_devMem){
      auto task_id = devMem->getId();
      auto task_other_params = m_task_param_manager->get_task_other_param(task_id);
      if (task_other_params == nullptr) 
        continue;
      const auto &algor_other_params = task_other_params->find(algorithm_type_t::VIDEO_TIMING_SNAPSHOT);
      if(algor_other_params != task_other_params->end()){
        const algor_basic_config_param_t *basic_param = algor_other_params->second->basic_param;
        std::string cur_timestamp_ms =  std::to_string(devMem->getTimesstamp());
        const std::string fpath_ori = basic_param->result_folder + helpers::os::sep + task_id + "_" + cur_timestamp_ms + ".jpg";

        // LOG_DEBUG("snapshot save path: {}", fpath_ori.c_str());

        acldvppPicDesc *vpcDesc= acldvppCreatePicDesc();
        acldvppSetPicDescData(vpcDesc, devMem->getMem()); 
        acldvppSetPicDescFormat(vpcDesc, PIXEL_FORMAT_YUV_SEMIPLANAR_420);
        acldvppSetPicDescWidth(vpcDesc, devMem->getWidth());
        acldvppSetPicDescHeight(vpcDesc, devMem->getHeight());
        acldvppSetPicDescWidthStride(vpcDesc, devMem->getWidthStride());
        acldvppSetPicDescHeightStride(vpcDesc, devMem->getHeightStride());
        acldvppSetPicDescSize(vpcDesc, devMem->getSize());

        jpegUtil.jpeg_encode(vpcDesc, fpath_ori);

        acldvppDestroyPicDesc(vpcDesc);

    #ifdef POST_USE_RABBITMQ
        auto json_str = helpers::gen_json::gen_vtsnapshot_json(task_id, fpath_ori);
        mq_manager_->publish(mq_type_t::TIMING_SCREENSHORT_TASK_MQ, json_str.c_str(), true);
    #endif
      }
    }

    for(auto devMem : vec_devMem){
      delete devMem;
      devMem = nullptr;
    }
    vec_devMem.clear();

    std::this_thread::sleep_for(std::chrono::milliseconds(600));
  }

  jpegUtil.jpeg_release();

  LOG_INFO("timing_snapshot_thread end.");
}

// 逆行
void CMultiSourceProcess::algorthim_retrograde(vector<string>& vpt_interest_task_id, vector<DeviceMemory*> vpt_interest_imgs, 
                                            vector<onelevel_det_result>& vptResult){
  vector<string> interest_task_id;
  vector<onelevel_det_result> interest_vpt_result;
  vector<DeviceMemory*> interest_imgs;  

  int _idx = 0;
  for (auto _task_id_iter = vpt_interest_task_id.begin(); _task_id_iter != vpt_interest_task_id.end();
        ++_task_id_iter, ++_idx) // loop task_id;
  {
    auto task_id = *_task_id_iter;
    auto algor_map = m_task_param_manager->get_task_other_param(task_id);

    if (algor_map->find(algorithm_type_t::PEDESTRIAN_RETROGRADE) != algor_map->end() ||
        algor_map->find(algorithm_type_t::VEHICLE_RETROGRADE) != algor_map->end()) {
      interest_task_id.emplace_back(task_id);
      interest_imgs.emplace_back(vpt_interest_imgs[_idx]);
      interest_vpt_result.emplace_back(vptResult[_idx]);
    }
  }

  LOG_DEBUG("retrograde interest_vpt_result size: {}", interest_vpt_result.size());

  if (!interest_imgs.empty()){
    pedestrian_vehicle_retrograde_.update_mstreams(interest_task_id, interest_imgs, interest_vpt_result);
  }
}

// 闯入
void CMultiSourceProcess::algorthim_trespass(vector<string>& vpt_interest_task_id, vector<DeviceMemory*> vpt_interest_imgs, 
                                            vector<onelevel_det_result>& vptResult ,vector<vector<int>>& deleteObjectID){

  vector<string> trespass_interest_task_id;
  vector<onelevel_det_result> trespass_interest_vpt_result;
  vector<vector<int>> trespass_interest_deleteobjs;
  vector<DeviceMemory*> trespass_interest_imgs;

  int _idx = 0;
  for (auto _task_id_iter = vpt_interest_task_id.begin(); _task_id_iter != vpt_interest_task_id.end();
        ++_task_id_iter, ++_idx) // loop task_id;
  {
    auto task_id = *_task_id_iter;
    auto algor_map = m_task_param_manager->get_task_other_param(task_id);

    if (algor_map->find(algorithm_type_t::PEDESTRIAN_TRESPASS) != algor_map->end() ||
        algor_map->find(algorithm_type_t::VEHICLE_TRESPASS) != algor_map->end()) {
      trespass_interest_task_id.emplace_back(task_id);
      trespass_interest_imgs.emplace_back(vpt_interest_imgs[_idx]);
      trespass_interest_vpt_result.emplace_back(vptResult[_idx]);
      trespass_interest_deleteobjs.emplace_back(deleteObjectID[_idx]);
    }
  }

  LOG_DEBUG("trespass interest_vpt_result size: {}", trespass_interest_vpt_result.size());

  if (!trespass_interest_imgs.empty()) {
    pedestrian_vehicle_trespass_.update_mstreams( trespass_interest_task_id, trespass_interest_imgs, 
                                                      trespass_interest_vpt_result, trespass_interest_deleteobjs);
  }
}


// for snapshot algorithm. 轨迹结束目标 做最后的结果返回（当前返回算法结果+快照保存路径）
void CMultiSourceProcess::retrograde_snapshot(vector<string>& vpt_interest_task_id, vector<vector<int>> deleteObjectID) {
  auto task_iter = vpt_interest_task_id.begin();

  for (int i = 0; i < deleteObjectID.size(); i++, ++task_iter) // loop taskId.
  {
    for (int &j : deleteObjectID[i]) // loop algor type.
    {
      OBJ_KEY obj_key = {*task_iter, j};
      auto task_param_ptr = m_task_param_manager->get_task_algor_param(obj_key.video_id);

      /* 开启行人&机动车逆行算法模块，获取该目标的算法分析结果 返回结果+快照 最后释放资源 */
      if (task_param_ptr->human_algors.find(algorithm_type_t::PEDESTRIAN_RETROGRADE) != task_param_ptr->human_algors.end()){
        retrograde_trespass_alarm(obj_key, algorithm_type_t::PEDESTRIAN_RETROGRADE);
      }
      
      if (task_param_ptr->vehicle_algors.find(algorithm_type_t::VEHICLE_RETROGRADE) != task_param_ptr->vehicle_algors.end()){
        retrograde_trespass_alarm(obj_key, algorithm_type_t::VEHICLE_RETROGRADE);
      }
    }
  }
}

// for snapshot algorithm. 轨迹结束目标 做最后的结果返回（当前返回算法结果+快照保存路径）
void CMultiSourceProcess::trespass_snapshot(vector<string>& vpt_interest_task_id, vector<vector<int>> deleteObjectID) {
  auto task_iter = vpt_interest_task_id.begin();

  for (int i = 0; i < deleteObjectID.size(); i++, ++task_iter) // loop taskId.
  {
    for (int &j : deleteObjectID[i]) // loop algor type.
    {
      OBJ_KEY obj_key = {*task_iter, j};
      auto task_param_ptr = m_task_param_manager->get_task_algor_param(obj_key.video_id);

      if (task_param_ptr->human_algors.find(algorithm_type_t::PEDESTRIAN_TRESPASS) != task_param_ptr->human_algors.end()){
        retrograde_trespass_alarm(obj_key, algorithm_type_t::PEDESTRIAN_TRESPASS);
      }
        
      if (task_param_ptr->vehicle_algors.find(algorithm_type_t::VEHICLE_TRESPASS) != task_param_ptr->vehicle_algors.end()){
        retrograde_trespass_alarm(obj_key, algorithm_type_t::VEHICLE_TRESPASS);
      }
    }
  }
}

void CMultiSourceProcess::retrograde_trespass_alarm(const OBJ_KEY &obj_key, const algorithm_type_t &algor_type) {
  
  vector<ai_engine_module::result_data_t> results ;
  if(algor_type == algorithm_type_t::PEDESTRIAN_RETROGRADE || algor_type == algorithm_type_t::VEHICLE_RETROGRADE){
    results = pedestrian_vehicle_retrograde_.get_results_by_id(ai_engine_module::obj_key_t{obj_key.obj_id, obj_key.video_id, algor_type});
  } else if(algor_type == algorithm_type_t::PEDESTRIAN_TRESPASS || algor_type == algorithm_type_t::VEHICLE_TRESPASS){
    results = pedestrian_vehicle_trespass_.get_results_by_id(ai_engine_module::obj_key_t{obj_key.obj_id, obj_key.video_id, algor_type});
  } else {
    return ;
  }
  

  bool bRetroGrade = true ;
  for (unsigned idx = 0; idx < results.size(); ++idx) {
    auto &result = results[idx];

    vpc_img_info src_img;
    src_img.pic_desc = result.origin_img_desc;
    src_img.task_id = obj_key.video_id;

    vpc_img_info roi_img;
    roi_img.pic_desc = result.roi_img_desc;
    roi_img.task_id = obj_key.video_id;
    roi_img.object_id = obj_key.obj_id;

    if(bRetroGrade){
      auto &&json_str = helpers::gen_json::gen_retrograde_json(obj_key.video_id, obj_key.obj_id, result.box, algor_type);
      save_snapshot_process(obj_key, algor_type, src_img, roi_img, idx, json_str);
    } else {
      VPCUtil::vpc_img_release(src_img);
      VPCUtil::vpc_img_release(roi_img);
    }

    if (bRetroGrade == true) {
      bRetroGrade = false;
    }
  }
}

bool CMultiSourceProcess::save_snapshot_process(const OBJ_KEY &obj_key, const algorithm_type_t &algorithm_type, vpc_img_info src_img, vpc_img_info roi_img,
                                       const long long id,const std::string &json_str) {
  auto task_other_params = m_task_param_manager->get_task_other_param(obj_key.video_id);
  const auto &algor_other_params = task_other_params->find(algorithm_type);
  if (algor_other_params == task_other_params->end()) {
    LOG_ERROR("task_id {} not found {} error", obj_key.video_id, int(algorithm_type));
    return false;
  }

  const algor_basic_config_param_t *basic_param = algor_other_params->second->basic_param;

  std::string cur_timestamp_ms =  std::to_string(helpers::timer::get_timestamp<std::chrono::milliseconds>());
  const std::string fpath_origin = basic_param->result_folder + helpers::os::sep + obj_key.video_id + "_" +
                                std::to_string(obj_key.obj_id) + "_" + std::to_string(id) + "_" + cur_timestamp_ms + ".jpg";

  ImgSaveInfo obj_save_info;
  obj_save_info.file_path = fpath_origin;
  obj_save_info.img_info = src_img;
  m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(obj_save_info);

  {
    // 抠图保存
    const std::string fpath_roi = basic_param->result_folder_little + helpers::os::sep + obj_key.video_id + "_" +
                                std::to_string(obj_key.obj_id) + "_" + std::to_string(id) + "_" + cur_timestamp_ms + ".jpg";

    // 调用快照保存后处理模块 将快照保存
    ImgSaveInfo obj_save_info;
    obj_save_info.file_path = fpath_roi;
    obj_save_info.img_info = roi_img;
    obj_save_info.json_str = json_str;
    m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(obj_save_info);
  }

  return true;
}

void CMultiSourceProcess::cross_line_process(vector<DeviceMemory*> vec_gpuMem, vector<onelevel_det_result>& vptResult, algorithm_type_t eType)
{
  map<string, map<algo_type, task_param_manager::algo_param_type_t_*>> && algor_param = m_task_param_manager->get_task_other_params();

	for (int bidx = 0; bidx < vec_gpuMem.size(); ++ bidx) {

    DeviceMemory* gpuMem = vec_gpuMem[bidx];
    string task_id = gpuMem->getId();

    task_param_manager::algo_param_type_t_* cur_task_params = algor_param[task_id][eType];
    if (!cur_task_params)
    {
      continue;
    }
    
    algor_config_param_illegal_crossing_line* algor_param = (algor_config_param_illegal_crossing_line*)cur_task_params->algor_param;
    algor_basic_config_param_t* basic_param = (algor_basic_config_param_t*)cur_task_params->basic_param;
    if (basic_param == nullptr || basic_param->adapt_param == nullptr) {
      continue;
    }
    universal_algor_adapt_param *adapt_param = basic_param->adapt_param;
    
    jxline std_line(algor_param->p1.x_, algor_param->p1.y_, algor_param->p2.x_, algor_param->p2.y_);

    std::string cur_src_ts = std::to_string(helpers::timer::get_timestamp<std::chrono::milliseconds>());
    std::string origin_file_path = basic_param->result_folder + helpers::os::sep + task_id  + "_origin_" + cur_src_ts + ".jpg";

    std::vector<box_t> boxes;
    for (int c = 0; c < vptResult[bidx].obj_count; c++) {
      auto& obj_c = vptResult[bidx].obj[c];

      bool bHuman = eType == algorithm_type_t::HUMAN_CROSSING_LINE || eType == algorithm_type_t::HUMAN_CLIMB;

      bool bCount = false;
      if(bHuman && obj_c.index == (int)det_class_label_t::HUMAN) {
        bCount = true;
      } else if (eType == algorithm_type_t::VEHICLE_ILLEGAL_CROSSING_LINE && obj_c.index >= 4 && obj_c.index <= 8) {
        bCount = true;
      }

      sy_point center;
      center.x_ = (obj_c.right + obj_c.left)/ 2 ;
      center.y_ = (obj_c.bottom + obj_c.top) / 2;
      if (!bCount || !common::isInPolygon(adapt_param->points, adapt_param->points_count, center)) {
        continue;
      }

      if (obj_c.confidence < algor_param->conf_threshold)
      {
        continue;
      }

      int obj_width = obj_c.right - obj_c.left;
      int obj_height = obj_c.right - obj_c.left; 
      if (obj_width < algor_param->minmum_width || obj_height < algor_param->minmum_height)
      {
        continue;
      }

      //计算检测框坐标中心点
      sy_point center_point;
      center_point.x_ = obj_c.left + (obj_c.right - obj_c.left) * 0.5;
      center_point.y_ = obj_c.bottom; 

      m_TotalObjMtx.lock();

      OBJ_KEY obj_key = { task_id, obj_c.id };
      auto it = m_total_obj_info.find(obj_key);
      if (it != m_total_obj_info.end())
      {
        vector<sy_point> center_points = m_total_obj_info[obj_key].center_points;
        sy_point last_pt = center_points[center_points.size() - 1];
        // 计算越线
        jxline cur_line(last_pt.x_, last_pt.y_, center_point.x_, center_point.y_);
        bool bflag = common::is_intersect(cur_line, std_line);
        if (bflag)
        {
          box_t box;
          box.left = obj_c.left;
          box.right = obj_c.right;
          box.top = obj_c.top;
          box.bottom = obj_c.bottom;
          box.score = obj_c.confidence;
          boxes.push_back(box);
        }
      }
      m_TotalObjMtx.unlock();
    }

    if (boxes.size() <= 0)
    {
      continue;
    }

    int algorithm_type = (int)eType;
    string json_str = helpers::gen_json::gen_boxes_json(task_id, algorithm_type, boxes, origin_file_path);

    ImgSaveInfo info_origin;
    info_origin.img_info = VPCUtil::vpc_devMem2vpcImg(gpuMem);
    info_origin.file_path = origin_file_path;
    info_origin.json_str = json_str;
    m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(info_origin);
  }
}

void CMultiSourceProcess::wander_detect(vector<DeviceMemory*>& vec_gpuMem, vector<onelevel_det_result>& vptResult, algorithm_type_t eType)
{
  map<string, map<algo_type, task_param_manager::algo_param_type_t_*>> && algor_param = m_task_param_manager->get_task_other_params();

  for (size_t i = 0; i < vec_gpuMem.size(); i++)
  {
    DeviceMemory* gpuMem = vec_gpuMem[i];
    string task_id = gpuMem->getId();
    long frame_nb = gpuMem->getFrameNb();

    task_param_manager::algo_param_type_t_* cur_task_params = algor_param[task_id][eType];
    if (!cur_task_params)
    {
      continue;
    }

    algor_config_param_behavior* algor_param = (algor_config_param_behavior*)cur_task_params->algor_param;
    algor_basic_config_param_t* basic_param = (algor_basic_config_param_t*)cur_task_params->basic_param;
    if (basic_param == nullptr || basic_param->adapt_param == nullptr) {
      continue;
    }
    universal_algor_adapt_param *adapt_param = basic_param->adapt_param;

    long algor_skip_gap = algor_param->duration;

    std::string cur_src_ts = std::to_string(helpers::timer::get_timestamp<std::chrono::milliseconds>());
    std::string origin_file_path = basic_param->result_folder + helpers::os::sep + task_id  + "_origin_" + cur_src_ts + ".jpg";

    std::vector<box_t> boxes;
    for (int c = 0; c < vptResult[i].obj_count; c++) {
      auto& obj_c = vptResult[i].obj[c];

      bool bCount = false;
      if(eType == algorithm_type_t::HUMAN_LINGER && obj_c.index == (int)det_class_label_t::HUMAN) {
        bCount = true;
      } else if (eType == algorithm_type_t::VEHICLE_ILLEGAL_PARKING && obj_c.index >= 4 && obj_c.index <= 8) {
        bCount = true;
      }

      sy_point center;
      center.x_ = (obj_c.right + obj_c.left)/ 2 ;
      center.y_ = (obj_c.bottom + obj_c.top) / 2;
      if (!bCount || !common::isInPolygon(adapt_param->points, adapt_param->points_count, center)) {
        continue;
      }

      if (obj_c.confidence < algor_param->conf_threshold)
      {
        continue;
      }

      int obj_width = obj_c.right - obj_c.left;
      int obj_height = obj_c.right - obj_c.left; 
      if (obj_width < algor_param->minmum_width || obj_height < algor_param->minmum_height)
      {
        continue;
      }

      OBJ_KEY o_key = { task_id, obj_c.id };
      m_TotalObjMtx.lock();
      auto it = m_total_obj_info.find(o_key);
      if (it != m_total_obj_info.end())
      {
        long skip_gap = frame_nb - m_total_obj_info[o_key].last_frame_nb;
        if (skip_gap > algor_skip_gap)
        {
          box_t box;
          box.left = obj_c.left;
          box.right = obj_c.right;
          box.top = obj_c.top;
          box.bottom = obj_c.bottom;
          box.score = obj_c.confidence;
          boxes.push_back(box);

          m_total_obj_info[o_key].last_frame_nb = frame_nb; // 更新帧号以判断下一次逗留
        }
      }

      m_TotalObjMtx.unlock();
    }

    if (boxes.size() <= 0)
    {
      continue;
    }

    int algorithm_type = (int)eType;
    string json_str = helpers::gen_json::gen_boxes_json(task_id, algorithm_type, boxes, origin_file_path);

    ImgSaveInfo info_origin;
    info_origin.img_info = VPCUtil::vpc_devMem2vpcImg(gpuMem);
    info_origin.file_path = origin_file_path;
    info_origin.json_str = json_str;
    m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(info_origin);
  }
}

/* 每帧都需要做的算法模块 */
int CMultiSourceProcess::gather_process(vector<DeviceMemory*>& vec_gpuMem, vector<onelevel_det_result> &ol_det_result, algorithm_type_t algor_type) {
  /* 人数聚集算法功能 每帧都会获取算法结果 并返回 */
  std::vector<GatherResult> results;
  if (algor_type == algorithm_type_t::HUMAN_GATHER) {
    results = m_human_gather.process(vec_gpuMem, ol_det_result);
  } else if (algor_type == algorithm_type_t::HUMAN_DENSITY) {
    results = m_human_density.process(vec_gpuMem, ol_det_result);
  } else if (algor_type == algorithm_type_t::HUMAN_REGION_GATHER) {
    results = m_human_region_gather.process(vec_gpuMem, ol_det_result);
  } else if (algor_type == algorithm_type_t::VEHICLE_GATHER) {
    results = m_vehicle_gather.process(vec_gpuMem, ol_det_result);
  }

  int algorithm_type = (int)algor_type;
  for (auto &result : results) {

    if (result.boxes.size() <= 0)
    {
      continue;
    }

    auto task_id = result.task_id;
    auto task_other_params = m_task_param_manager->get_task_other_param(task_id);
    const auto &algor_other_params = task_other_params->find(algor_type);
    if (algor_other_params == task_other_params->end()) {
      LOG_ERROR("taskId {} not found algor {}", task_id.c_str(), (int)algor_type);
      continue;
    }
    const algor_basic_config_param_t *basic_param = algor_other_params->second->basic_param;

    std::string cur_timestamp_ms =  std::to_string(helpers::timer::get_timestamp<std::chrono::milliseconds>());
    const std::string origin_file_path = basic_param->result_folder + helpers::os::sep + task_id + "_" +
                                  std::to_string(result.boxes.size()) + "_" + std::to_string(result.id) + "_" + cur_timestamp_ms + ".jpg";

    string json_str = helpers::gen_json::gen_boxes_json(task_id, algorithm_type, result.boxes, origin_file_path);

    ImgSaveInfo info_origin;
    info_origin.img_info = result.origin_img;
    info_origin.file_path = origin_file_path;
    info_origin.json_str = json_str;
    m_save_snapshot_reprocessing->reprocessing_process_wo_locus_async(info_origin);
  }
  
  return 0;
}

int CMultiSourceProcess::CountRunningTask() {
  DecoderManager* pDecManager = DecoderManager::getInstance();
  return pDecManager->count();
}

void CMultiSourceProcess::CloseAllTask2() {
  DecoderManager* pDecManager = DecoderManager::getInstance();
  pDecManager->closeAllDecoder();
}