btl143/QD4C-firmware
4
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

更新IMU660RA硬件设置

Browse Source
This commit is contained in:
CaoWangrenbo
2023-12-14 21:18:55 +08:00
parent eaa7cc0eea
commit d2d40d225c
2 changed files with 247 additions and 249 deletions
Download Patch File Download Diff File Expand all files Collapse all files

78
libraries/zf_device/zf_device_imu660ra.c
View File

@@ -63,9 +63,14 @@
#include "zf_device_imu660ra.h"
int16 imu660ra_gyro_x = 0, imu660ra_gyro_y = 0, imu660ra_gyro_z = 0; // 三轴陀螺仪数据 gyro (陀螺仪)
int16 imu660ra_acc_x = 0, imu660ra_acc_y = 0, imu660ra_acc_z = 0; // 三轴加速度计数据 acc (accelerometer 加速度计)
float imu660ra_transition_factor[2] = {4096, 16.4};
int16 imu660ra_gyro_x = 0;
int16 imu660ra_gyro_y = 0;
int16 imu660ra_gyro_z = 0; // 三轴陀螺仪数据 gyro (陀螺仪)
int16 imu660ra_acc_x = 0;
int16 imu660ra_acc_y = 0;
int16 imu660ra_acc_z = 0; // 三轴加速度计数据 acc (accelerometer 加速度计)
float imu660ra_temperature = 0;
float imu660ra_transition_factor[2] = {4096, 16.4f};
#if IMU660RA_USE_SOFT_IIC
static soft_iic_info_struct imu660ra_iic_struct;
@@ -136,8 +141,7 @@ static void imu660ra_read_registers(uint8 reg, uint8 *data, uint32 len)
IMU660RA_CS(0);
spi_read_8bit_registers(IMU660RA_SPI, reg | IMU660RA_SPI_R, temp_data, len + 1);
IMU660RA_CS(1);
for(int i = 0; i < len; i ++)
{
for (int i = 0; i < len; i++) {
*(data++) = temp_data[i + 1];
}
}
@@ -152,12 +156,11 @@ static void imu660ra_read_registers(uint8 reg, uint8 *data, uint32 len)
//-------------------------------------------------------------------------------------------------------------------
static uint8 imu660ra_self_check(void)
{
uint8 dat = 0, return_state = 0;
uint8 dat = 0;
uint8 return_state = 0;
uint16 timeout_count = 0;
do
{
if(timeout_count ++ > IMU660RA_TIMEOUT_COUNT)
{
do {
if (timeout_count++ > IMU660RA_TIMEOUT_COUNT) {
return_state = 1;
break;
}
@@ -202,6 +205,14 @@ void imu660ra_get_gyro (void)
imu660ra_gyro_z = (int16)(((uint16)dat[5] << 8 | dat[4]));
}
void imu660ra_get_temperature(void)
{
uint8_t dat[2];
imu660ra_read_registers(IMU660RA_TEMP_ADDRESS, dat, 2);
imu660ra_temperature = (int16_t)((uint16_t)dat[1] << 8 | dat[0]);
imu660ra_temperature = imu660ra_temperature / 512.0f + 23.0f;
}
//-------------------------------------------------------------------------------------------------------------------
// 函数简介 初始化 IMU660RA
// 参数说明 void
@@ -255,36 +266,29 @@ uint8 imu660ra_init (void)
// 设置为 0x01 加速度计量程为 ±4 g 获取到的加速度计数据除以 8192 可以转化为带物理单位的数据 单位 g(m/s^2)
// 设置为 0x02 加速度计量程为 ±8 g 获取到的加速度计数据除以 4096 可以转化为带物理单位的数据 单位 g(m/s^2)
// 设置为 0x03 加速度计量程为 ±16 g 获取到的加速度计数据除以 2048 可以转化为带物理单位的数据 单位 g(m/s^2)
switch(IMU660RA_ACC_SAMPLE_DEFAULT)
{
default:
{
switch (IMU660RA_ACC_SAMPLE_DEFAULT) {
default: {
zf_log(0, "IMU660RA_ACC_SAMPLE_DEFAULT set error.");
return_state = 1;
} break;
case IMU660RA_ACC_SAMPLE_SGN_2G:
{
case IMU660RA_ACC_SAMPLE_SGN_2G: {
imu660ra_write_register(IMU660RA_ACC_RANGE, 0x00);
imu660ra_transition_factor[0] = 16384;
} break;
case IMU660RA_ACC_SAMPLE_SGN_4G:
{
case IMU660RA_ACC_SAMPLE_SGN_4G: {
imu660ra_write_register(IMU660RA_ACC_RANGE, 0x01);
imu660ra_transition_factor[0] = 8192;
} break;
case IMU660RA_ACC_SAMPLE_SGN_8G:
{
case IMU660RA_ACC_SAMPLE_SGN_8G: {
imu660ra_write_register(IMU660RA_ACC_RANGE, 0x02);
imu660ra_transition_factor[0] = 4096;
} break;
case IMU660RA_ACC_SAMPLE_SGN_16G:
{
case IMU660RA_ACC_SAMPLE_SGN_16G: {
imu660ra_write_register(IMU660RA_ACC_RANGE, 0x03);
imu660ra_transition_factor[0] = 2048;
} break;
}
if(1 == return_state)
{
if (1 == return_state) {
break;
}
@@ -294,45 +298,35 @@ uint8 imu660ra_init (void)
// 设置为 0x02 陀螺仪量程为 ±500 dps 获取到的陀螺仪数据除以 65.6 可以转化为带物理单位的数据 单位为 °/s
// 设置为 0x01 陀螺仪量程为 ±1000 dps 获取到的陀螺仪数据除以 32.8 可以转化为带物理单位的数据 单位为 °/s
// 设置为 0x00 陀螺仪量程为 ±2000 dps 获取到的陀螺仪数据除以 16.4 可以转化为带物理单位的数据 单位为 °/s
switch(IMU660RA_GYRO_SAMPLE_DEFAULT)
{
default:
{
switch (IMU660RA_GYRO_SAMPLE_DEFAULT) {
default: {
zf_log(0, "IMU660RA_GYRO_SAMPLE_DEFAULT set error.");
return_state = 1;
} break;
case IMU660RA_GYRO_SAMPLE_SGN_125DPS:
{
case IMU660RA_GYRO_SAMPLE_SGN_125DPS: {
imu660ra_write_register(IMU660RA_GYR_RANGE, 0x04);
imu660ra_transition_factor[1] = 262.4;
} break;
case IMU660RA_GYRO_SAMPLE_SGN_250DPS:
{
case IMU660RA_GYRO_SAMPLE_SGN_250DPS: {
imu660ra_write_register(IMU660RA_GYR_RANGE, 0x03);
imu660ra_transition_factor[1] = 131.2;
} break;
case IMU660RA_GYRO_SAMPLE_SGN_500DPS:
{
case IMU660RA_GYRO_SAMPLE_SGN_500DPS: {
imu660ra_write_register(IMU660RA_GYR_RANGE, 0x02);
imu660ra_transition_factor[1] = 65.6;
} break;
case IMU660RA_GYRO_SAMPLE_SGN_1000DPS:
{
case IMU660RA_GYRO_SAMPLE_SGN_1000DPS: {
imu660ra_write_register(IMU660RA_GYR_RANGE, 0x01);
imu660ra_transition_factor[1] = 32.8;
} break;
case IMU660RA_GYRO_SAMPLE_SGN_2000DPS:
{
case IMU660RA_GYRO_SAMPLE_SGN_2000DPS: {
imu660ra_write_register(IMU660RA_GYR_RANGE, 0x00);
imu660ra_transition_factor[1] = 16.4;
} break;
}
if(1 == return_state)
{
if (1 == return_state) {
break;
}
} while (0);
return return_state;
}

24
libraries/zf_device/zf_device_imu660ra.h
View File

@@ -58,12 +58,12 @@
#include "zf_common_typedef.h"
#define IMU660RA_USE_SOFT_IIC (0) // 默认使用硬件 SPI 方式驱动
#define IMU660RA_USE_SOFT_IIC (1) // 默认使用硬件 SPI 方式驱动
#if IMU660RA_USE_SOFT_IIC // 这两段 颜色正常的才是正确的 颜色灰的就是没有用的
//====================================================软件 IIC 驱动====================================================
#define IMU660RA_SOFT_IIC_DELAY (10) // 软件 IIC 的时钟延时周期 数值越小 IIC 通信速率越快
#define IMU660RA_SCL_PIN (B13) // 软件 IIC SCL 引脚 连接 IMU660RA 的 SCL 引脚
#define IMU660RA_SDA_PIN (B15) // 软件 IIC SDA 引脚 连接 IMU660RA 的 SDA 引脚
#define IMU660RA_SCL_PIN (B3) // 软件 IIC SCL 引脚 连接 IMU660RA 的 SCL 引脚
#define IMU660RA_SDA_PIN (B5) // 软件 IIC SDA 引脚 连接 IMU660RA 的 SDA 引脚
//====================================================软件 IIC 驱动====================================================
#else
@@ -79,16 +79,14 @@
#define IMU660RA_CS_PIN (C10) // CS 片选引脚
#define IMU660RA_CS(x) ((x) ? (gpio_high(IMU660RA_CS_PIN)) : (gpio_low(IMU660RA_CS_PIN)))
typedef enum
{
typedef enum {
IMU660RA_ACC_SAMPLE_SGN_2G, // 加速度计量程 ±2G (ACC = Accelerometer 加速度计) (SGN = signum 带符号数 表示正负范围) (G = g 重力加速度 g≈9.80 m/s^2)
IMU660RA_ACC_SAMPLE_SGN_4G, // 加速度计量程 ±4G (ACC = Accelerometer 加速度计) (SGN = signum 带符号数 表示正负范围) (G = g 重力加速度 g≈9.80 m/s^2)
IMU660RA_ACC_SAMPLE_SGN_8G, // 加速度计量程 ±8G (ACC = Accelerometer 加速度计) (SGN = signum 带符号数 表示正负范围) (G = g 重力加速度 g≈9.80 m/s^2)
IMU660RA_ACC_SAMPLE_SGN_16G, // 加速度计量程 ±16G (ACC = Accelerometer 加速度计) (SGN = signum 带符号数 表示正负范围) (G = g 重力加速度 g≈9.80 m/s^2)
} imu660ra_acc_sample_config;
typedef enum
{
typedef enum {
IMU660RA_GYRO_SAMPLE_SGN_125DPS, // 陀螺仪量程 ±125DPS (GYRO = Gyroscope 陀螺仪) (SGN = signum 带符号数 表示正负范围) (DPS = Degree Per Second 角速度单位 °/S)
IMU660RA_GYRO_SAMPLE_SGN_250DPS, // 陀螺仪量程 ±250DPS (GYRO = Gyroscope 陀螺仪) (SGN = signum 带符号数 表示正负范围) (DPS = Degree Per Second 角速度单位 °/S)
IMU660RA_GYRO_SAMPLE_SGN_500DPS, // 陀螺仪量程 ±500DPS (GYRO = Gyroscope 陀螺仪) (SGN = signum 带符号数 表示正负范围) (DPS = Degree Per Second 角速度单位 °/S)
@@ -112,6 +110,7 @@ typedef enum
#define IMU660RA_INIT_CTRL (0x59)
#define IMU660RA_INIT_DATA (0x5E)
#define IMU660RA_INT_STA (0x21)
#define IMU660RA_TEMP_ADDRESS (0x22)
#define IMU660RA_ACC_ADDRESS (0x0C)
#define IMU660RA_GYRO_ADDRESS (0x12)
#define IMU660RA_ACC_CONF (0x40)
@@ -120,12 +119,18 @@ typedef enum
#define IMU660RA_GYR_RANGE (0x43)
//================================================定义 IMU660RA 内部地址================================================
extern int16 imu660ra_gyro_x, imu660ra_gyro_y, imu660ra_gyro_z; // 三轴陀螺仪数据 gyro (陀螺仪)
extern int16 imu660ra_acc_x, imu660ra_acc_y, imu660ra_acc_z; // 三轴加速度计数据 acc (accelerometer 加速度计)
extern int16 imu660ra_gyro_x;
extern int16 imu660ra_gyro_y;
extern int16 imu660ra_gyro_z; // 三轴陀螺仪数据 gyro (陀螺仪)
extern int16 imu660ra_acc_x;
extern int16 imu660ra_acc_y;
extern int16 imu660ra_acc_z; // 三轴加速度计数据 acc (accelerometer 加速度计)
extern float imu660ra_temperature;
extern float imu660ra_transition_factor[2];
void imu660ra_get_acc(void); // 获取 IMU660RA 加速度计数据
void imu660ra_get_gyro(void); // 获取 IMU660RA 陀螺仪数据
void imu660ra_get_temperature(void);
//-------------------------------------------------------------------------------------------------------------------
// 函数简介 将 IMU660RA 加速度计数据转换为实际物理数据
@@ -148,4 +153,3 @@ void imu660ra_get_gyro (void);
uint8 imu660ra_init(void); // 初始化 IMU660RA
#endif