117 lines
2.9 KiB
C
117 lines
2.9 KiB
C
#ifndef DJI_MOTOR_H
|
||
#define DJI_MOTOR_H
|
||
|
||
#ifdef __cplusplus
|
||
extern "C"{
|
||
#endif
|
||
#define FREERTOS_DJI 1
|
||
|
||
#include "struct_typedef.h"
|
||
#include "can.h"
|
||
#include "odrive_can.h"
|
||
|
||
typedef enum{
|
||
GM6020 = 0,
|
||
M3508 = 1,
|
||
M2006 = 2
|
||
}motor_type_e;
|
||
|
||
|
||
//rm motor data
|
||
typedef struct
|
||
{
|
||
uint16_t ecd;//编码器返回值0-8192
|
||
int16_t speed_rpm;//速度
|
||
int16_t given_current;//电流
|
||
uint16_t temperate;//温度
|
||
int16_t last_ecd;//上次的编码器角度
|
||
int16_t round_cnt;//转子圈数(ecd round)
|
||
int32_t total_angle;//输出轴角度
|
||
uint16_t offset_ecd;//开始的ecd值
|
||
uint32_t msg_cnt;//初始化开始ecd值用的
|
||
int16_t real_round;//输出轴圈数
|
||
int16_t real_angle;//输出轴单圈角度
|
||
motor_type_e type;//电机类型，详见motor_type_e
|
||
|
||
} motor_measure_t;
|
||
|
||
typedef struct
|
||
{
|
||
uint16_t ecd;
|
||
int16_t speed_rpm;
|
||
int16_t given_current;
|
||
uint8_t temperate;
|
||
int16_t last_ecd;
|
||
} odrive_measure_t;
|
||
|
||
|
||
//motor calc ecd to angle
|
||
|
||
#define MOTOR_ECD_TO_ANGLE (360.0 / 8191.0 / (3591.0/187.0))
|
||
#define MOTOR_ECD_TO_RAD 0.000766990394f
|
||
#define MOTOR_ECD_TO_ANGLE_6020 (360.0 / 8191.0 )
|
||
|
||
#if FREERTOS_DJI == 1
|
||
|
||
/**
|
||
* @brief 大疆电机初始化
|
||
* @param none
|
||
* @retval none
|
||
*/
|
||
void djiInit(void);
|
||
|
||
/**
|
||
* @brief 等待新数据
|
||
*/
|
||
uint32_t waitNewDji(void);
|
||
#endif
|
||
/**
|
||
* @brief 发送电机控制电流(0x205,0x206,0x207,0x208)
|
||
* @param[in] motor1: (0x205) 电机控制电流
|
||
* @param[in] motor2: (0x206) 电机控制电流
|
||
* @param[in] motor3: (0x207) 电机控制电流
|
||
* @param[in] motor4: (0x208) 电机控制电流
|
||
* @retval none
|
||
*/
|
||
extern void CAN_cmd_1FF(int16_t motor1, int16_t motor2, int16_t motor3, int16_t motor4,CAN_HandleTypeDef*hcan);
|
||
|
||
/**
|
||
* @brief 发送电机控制电流(0x201,0x202,0x203,0x204)
|
||
* @param[in] motor1: (0x201) 电机控制电流
|
||
* @param[in] motor2: (0x202) 电机控制电流
|
||
* @param[in] motor3: (0x203) 电机控制电流
|
||
* @param[in] motor4: (0x204) 电机控制电流
|
||
* @retval none
|
||
*/
|
||
extern void CAN_cmd_200(int16_t motor1, int16_t motor2, int16_t motor3, int16_t motor4,CAN_HandleTypeDef*hcan);
|
||
|
||
/**
|
||
* @brief 发送电机控制电流(0x205,0x206,0x207,0x208)
|
||
* @param[in] motor1: (0x209) 电机控制电流
|
||
* @param[in] motor2: (0x20A) 电机控制电流
|
||
* @param[in] motor3: (0x20B) 电机控制电流
|
||
* @retval none
|
||
*/
|
||
extern void CAN_cmd_2FF(int16_t motor1, int16_t motor2, int16_t motor3, CAN_HandleTypeDef*hcan);
|
||
|
||
/**
|
||
* @brief 返回电机数据指针
|
||
* @param[in] i: 电机编号
|
||
* @retval 电机数据指针
|
||
*/
|
||
extern motor_measure_t *get_motor_point(uint8_t i);
|
||
|
||
|
||
/**
|
||
* @brief 数据处理函数
|
||
* @param[in] none
|
||
* @retval none
|
||
*/
|
||
void djiMotorEncode(void);
|
||
|
||
#ifdef __cplusplus
|
||
}
|
||
#endif
|
||
|
||
#endif
|