STM32驱动MPU6050
STM32通过串口给MPU6050与MU6050通信,以下程序将MPU6050接到了串口2上,PA2为TX,PA3为RX,具体的代码如下:
CubeMx配置
CubeMx配置的配置很简单,只需要把串口1以及串口2都使能,其中串口1用于与上位机(电脑)通信,以发送MPU6050的测量值,串口2则用于与MPU6050通信,之后开启串口2的中断,串口1的不用开,因为串口1只需要向上位机发送数据,所以不用中断,串口2因为要接收数据,所以要使能
工程文件准备
把正点原子的system文件夹粘贴到工程下,因为接下来要用到delay.c中的函数,复制完后,向工程中添加.c以及.h文件,并在主函数中包含头文件
#include "delay.h"
定义在程序中要用到的变量
static unsigned char flag=0;
static uint8_t rebuf=0;
unsigned char chr;
int16_t YAW=0,PITCH=0,ROLL=0;
主函数的编写
在对应位置粘贴如下代码:
delay_init(72);
HAL_UART_Receive_IT(&huart2, (uint8_t *)&rebuf, 1);
第二处:
if(flag==0)
{
chr = 0xa5;
HAL_UART_Transmit(&huart2,(uint8_t *)&chr, 1, 0xffff);
chr = 0x51;
HAL_UART_Transmit(&huart2,(uint8_t *)&chr, 1, 0xffff);
}
delay_ms(10);
if(flag==1)
{
flag=0;
printf("YAW = %hd\r\n", YAW);
printf("PITCH = %hd\r\n", PITCH);
printf("ROLL = %hd\r\n", ROLL);
}
}
串口接收中断函数的编写
void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart)
{
if(huart->Instance==USART2)
{
static unsigned char buf[8] = {0}, k = 0;
buf[k++] = rebuf;
if(!(buf[0]==0xaa))
{
k=0;
buf[0]=0;
}
if(k==8)
{
if(buf[7]==0x55)
{
YAW=(buf[1]<<8|buf[2]);
PITCH=(buf[3]<<8|buf[4]);
ROLL=(buf[5]<<8|buf[6]);
flag=1;
}
k=0;
}
}
HAL_UART_Receive_IT(&huart2, (uint8_t *)&rebuf, 1);
}
MPU6050的数据:
MPU6050输出的3个角的关系可由下图得到
|