sentry_chassis_hzz/application/robot_def.h

206 lines
5.9 KiB
C
Raw Normal View History

2022-12-02 23:10:36 +08:00
/**
* @file robot_def.h
* @author NeoZeng neozng1@hnu.edu.cn
* @author Even
* @version 0.1
* @date 2022-12-02
*
2022-12-02 23:10:36 +08:00
* @copyright Copyright (c) HNU YueLu EC 2022 all rights reserved
*
2022-12-02 23:10:36 +08:00
*/
#ifndef ROBOT_DEF_H
#define ROBOT_DEF_H
2022-12-02 22:17:10 +08:00
#include "ins_task.h"
#include "master_process.h"
#include "stdint-gcc.h"
/* 开发板类型定义,烧录时注意不要弄错对应功能;修改定义后需要重新编译 */
2022-12-02 22:17:10 +08:00
/* 只能存在一个宏定义! */
#define ONE_BOARD // 单板控制整车
// #define CHASSIS_BOARD //底盘板
// #define GIMBAL_BOARD //云台板
/* 重要参数定义,注意根据不同机器人进行修改 */
2022-12-05 15:03:45 +08:00
// 云台参数
#define YAW_CHASSIS_ALIGN_ECD 0 // 云台和底盘对齐指向相同方向时的电机编码器值,若对云台有机械改动需要修改
#define YAW_ECD_GREATER_THAN_4096 0 // yaw电机的初始编码器值是否大于4096,是为1,否为0
#define PITCH_HORIZON_ECD 0 // 云台处于水平位置时编码器值,若对云台有机械改动需要修改
2022-12-05 15:03:45 +08:00
// 发射参数
#define ONE_BULLET_DELTA_ANGLE 0 // 发射一发弹丸拨盘转动的距离,由机械设计图纸给出
#define REDUCTION_RATIO_LOADER 49.0f // 拨盘电机的减速比,英雄需要修改为3508的19.0f
#define NUM_PER_CIRCLE 1 // 拨盘一圈的装载量
// 机器人底盘修改的参数,单位为mm(毫米)
#define WHEEL_BASE 300 // 纵向轴距(前进后退方向)
#define TRACK_WIDTH 300 // 横向轮距(左右平移方向)
#define CENTER_GIMBAL_OFFSET_X 0 // 云台旋转中心距底盘几何中心的距离,前后方向,云台位于正中心时默认设为0
#define CENTER_GIMBAL_OFFSET_Y 0 // 云台旋转中心距底盘几何中心的距离,左右方向,云台位于正中心时默认设为0
#define RADIUS_WHEEL 60 // 轮子半径
#define REDUCTION_RATIO_WHEEL 19.0f // 电机减速比,因为编码器量测的是转子的速度而不是输出轴的速度故需进行转换
2022-12-02 22:17:10 +08:00
#if (defined(ONE_BOARD) && defined(CHASSIS_BOARD)) || \
(defined(ONE_BOARD) && defined(GIMBAL_BOARD)) || \
(defined(CHASSIS_BOARD) && defined(GIMBAL_BOARD))
#error Conflict board definition! You can only define one type.
#endif // 检查是否出现定义冲突
#pragma pack(1) // 压缩结构体,取消字节对齐
/* -------------------------基本控制模式和数据类型定义-------------------------*/
/**
* @brief CMD控制数据和各应用的反馈数据的一部分
*
*/
// 机器人状态
typedef enum
{
ROBOT_STOP,
ROBOT_WORKING,
} Robot_Status_e;
2022-12-02 22:17:10 +08:00
// 应用状态
typedef enum
{
APP_OFFLINE,
APP_ONLINE,
APP_ERROR,
} App_Status_e;
// 底盘模式设置
/**
* @brief ,,.
*
*/
2022-12-02 22:17:10 +08:00
typedef enum
{
CHASSIS_ZERO_FORCE, // 电流零输入
CHASSIS_ROTATE, // 小陀螺模式
CHASSIS_NO_FOLLOW, // 不跟随,允许全向平移
CHASSIS_FOLLOW_GIMBAL_YAW, // 跟随模式,底盘叠加角度环控制
} chassis_mode_e;
// 云台模式设置
typedef enum
{
GIMBAL_ZERO_FORCE, // 电流零输入
2022-12-07 21:56:34 +08:00
GIMBAL_FREE_MODE, // 云台自由运动模式,即与底盘分离(底盘此时应为NO_FOLLOW)反馈值为电机total_angle;似乎可以改为全部用IMU数据?
GIMBAL_GYRO_MODE, // 云台陀螺仪反馈模式,反馈值为陀螺仪pitch,total_yaw_angle,底盘可以为小陀螺和跟随模式
2022-12-02 22:17:10 +08:00
} gimbal_mode_e;
2022-12-02 22:17:10 +08:00
// 发射模式设置
typedef enum
{
SHOOT_ON,
SHOOT_OFF,
}shoot_mode_e;
typedef enum
2022-12-02 22:17:10 +08:00
{
FRICTION_OFF, // 摩擦轮关闭
FRICTION_ON, // 摩擦轮开启
} friction_mode_e;
2022-12-02 22:17:10 +08:00
typedef enum
{
LID_CLOSE, // 弹舱盖打开
LID_OPEN, // 弹舱盖关闭
2022-12-02 22:17:10 +08:00
} lid_mode_e;
typedef enum
{
LOAD_STOP, // 停止发射
LOAD_REVERSE, // 反转
LOAD_1_BULLET, // 单发
LOAD_3_BULLET, // 三发
LOAD_BURSTFIRE, // 连发
} loader_mode_e;
// 功率限制,从裁判系统获取
typedef struct
{ // 功率控制
} Chassis_Power_Data_s;
/* ----------------CMD应用发布的控制数据,应当由gimbal/chassis/shoot订阅---------------- */
2022-12-02 22:17:10 +08:00
/**
* @brief ,pc在云台,
2022-12-02 22:17:10 +08:00
*
*/
// cmd发布的底盘控制数据,由chassis订阅
2022-12-02 22:17:10 +08:00
typedef struct
{
// 控制部分
2022-12-02 22:17:10 +08:00
float vx; // 前进方向速度
float vy; // 横移方向速度
float wz; // 旋转速度
float offset_angle; // 底盘和归中位置的夹角
chassis_mode_e chassis_mode;
// UI部分
// ...
2022-12-02 22:17:10 +08:00
} Chassis_Ctrl_Cmd_s;
// cmd发布的云台控制数据,由gimbal订阅
2022-12-02 22:17:10 +08:00
typedef struct
{ // 云台角度控制
float yaw;
float pitch;
float chassis_rotate_wz;
gimbal_mode_e gimbal_mode;
} Gimbal_Ctrl_Cmd_s;
// cmd发布的发射控制数据,由shoot订阅
2022-12-02 22:17:10 +08:00
typedef struct
2022-12-05 15:03:45 +08:00
{
shoot_mode_e shoot_mode;
2022-12-02 22:17:10 +08:00
loader_mode_e load_mode;
lid_mode_e lid_mode;
friction_mode_e friction_mode;
Bullet_Speed_e bullet_speed; // 弹速枚举
2022-12-02 22:17:10 +08:00
uint8_t rest_heat;
2022-12-05 15:03:45 +08:00
float shoot_rate; // 连续发射的射频,unit per s,发/秒
2022-12-02 22:17:10 +08:00
} Shoot_Ctrl_Cmd_s;
/* ----------------gimbal/shoot/chassis发布的反馈数据----------------*/
/**
* @brief cmd订阅,.
*
*/
typedef struct
{
#ifdef CHASSIS_BOARD
attitude_t chassis_imu_data;
#endif // CHASSIS_BOARD
// 后续增加底盘的真实速度
// float real_vx;
// float real_vy;
// float real_wz;
uint8_t rest_heat; // 剩余枪口热量
Bullet_Speed_e bullet_speed; // 弹速限制
Enemy_Color_e enemy_color; // 0 for blue, 1 for red
// 是否需要剩余电量?(电容)
2022-12-02 22:17:10 +08:00
} Chassis_Upload_Data_s;
typedef struct
{
attitude_t gimbal_imu_data;
2022-12-05 15:03:45 +08:00
uint16_t yaw_motor_single_round_angle;
2022-12-02 22:17:10 +08:00
} Gimbal_Upload_Data_s;
2022-12-02 22:17:10 +08:00
typedef struct
{
// code to go here
// ...
} Shoot_Upload_Data_s;
2022-12-02 22:17:10 +08:00
#pragma pack() // 开启字节对齐
#endif // !ROBOT_DEF_H