HT32F52352DMP單片機讀取MPU9250數據源程序

ID:875316 · 發表于 2021-4-2 12:17

單片機源程序如下:

#include "ht32.h"
#include "ht32_board.h"
#include "usart_int.h"
#include <string.h>
#include "usart.h"
#include "./IMU901/ringbuffer.h"
#include "./IMU901/imu901.h"
#include "delay.h"
#include "motor.h"
#include "NRF24L01.h"
#include "usart1.h"
#include "ANO_DT.h"
#include "pid.h"
#include "mpu9250.h"
#include "inv_mpu.h"
#include "inv_mpu_dmp_motion_driver.h"
#include "stdio.h"
/*
1號電機 30解鎖 31-40 占空比 372-480
3號電機 30解鎖 31-40 占空比 372-480
2號電機 18解鎖 19-34 占空比 228-408
4號電機 18解鎖 21-39 占空比 252-468
*/
u8 tmp_buf[33]= "hello";
u8 k;
float mpu_pitch,mpu_roll,mpu_yaw; //歐拉角
short aacx,aacy,aacz; //加速度傳感器原始數據
short gyrox,gyroy,gyroz;//陀螺儀原始數據
short temp; //溫度
#define Key1 1<<8 //Key1=PA8
#define Key2 1<<13 //Key2=PC13
#define Key1_DIR { HT_GPIOA->INER |= HT_GPIOA->PUR |= Key1;} //Key1塊の矗ど筿
#define Key2_DIR { HT_GPIOC->INER |= HT_GPIOC->PUR |= Key2;} //Key2塊の矗ど筿
#define Key1_0 !(HT_GPIOA->DINR & Key1) //浪琩琌齡Key1=0
#define Key1_1 HT_GPIOA->DINR & Key1 //浪琩琌齡Key1=1
#define Key2_0 !(HT_GPIOC->DINR & Key2) //浪琩琌齡Key2=0
#define Key2_1 HT_GPIOC->DINR & Key2 //浪琩琌齡Key2=1
void Key_Init(void)
{
HT_CKCU->AHBCCR |= 1<<16;
HT_CKCU->AHBCCR |= 1<<18;
Key1_DIR
Key2_DIR
}
int main(void)
{
static u8 t =23;
// u8 buff[20];
//NRF24L01_Init();
USART0_Configuration(256000); //USART0的初始化,波特率為460800
// printf("OK\n");
//// ringbuffer_init(&usart0RxFifo, (uint8_t*)buff, 256); //FIFO結構體的初始化
UART0_Configuration(115200);
// PWM_Init();
// Key_Init();
//// unlocked();
//// delay_ms(500);
//// delay_ms(500);
//// delay_ms(500);
//// delay_ms(500);
MPU_Init(); //初始化MPU9250
// if(NRF24L01_Check()==0)
// {
// }
if(mpu_dmp_init())
{
}
// NRF24L01_TX_Mode();
while (1)
{
// Data_Send_To_PC();
delay_ms(5);
// Angle_PWM(attitude.pitch,attitude.roll,attitude.yaw);
Angle_PWM(mpu_pitch,mpu_roll,mpu_yaw);
t++;
if(t == 100)
{
// HT32F_DVB_LEDToggle(HT_LED1);
// HT32F_DVB_LEDToggle(HT_LED2);
}
if(mpu_mpl_get_data(&mpu_pitch,&mpu_roll,&mpu_yaw)==0)
{
temp=MPU_Get_Temperature(); //得到溫度值
MPU_Get_Accelerometer(&aacx,&aacy,&aacz); //得到加速度傳感器數據
MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz); //得到陀螺儀數據
printf("x:%f,y:%f,z:%f\n",mpu_pitch,mpu_roll,mpu_yaw);
HT32F_DVB_LEDInit(HT_LED2);
HT32F_DVB_LEDOn(HT_LED2);
}
}
}

復制代碼

所有代碼51hei提供下載:

MPU9250DMP.7z (611.51 KB, 下載次數: 12)

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

HT32F52352DMP單片機讀取MPU9250數據源程序

評分