vehicle-backup/zw_pro/EgoSystem/can_bus.h

#pragma once
#include "../common/comm.h"
#include "../common/notifier.h"
#include "../common/iobuffer.h"
#include "../common/sensor_socket.h"

using namespace std;



class CMessageQueue;
class CCanBusSensor
{
public:
     CCanBusSensor(CMessageQueue *q);
     void Notify(struct can_frame *date);
     
     void SetCanBusSensor(SensorCanBus<CCanBusSensor>* can);
     void Start();
     void Stop();

     void OnMessage(cannet_frame* frames, int32_t count = 4);
     void Emergency();
     

     void order(cannet_frame* frame);  // 指令模式
     void toggleLamp(cannet_frame* frame);  // 车灯开关  
     void move_run(cannet_frame* frame); // 车辆前进  
     void move_rot(cannet_frame* frame);  // 车辆右转  
     void car_stop(cannet_frame* frame);

/*------------------小车控制参数起------------------*/
     bool order_flag = false; // 指令模式
     bool lamp_flag = false; // 车灯状态 
     bool run_flag = false; // 车辆前进后退
     bool rot_flag = false; // 车辆转弯
     bool stop_flag = false; // 急停状态
/*------------------小车控制参数止------------------*/

private:
     void Run();
     void CanSendProc();
     void SendStatusToMSG();
     

private:
     CMessageQueue* _message;
     SensorCanBus<CCanBusSensor> * _canbus;
     bool _run;

     std::thread _can_thread;
     std::mutex _last_can_lock;
     struct can_frame Sendframe[6];
     bool _front_view = true;

     int16_t Direction;//方向
     int16_t Hand_Throttle;//手油门
     int16_t Foot_Throttle;//脚油门
     int16_t Brake;//刹车

     int64_t count;
     FeedData _data;
     int model;//0本地,1远程

     /*-------------------小车控制起--------------------*/
     

     unsigned char* data2copy;

     unsigned char order_on[8] = {0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00};        //id:421 指令模式开
     unsigned char headlamp_on[8] = {0x01,0x01,0x50,0x00,0x00,0x00,0x00,0x00};        //id:121 前车灯常开
     unsigned char headlamp_off[8] = {0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00};       //id:121 前车灯常关
     unsigned char taillamp_on[8] = {0x01,0x00,0x00,0x01,0x50,0x00,0x00,0x00};       //id:121 后车灯常开
     unsigned char taillamp_off[8] = {0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00};       //id:121 后车灯常关
     unsigned char move_forward[8] = {0x00,0x96,0x00,0x00,0x00,0x00,0x00,0x00};    //id:111 以0.15m/s前进
     unsigned char move_backward[8] = {0x00,0xcc,0x00,0x00,0x00,0x00,0x00,0x00};   //id:111 以0.15m/s后退
     unsigned char move_rotation[8] = {0x00,0x00,0x00,0xc8,0x00,0x00,0x00,0x00};   //id:111 以0.2rad/s旋转
     unsigned char stop_on[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};            //id:111 急停
     /*-------------------小车控制止--------------------*/
     
};