设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › stm32F1+mpu6050平衡车源代码
返回列表 发新帖
查看: 4905|回复: 3
打印 上一主题 下一主题
收起左侧

stm32F1+mpu6050平衡车源代码

[复制链接]
跳转到指定楼层
楼主
ID:472829 发表于 2019-1-25 14:31 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
stm32F1 平衡车源代码，采用亚博智能小车拓展板，采用MPU6050  INT脚中断，本代码只有直立环，后续代码稍后上传

单片机源程序如下:
  1. #include "mpu6050.h"
  2. #include "sys.h"
  3. #include "delay.h"
  4. #include "usart.h"   

  6. //初始化MPU6050
  7. //返回值:0,成功
  8. //    其他,错误代码
  9. u8 MPU_Init(void)
  10. {
  11.         u8 res;
  12.   GPIO_InitTypeDef  GPIO_InitStructure;
  13.         
  14.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);//使能AFIO时钟
  15.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);//先使能外设IO PORTA时钟
  16.         
  17.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_15;         // 端口配置
  18.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;        //推挽输出
  19.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 //IO口速度为50MHz
  20.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                         //根据设定参数初始化GPIOA

  22.         GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable,ENABLE);//禁止JTAG,从而PA15可以做普通IO使用,否则PA15不能做普通IO!!!
  23.         
  24.         MPU_AD0_CTRL=0;                        //控制MPU6050的AD0脚为低电平,从机地址为:0X68
  25.         
  26.         MPU_IIC_Init(); //初始化IIC总线
  27.         MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X80);        //复位MPU6050
  28.   delay_ms(100);
  29.         MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X00);        //唤醒MPU6050
  30.         MPU_Set_Gyro_Fsr(3);                                        //陀螺仪传感器,±2000dps
  31.         MPU_Set_Accel_Fsr(0);                                        //加速度传感器,±2g
  32.         MPU_Set_Rate(200);                                                //设置采样率50Hz
  33.         MPU_Write_Byte(MPU_INT_EN_REG,0X00);        //关闭所有中断
  34.         MPU_Write_Byte(MPU_USER_CTRL_REG,0X00);        //I2C主模式关闭
  35.         MPU_Write_Byte(MPU_FIFO_EN_REG,0X00);        //关闭FIFO
  36.         MPU_Write_Byte(MPU_INTBP_CFG_REG,0X80);//INT引脚低电平有效
  37.         res=MPU_Read_Byte(MPU_DEVICE_ID_REG);
  38.         if(res==MPU_ADDR)//器件ID正确
  39.         {
  40.                 MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X01);        //设置CLKSEL,PLL X轴为参考
  41.                 MPU_Write_Byte(MPU_PWR_MGMT2_REG,0X00);        //加速度与陀螺仪都工作
  42.                 MPU_Set_Rate(200);                                                //设置采样率为50Hz
  43.          }else return 1;
  44.         return 0;
  45. }
  46. //设置MPU6050陀螺仪传感器满量程范围
  47. //fsr:0,±250dps;1,±500dps;2,±1000dps;3,±2000dps
  48. //返回值:0,设置成功
  49. //    其他,设置失败
  50. u8 MPU_Set_Gyro_Fsr(u8 fsr)
  51. {
  52.         return MPU_Write_Byte(MPU_GYRO_CFG_REG,fsr<<3);//设置陀螺仪满量程范围  
  53. }
  54. //设置MPU6050加速度传感器满量程范围
  55. //fsr:0,±2g;1,±4g;2,±8g;3,±16g
  56. //返回值:0,设置成功
  57. //    其他,设置失败
  58. u8 MPU_Set_Accel_Fsr(u8 fsr)
  59. {
  60.         return MPU_Write_Byte(MPU_ACCEL_CFG_REG,fsr<<3);//设置加速度传感器满量程范围  
  61. }
  62. //设置MPU6050的数字低通滤波器
  63. //lpf:数字低通滤波频率(Hz)
  64. //返回值:0,设置成功
  65. //    其他,设置失败
  66. u8 MPU_Set_LPF(u16 lpf)
  67. {
  68.         u8 data=0;
  69.         if(lpf>=188)data=1;
  70.         else if(lpf>=98)data=2;
  71.         else if(lpf>=42)data=3;
  72.         else if(lpf>=20)data=4;
  73.         else if(lpf>=10)data=5;
  74.         else data=6;
  75.         return MPU_Write_Byte(MPU_CFG_REG,data);//设置数字低通滤波器  
  76. }
  77. //设置MPU6050的采样率(假定Fs=1KHz)
  78. //rate:4~1000(Hz)
  79. //返回值:0,设置成功
  80. //    其他,设置失败
  81. u8 MPU_Set_Rate(u16 rate)
  82. {
  83.         u8 data;
  84.         if(rate>1000)rate=1000;
  85.         if(rate<4)rate=4;
  86.         data=1000/rate-1;
  87.         data=MPU_Write_Byte(MPU_SAMPLE_RATE_REG,data);        //设置数字低通滤波器
  88.          return MPU_Set_LPF(rate/2);        //自动设置LPF为采样率的一半
  89. }

  91. //得到温度值
  92. //返回值:温度值(扩大了100倍)
  93. short MPU_Get_Temperature(void)
  94. {
  95.     u8 buf[2];
  96.     short raw;
  97.         float temp;
  98.         MPU_Read_Len(MPU_ADDR,MPU_TEMP_OUTH_REG,2,buf);
  99.     raw=((u16)buf[0]<<8)|buf[1];  
  100.     temp=36.53+((double)raw)/340;  
  101.     return temp*100;;
  102. }
  103. //得到陀螺仪值(原始值)
  104. //gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
  105. //返回值:0,成功
  106. //    其他,错误代码
  107. u8 MPU_Get_Gyroscope(short *gx,short *gy,short *gz)
  108. {
  109.     u8 buf[6],res;  
  110.         res=MPU_Read_Len(MPU_ADDR,MPU_GYRO_XOUTH_REG,6,buf);
  111.         if(res==0)
  112.         {
  113.                 *gx=((u16)buf[0]<<8)|buf[1];  
  114.                 *gy=((u16)buf[2]<<8)|buf[3];  
  115.                 *gz=((u16)buf[4]<<8)|buf[5];
  116.         }         
  117.     return res;;
  118. }
  119. //得到加速度值(原始值)
  120. //gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
  121. //返回值:0,成功
  122. //    其他,错误代码
  123. u8 MPU_Get_Accelerometer(short *ax,short *ay,short *az)
  124. {
  125.     u8 buf[6],res;  
  126.         res=MPU_Read_Len(MPU_ADDR,MPU_ACCEL_XOUTH_REG,6,buf);
  127.         if(res==0)
  128.         {
  129.                 *ax=((u16)buf[0]<<8)|buf[1];  
  130.                 *ay=((u16)buf[2]<<8)|buf[3];  
  131.                 *az=((u16)buf[4]<<8)|buf[5];
  132.         }         
  133.     return res;;
  134. }
  135. //IIC连续写
  136. //addr:器件地址
  137. //reg:寄存器地址
  138. //len:写入长度
  139. //buf:数据区
  140. //返回值:0,正常
  141. //    其他,错误代码
  142. u8 MPU_Write_Len(u8 addr,u8 reg,u8 len,u8 *buf)
  143. {
  144.         u8 i;
  145.     MPU_IIC_Start();
  146.         MPU_IIC_Send_Byte((addr<<1)|0);//发送器件地址+写命令        
  147.         if(MPU_IIC_Wait_Ack())        //等待应答
  148.         {
  149.                 MPU_IIC_Stop();                 
  150.                 return 1;               
  151.         }
  152.     MPU_IIC_Send_Byte(reg);        //写寄存器地址
  153.     MPU_IIC_Wait_Ack();                //等待应答
  154.         for(i=0;i<len;i++)
  155.         {
  156.                 MPU_IIC_Send_Byte(buf[i]);        //发送数据
  157.                 if(MPU_IIC_Wait_Ack())                //等待ACK
  158.                 {
  159.                         MPU_IIC_Stop();         
  160.                         return 1;                 
  161.                 }               
  162.         }   
  163.     MPU_IIC_Stop();         
  164.         return 0;        
  165. }
  166. //IIC连续读
  167. //addr:器件地址
  168. //reg:要读取的寄存器地址
  169. //len:要读取的长度
  170. //buf:读取到的数据存储区
  171. //返回值:0,正常
  172. //    其他,错误代码
  173. u8 MPU_Read_Len(u8 addr,u8 reg,u8 len,u8 *buf)
  174. {
  175.          MPU_IIC_Start();
  176.         MPU_IIC_Send_Byte((addr<<1)|0);//发送器件地址+写命令        
  177.         if(MPU_IIC_Wait_Ack())        //等待应答
  178.         {
  179.                 MPU_IIC_Stop();                 
  180.                 return 1;               
  181.         }
  182.     MPU_IIC_Send_Byte(reg);        //写寄存器地址
  183.     MPU_IIC_Wait_Ack();                //等待应答
  184.     MPU_IIC_Start();
  185.         MPU_IIC_Send_Byte((addr<<1)|1);//发送器件地址+读命令        
  186.     MPU_IIC_Wait_Ack();                //等待应答
  187.         while(len)
  188.         {
  189.                 if(len==1)*buf=MPU_IIC_Read_Byte(0);//读数据,发送nACK
  190.                 else *buf=MPU_IIC_Read_Byte(1);                //读数据,发送ACK  
  191.                 len--;
  192.                 buf++;
  193.         }   
  194.     MPU_IIC_Stop();        //产生一个停止条件
  195.         return 0;        
  196. }
  197. //IIC写一个字节
  198. //reg:寄存器地址
  199. //data:数据
  200. //返回值:0,正常
  201. //    其他,错误代码
  202. u8 MPU_Write_Byte(u8 reg,u8 data)                                 
  203. {
  204.     MPU_IIC_Start();
  205.         MPU_IIC_Send_Byte((MPU_ADDR<<1)|0);//发送器件地址+写命令        
  206.         if(MPU_IIC_Wait_Ack())        //等待应答
  207.         {
  208.                 MPU_IIC_Stop();                 
  209.                 return 1;               
  210.         }
  211.     MPU_IIC_Send_Byte(reg);        //写寄存器地址
  212.     MPU_IIC_Wait_Ack();                //等待应答
  213.         MPU_IIC_Send_Byte(data);//发送数据
  214.         if(MPU_IIC_Wait_Ack())        //等待ACK
  215.         {
  216.                 MPU_IIC_Stop();         
  217.                 return 1;                 
  218.         }                 
  219.     MPU_IIC_Stop();         
  220.         return 0;
  221. }
  222. //IIC读一个字节
  223. //reg:寄存器地址
  224. //返回值:读到的数据
  225. u8 MPU_Read_Byte(u8 reg)
  226. {
  227.         u8 res;
  228.     MPU_IIC_Start();
  229.         MPU_IIC_Send_Byte((MPU_ADDR<<1)|0);//发送器件地址+写命令        
  230.         MPU_IIC_Wait_Ack();                //等待应答
  231.     MPU_IIC_Send_Byte(reg);        //写寄存器地址
  232.     MPU_IIC_Wait_Ack();                //等待应答
  233.     MPU_IIC_Start();
  234.         MPU_IIC_Send_Byte((MPU_ADDR<<1)|1);//发送器件地址+读命令        
  235.     MPU_IIC_Wait_Ack();                //等待应答
  236.         res=MPU_IIC_Read_Byte(0);//读取数据,发送nACK
  237.     MPU_IIC_Stop();                        //产生一个停止条件
  238.         return res;               
  239. }
复制代码
  1. #include "sys.h"        
  2. #include "delay.h"        
  3. #include "led.h"
  4. #include "Motor.h"
  5. #include "usart.h"
  6. #include "timer.h"
  7. #include "pid.h"
  8. #include "oled.h"
  9. #include "mpu6050.h"
  10. #include "usmart.h"   
  11. #include "inv_mpu.h"
  12. #include "inv_mpu_dmp_motion_driver.h"

  14. //串口1发送1个字符
  15. //c:要发送的字符
  16. u8 a = 0;
  17. u16 Kms;

  19. float pitch;
  20. float roll,yaw;                 //欧拉角         
  21. short gyrox,gyroy,gyroz;        //陀螺仪原始数据
  22. short aacx,aacy,aacz;                //加速度传感器原始数据

  24. void usart1_send_char(u8 c)
  25. {           
  26.         while(USART_GetFlagStatus(USART1,USART_FLAG_TC)==RESET); //循环发送,直到发送完毕   
  27.         USART_SendData(USART1,c);  
  28. }
  29. //传送数据给匿名四轴上位机软件(V2.6版本)
  30. //fun:功能字. 0XA0~0XAF
  31. //data:数据缓存区,最多28字节!!
  32. //len:data区有效数据个数
  33. void usart1_niming_report(u8 fun,u8*data,u8 len)
  34. {
  35.         u8 send_buf[32];
  36.         u8 i;
  37.         if(len>28)return;        //最多28字节数据
  38.         send_buf[len+3]=0;        //校验数置零
  39.         send_buf[0]=0X88;        //帧头
  40.         send_buf[1]=fun;        //功能字
  41.         send_buf[2]=len;        //数据长度
  42.         for(i=0;i<len;i++)send_buf[3+i]=data[i];                        //复制数据
  43.         for(i=0;i<len+3;i++)send_buf[len+3]+=send_buf[i];        //计算校验和        
  44.         for(i=0;i<len+4;i++)usart1_send_char(send_buf[i]);        //发送数据到串口1
  45. }
  46. //发送加速度传感器数据和陀螺仪数据
  47. //aacx,aacy,aacz:x,y,z三个方向上面的加速度值
  48. //gyrox,gyroy,gyroz:x,y,z三个方向上面的陀螺仪值
  49. void mpu6050_send_data(short aacx,short aacy,short aacz,short gyrox,short gyroy,short gyroz)
  50. {
  51.         u8 tbuf[12];
  52.         tbuf[0]=(aacx>>8)&0XFF;
  53.         tbuf[1]=aacx&0XFF;
  54.         tbuf[2]=(aacy>>8)&0XFF;
  55.         tbuf[3]=aacy&0XFF;
  56.         tbuf[4]=(aacz>>8)&0XFF;
  57.         tbuf[5]=aacz&0XFF;
  58.         tbuf[6]=(gyrox>>8)&0XFF;
  59.         tbuf[7]=gyrox&0XFF;
  60.         tbuf[8]=(gyroy>>8)&0XFF;
  61.         tbuf[9]=gyroy&0XFF;
  62.         tbuf[10]=(gyroz>>8)&0XFF;
  63.         tbuf[11]=gyroz&0XFF;
  64.         usart1_niming_report(0XA1,tbuf,12);//自定义帧,0XA1
  65. }        
  66. //通过串口1上报结算后的姿态数据给电脑
  67. //aacx,aacy,aacz:x,y,z三个方向上面的加速度值
  68. //gyrox,gyroy,gyroz:x,y,z三个方向上面的陀螺仪值
  69. //roll:横滚角.单位0.01度。 -18000 -> 18000 对应 -180.00  ->  180.00度
  70. //pitch:俯仰角.单位 0.01度。-9000 - 9000 对应 -90.00 -> 90.00 度
  71. //yaw:航向角.单位为0.1度 0 -> 3600  对应 0 -> 360.0度
  72. void usart1_report_imu(short aacx,short aacy,short aacz,short gyrox,short gyroy,short gyroz,short roll,short pitch,short yaw)
  73. {
  74.         u8 tbuf[28];
  75.         u8 i;
  76.         for(i=0;i<28;i++)tbuf[i]=0;//清0
  77.         tbuf[0]=(aacx>>8)&0XFF;
  78.         tbuf[1]=aacx&0XFF;
  79.         tbuf[2]=(aacy>>8)&0XFF;
  80.         tbuf[3]=aacy&0XFF;
  81.         tbuf[4]=(aacz>>8)&0XFF;
  82.         tbuf[5]=aacz&0XFF;
  83.         tbuf[6]=(gyrox>>8)&0XFF;
  84.         tbuf[7]=gyrox&0XFF;
  85.         tbuf[8]=(gyroy>>8)&0XFF;
  86.         tbuf[9]=gyroy&0XFF;
  87.         tbuf[10]=(gyroz>>8)&0XFF;
  88.         tbuf[11]=gyroz&0XFF;        
  89.         tbuf[18]=(roll>>8)&0XFF;
  90.         tbuf[19]=roll&0XFF;
  91.         tbuf[20]=(pitch>>8)&0XFF;
  92.         tbuf[21]=pitch&0XFF;
  93.         tbuf[22]=(yaw>>8)&0XFF;
  94.         tbuf[23]=yaw&0XFF;
  95.         usart1_niming_report(0XAF,tbuf,28);//飞控显示帧,0XAF
  96. }  


  99. int main(void)
  100. {        
  101.          
  102.         u8 i,report=1;
  103.   
  104.         
  105.         delay_init();                     //延时函数初始化        
  106.    NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置NVIC中断分组2:2位抢占优先级，2位响应优先级                 
  107.         uart_init(115200);         //串口初始化为115200
  108.      delay_ms(100);
  109.           MPU_Init();                                        //初始化MPU6050
  110.         
  111.         
  112.             Motor_Init();        
  113.    
  114.            TIM2_PWM_Init(7199,0);         //不分频。PWM频率=72000000/900=80Khz
  115.       PID_Init();
  116.           LED_Init();//LED端口初始化
  117.          

  119.      mpu_dmp_init();
  120.                
  121.         MPU6050_EXTI_Init();//外部中断初始化
  122.          
  123.         
  124.          
  125. while(1)
  126.         {
  127.                         
  128.                
  129.         }         
  130. }

复制代码

所有资料51hei提供下载:
平衡版.7z (277.58 KB, 下载次数: 89)
BST STM32智能平衡小车.pdf (40 KB, 下载次数: 63)

评分

参与人数 1黑币 +100 收起 理由
admin + 100 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏4 分享淘帖 顶顶 踩踩
回复

使用道具 举报

沙发
ID:1 发表于 2019-1-25 15:23 | 只看该作者
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
回复

使用道具 举报

板凳
ID:119642 发表于 2020-2-19 19:59 | 只看该作者
黑51这个网站是比较厉害了。这个资料都出来了。
回复

使用道具 举报

地板
ID:730307 发表于 2020-4-16 09:39 | 只看该作者
不错不错
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表