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

//区域功能类 的预测算法的时间周期, 一般为100ms, 我们这里设一个较大值200ms
#define REGION_WORKER_DETECT_CYCLE_MS 200

	//万集区域功能的状态
	enum Region_worker_status
	{
		E_UNKNOWN = 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 init(Point2D_tool::Point2D_box point2D_box, std::mutex* p_cloud_collection_mutex,
					   pcl::PointCloud<pcl::PointXYZ>::Ptr p_cloud_collection, int index);

	//开始自动预测的算法线程
	Error_manager start_auto_detect();
	//关闭自动预测的算法线程
	Error_manager stop_auto_detect();

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

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


	//外部调用获取新的车轮定位信息, 获取指令时间之后的车轮定位信息, 如果没有就会等待车轮定位信息刷新, 直到超时, (内置while)
	Error_manager get_new_wheel_information_and_wait(Common_data::Car_wheel_information* p_car_wheel_information,
													 std::chrono::system_clock::time_point command_time, int timeout_ms=1500);

	//外部调用获取当前车轮定位信息, 获取指令时间之后的车轮定位信息, 如果没有就会报错, 不会等待
	Error_manager get_current_wheel_information(Common_data::Car_wheel_information* p_car_wheel_information,
												std::chrono::system_clock::time_point command_time);
	//外部调用获取最新的车轮定位信息, 获取指令时间往前一个周期内的车轮定位信息, 如果没有就会报错, 不会等待
	Error_manager get_last_wheel_information(Common_data::Car_wheel_information* p_car_wheel_information,
											 std::chrono::system_clock::time_point command_time);

public:
	Region_worker_status get_status();

	std::chrono::system_clock::time_point get_detect_updata_time();

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

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

protected:

	int m_index;// 区域编号,仅普爱使用

	//状态
	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::system_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