forked from logzhan/RobotHardware-UESTC
112 lines
3.1 KiB
C++
112 lines
3.1 KiB
C++
#ifndef DATA_HOLDER_H_
|
||
#define DATA_HOLDER_H_
|
||
|
||
#include <string.h>
|
||
|
||
// 1字节对齐
|
||
#pragma pack(1)
|
||
|
||
struct Robot_firmware
|
||
{
|
||
char version[16]; //固件版本
|
||
char time[16]; //构建时间
|
||
};
|
||
|
||
enum IMU_TYPE
|
||
{
|
||
IMU_TYPE_GY65 = 49,
|
||
IMU_TYPE_GY85 = 69,
|
||
IMU_TYPE_GY87 = 71
|
||
};
|
||
|
||
#define MOTOR_ENCODER_1_FLAG 0x01
|
||
#define MOTOR_ENCODER_2_FLAG 0x02
|
||
#define MOTOR_ENCODER_3_FLAG 0x04
|
||
#define MOTOR_ENCODER_4_FLAG 0x08
|
||
|
||
struct Params
|
||
{
|
||
unsigned short wheel_diameter; //轮子直径 mm
|
||
unsigned short wheel_track; //差分：轮距， 三全向轮：直径，四全向：前后轮距+左右轮距 mm
|
||
unsigned short encoder_resolution; //编码器分辨率
|
||
unsigned char do_pid_interval; //pid间隔 (ms)
|
||
unsigned short kp;
|
||
unsigned short ki;
|
||
unsigned short kd;
|
||
unsigned short ko; //pid参数比例
|
||
unsigned short cmd_last_time; //命令持久时间ms 超过该时间会自动停止运动
|
||
unsigned short max_v_liner_x; // 最大x线速度
|
||
unsigned short max_v_liner_y; // 最大y线速度
|
||
unsigned short max_v_angular_z; // 最大角速度
|
||
unsigned char imu_type; // imu类型 参见IMU_TYPE
|
||
unsigned short motor_ratio; // 电机减速比
|
||
unsigned char model_type; // 运动模型类型 参见MODEL_TYPE
|
||
unsigned char motor_nonexchange_flag; // 电机标志参数 1 正接 0 反接(相当于电机线交换)
|
||
unsigned char encoder_nonexchange_flag; // 编码器标志参数 1 正接 0 反接(相当于编码器ab相交换)
|
||
};
|
||
|
||
struct Robot_parameter
|
||
{
|
||
union
|
||
{
|
||
char buff[64];
|
||
struct Params params;
|
||
};
|
||
};
|
||
|
||
struct Robot_velocity
|
||
{
|
||
short v_liner_x; //线速度 前>0 cm/s
|
||
short v_liner_y; //差分轮 为0 cm/s
|
||
short v_angular_z; //角速度 左>0 0.01rad/s 100 means 1 rad/s
|
||
};
|
||
|
||
struct Robot_odom
|
||
{
|
||
short v_liner_x; //线速度 前>0 后<0 cm/s
|
||
short v_liner_y; //差分轮 为0 cm/s
|
||
short v_angular_z; //角速度 左>0 右<0 0.01rad/s 100 means 1 rad/s
|
||
long x; //里程计坐标x cm (这里long为4字节，下同)
|
||
long y; //里程计坐标y cm
|
||
short yaw; //里程计航角 0.01rad 100 means 1 rad
|
||
};
|
||
|
||
struct Robot_pid_data
|
||
{
|
||
long input[4]; //各轮子驱动输入值
|
||
long output[4]; //个轮子输出值
|
||
};
|
||
|
||
struct Robot_pwm_value
|
||
{
|
||
short value[4];
|
||
};
|
||
|
||
class Data_holder
|
||
{
|
||
public:
|
||
static Data_holder* get() {
|
||
static Data_holder dh;
|
||
return &dh;
|
||
}
|
||
|
||
void load_parameter();
|
||
|
||
void save_parameter();
|
||
|
||
private:
|
||
Data_holder();
|
||
public:
|
||
struct Robot_firmware firmware_info;//版本信息
|
||
struct Robot_parameter parameter; //参数
|
||
struct Robot_velocity velocity; // 速度
|
||
struct Robot_odom odom; //里程
|
||
struct Robot_pid_data pid_data; //pid输入输出
|
||
|
||
float imu_data[9]; //imu的值 9axis
|
||
|
||
float encoder_count[4]; // 编码器计数
|
||
struct Robot_pwm_value pwm; // 控制的pwm
|
||
};
|
||
#endif
|