puai_wj_2021/wanji_lidar/region_worker.h

//
// Created by zx on 2019/12/9.
//

#ifndef REGION_WORKER_H
#define REGION_WORKER_H

#include "region_detect.h"
//#include "../tool/StdCondition.h"
#include <thread>
#include <mutex>
#include <iostream>
#include <atomic>
#include <chrono>
#include "../error_code/error_code.h"
#include "../verify/Verify_result.h"
#include "../tool/thread_condition.h"
#include "../tool/common_data.h"


/**
 * 区域功能类，负责自动检测区域状态并更新到plc
 * */
class Region_worker
{
public:
#define REGION_WORKER_RESULT_DEFAULT 0x0000
//#define REGION_WORKER_VERIFY_OK 0x0001
//#define REGION_WORKER_EMPTY_SPACE 0x0020
//#define REGION_WORKER_CLUSTER_SIZE_ERROR 0x0040
//#define REGION_WORKER_OTHER_ERROR 0x0080
//#define REGION_WORKER_NULL_POINTER 0x0100
#define REGION_WORKER_EMPTY_SPACE 1
#define REGION_WORKER_HAS_CAR 2
#define REGION_WORKER_DETECT_ERROR 3

enum Region_worker_status
	{
		E_UNKNOW               	= 0,    //未知
		E_READY               	= 1,    //准备，待机
		E_BUSY					= 2, 	//工作正忙

		E_FAULT					= 10,	//故障
	};
public:

	Region_worker();
    ~Region_worker();

	Error_manager init(Point2D_tool::Point2D_box point2D_box, std::mutex* p_cloud_collection_mutex,
					   pcl::PointCloud<pcl::PointXYZ>::Ptr p_cloud_collection);

	//唤醒自动预测的算法线程
	Error_manager wake_auto_detect();

    // 获得中心点、角度等测量数据
    Error_manager get_wheel_result(std::mutex* p_cloud_mutex, pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_in,
    Common_data::Car_wheel_information& car_wheel_information);

    // 获得中心点、角度等测量数据,  新算法, 可以测量前轮旋转
    Error_manager get_wheel_result_ex(std::mutex* p_cloud_mutex, pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_in,
    Common_data::Car_wheel_information& car_wheel_information);

protected:
    static cv::RotatedRect create_rotate_rect(float length,float width,float angle,float x,float y);

    //自动预测的线程函数
    void auto_detect_thread_fun();

protected:
	//状态
	Region_worker_status						m_region_worker_status;			//区域功能的状态

    Region_detector 							m_detector;                             // 区域检测算法实例

	//万集雷达的自动功能, 定时收集所有点云, 然后通知detect去计算车轮信息.
	std::mutex*	 								mp_cloud_collection_mutex;       // 点云更新互斥锁, 内存由上级管理
	pcl::PointCloud<pcl::PointXYZ>::Ptr 		mp_cloud_collection;			//扫描点的点云集合, 内存由上级管理

	Common_data::Car_wheel_information			m_car_wheel_information;		//车轮的定位结果,
	std::chrono::system_clock::time_point		m_detect_updata_time;			//定位结果的更新时间.

	std::thread*        						mp_auto_detect_thread;   		//自动预测的线程指针，内存由本类管理
	Thread_condition							m_auto_detect_condition;		//自动预测的条件变量





//    pcl::PointCloud<pcl::PointXYZ>::Ptr m_cloud;             // 自动区域检测用点云
//    std::atomic<bool> mb_cloud_updated;                      // 点云更新指标
////
////    std::chrono::steady_clock::time_point m_update_plc_time; // 更新plc状态时刻
////    int m_last_sent_code;                              // 上次写入plc的状态值
////    int m_last_read_code;                              // 上次检查获得的状态值
////    int m_last_border_status;				// 上次超界提示
////    std::atomic<int> m_read_code_count;                      // 检查后重复获取相同状态值次数
//
//    Thread_condition m_cond_exit;     // 系统退出标志
//    std::thread *m_detect_thread; // 实时检测线程
//    std::mutex m_mutex;           // 点云互斥锁
//
//    Verify_result* mp_verify_handle; // 边缘检测
};

#endif //REGION_WORKER_H