实例介绍
【实例简介】编写蓝牙串口通信、电机PWM调速、MPU9250获取偏航角
遥控部分：
使用蓝牙模块连接PC10、11，USART3。
PC10为TX，PC11为RX。
电机部分：
PB6、7、8、9控制电机，TIM4四个通道。
舵机部分：
PC9已初始化可控制舵机，TIM8_CH4，PC8(TIM8_CH3）备用。
mpu9250：
PB10、11分别复用为SCL、SDAI2C进行通信；PA15接AD0；
//按键部分：
计划所买控制板有两个按键KEY0（PC12)和KEY1（PD2），设定KEY0按下时开始循迹避障，KEY1按下时蓝牙遥控。
（程序中会另外设一变量，在循迹脱离五秒后置位与触发KEY1相同效果进入遥控控制）
【核心代码】
//#include "exti.h"
//#include "wdg.h"
#include "math.h"
#include "sys.h"
#include "delay.h"
#include "motor_drive.h"
#include "pwm.h"
#include "mpuiic.h"
#include "inv_mpu.h"
#include "inv_mpu_dmp_motion_driver.h"
//-----------------------------------------------------------
u16 angle = 1500; //舵机占空比，改变舵机转动角度 speed只在启动遥控时通信改变值，故函数调用写speed不写数值；angle则每一次情况不同写不同数值
float pitch,roll,yaw; //欧拉角
short aacx,aacy,aacz; //加速度传感器原始数据
short gyrox,gyroy,gyroz; //陀螺仪原始数据
short temp; //温度
int main(void)
{
// 注：程序中使用中断时，NVIC分组设置应尽量位于程序起始处，并且在设置后尽量不要再更改NVIC分组
//------------------------------------------------------------------------------------------
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //NVIC分组2：2位抢占优先级，2位响应优先级
delay_init(168); // 延时初始化（注：调用延时函数之前，必须先调用delay_Init()将SysTick初始化）
TIM4_Init(499,71); //pwm.c PWM频率=72000/500/(71 1)=2Khz 电机
TIM8_Init(19999,71); //pwm.c PWM频率=72000/20000/(71 1)=50hz 舵机
MPU_Init(); //初始化MPU6050------------
unsigned char ERROR = 0;
while(1)
{
ERROR = mpu_dmp_init();
printf("ERROR:%d\r\n",ERROR);
delay_ms(200);
if(ERROR == 0)break;
} //----------------------------------------
while(1)
{
if(mpu_dmp_get_data(&pitch,&roll,&yaw)==0)
{
temp=MPU_Get_Temperature(); //得到温度值
MPU_Get_Accelerometer(&aacx,&aacy,&aacz); //得到加速度传感器数据
MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz); //得到陀螺仪数据
printf("三轴角度：%f\t%f\t%f\r\n",pitch,roll,yaw);
}
}
}
小贴士
感谢您为本站写下的评论，您的评论对其它用户来说具有重要的参考价值，所以请认真填写。
- 类似“顶”、“沙发”之类没有营养的文字，对勤劳贡献的楼主来说是令人沮丧的反馈信息。
- 相信您也不想看到一排文字/表情墙，所以请不要反馈意义不大的重复字符，也请尽量不要纯表情的回复。
- 提问之前请再仔细看一遍楼主的说明，或许是您遗漏了。
- 请勿到处挖坑绊人、招贴广告。既占空间让人厌烦，又没人会搭理，于人于己都无利。
关于好例子网
本站旨在为广大IT学习爱好者提供一个非营利性互相学习交流分享平台。本站所有资源都可以被免费获取学习研究。本站资源来自网友分享，对搜索内容的合法性不具有预见性、识别性、控制性，仅供学习研究，请务必在下载后24小时内给予删除，不得用于其他任何用途，否则后果自负。基于互联网的特殊性，平台无法对用户传输的作品、信息、内容的权属或合法性、安全性、合规性、真实性、科学性、完整权、有效性等进行实质审查；无论平台是否已进行审查，用户均应自行承担因其传输的作品、信息、内容而可能或已经产生的侵权或权属纠纷等法律责任。本站所有资源不代表本站的观点或立场，基于网友分享，根据中国法律《信息网络传播权保护条例》第二十二与二十三条之规定，若资源存在侵权或相关问题请联系本站客服人员，点此联系我们。关于更多版权及免责申明参见 版权及免责申明
网友评论
我要评论