forked from logzhan/RobotHardware-UESTC
111 lines
3.2 KiB
C++
111 lines
3.2 KiB
C++
#ifndef __DataHolder_H__
|
||
#define __DataHolder_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 DataHolder
|
||
{
|
||
public:
|
||
static DataHolder* get() {
|
||
static DataHolder dh;
|
||
return &dh;
|
||
}
|
||
|
||
void loadParameter();
|
||
|
||
void save_parameter();
|
||
|
||
private:
|
||
DataHolder();
|
||
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输入输出
|
||
struct Robot_pwm_value pwm; // 控制的pwm
|
||
|
||
float imu_data[9]; // imu的值 9axis
|
||
float encoder_count[4]; // 编码器计数
|
||
|
||
};
|
||
#endif
|