本文主要是介绍GY-25 倾斜度角度模块 串口直接输出角度数据 MPU-6050 传感器 的使用,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!
2019 电子设计大赛 激光炮题目 写的程序
外形:
链接:
GY-25 倾斜度角度模块 串口直接输出角度数据 MPU-6050 传感器
依赖:
usart_all.h
usart_all.c
见 STM32超级通用串口程序(秘籍)
调用场景:
- 2019 电子设计大赛 激光炮题目 主程序 最后没用角度传感器,用的自己间舵机角度和 PWM 参数的对应表
代码:
angle.h
:
#ifndef __ANGLE_H
#define __ANGLE_H#include "sys.h"void ANGLE_Init(void);
void ANGLE_Reset(void);
void ANGLE_SetQueryMode(void);
void ANGLE_xCalibration(void);
void ANGLE_yzCalibration(void);
char ANGLE_GetAngle(s16* x_angle, s16* y_angle, s16* z_angle);#endif
angle.c
:
#include "angle.h"#include "usart_all.h"void ANGLE_Reset(void) {}void ANGLE_SetQueryMode(void) {//发送查询命令字节USART2_PutChar(0xA5);USART2_PutChar(0x51);//清空串口2接收缓冲区USART2_ClearRXBuf();//再次查询USART2_PutChar(0xA5);USART2_PutChar(0x51);
}
//航向角校正为0,可在任意角度
void ANGLE_xCalibration(void) {USART2_PutChar(0xA5);USART2_PutChar(0x55);
}
//俯仰角横滚角校正为0,只能在模块水平时
void ANGLE_yzCalibration(void) {USART2_PutChar(0xA5);USART2_PutChar(0x54);
}char ANGLE_GetAngle(s16* x_angle, s16* y_angle, s16* z_angle) {u8 flag1 = 0, flag2 = 0;u8 x_angle1 = 0, x_angle2 = 0;u8 y_angle1 = 0, y_angle2 = 0;u8 z_angle1 = 0, z_angle2 = 0;while(flag1 != 0xAA) {USART2_GetChar(&flag1);//直至获取到角度数据流的开头标识符0xAA}USART2_GetChar(&x_angle1);USART2_GetChar(&x_angle2);USART2_GetChar(&y_angle1);USART2_GetChar(&y_angle2);USART2_GetChar(&z_angle1);USART2_GetChar(&z_angle2);USART2_GetChar(&flag2);//发送下一次查询命令字节USART2_PutChar(0xA5);USART2_PutChar(0x51);if(flag1 == 0xAA && flag2 == 0x55) {*x_angle = x_angle1<<8|x_angle2;*y_angle = y_angle1<<8|y_angle2;*z_angle = z_angle1<<8|z_angle2;return 1;}return 0;
}void ANGLE_Init(void) {USART2_Init(9600);ANGLE_SetQueryMode();ANGLE_xCalibration();ANGLE_yzCalibration();
}
这篇关于GY-25 倾斜度角度模块 串口直接输出角度数据 MPU-6050 传感器 的使用的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!