你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【经验分享】STM32开源代码——MPU6050程序

[复制链接]
STMCU小助手 发布时间:2022-2-5 23:00
  1. #include "led.h"
    + E) A( Q8 [0 v4 t
  2. #include "delay.h"
    % `% |, M% {, L: i; F
  3. #include "key.h"1 d% ^* k( m! F1 Y5 o. a
  4. #include "sys.h"  G, l( N$ s) v  r
  5. #include "usart.h". c& o0 G- E; e, ?$ x9 l. n
  6. #include "mpu6050.h"& B$ ]( v8 L/ [' I# p/ ^$ g  K
  7. #include "inv_mpu.h". M; F6 {2 V, N  T* S: t
  8. #include "inv_mpu_dmp_motion_driver.h": z7 q7 U, H) N) o8 Z+ m+ V& D5 ?+ r1 _
  9. /************************************************
    # v& k  Q; [; C! U3 l
  10. ALIENTEK精英STM32开发板9 t" z# L# n8 H- k5 T$ {
  11. 作者:唯恋殊雨) `/ X8 f8 y1 N! S; h% {
  12. CSDN博客:https://blog.csdn.net/tichimi3375* {: n% X9 e+ R, r8 M
  13. SCL-PB6. d$ S* U# E, e$ @% l' E/ P
  14. SDA-PB7
    % L4 t" g; v/ D5 o4 {8 f
  15. ************************************************/
    + R$ B+ Q# I* W" ]5 Y/ f" d
  16. int main(void)
    * w9 P0 V& {+ y; D4 G
  17. {7 d" `4 V1 U; W7 n9 `9 c' _) ~0 h  ^
  18.     u8 t=0,report=1;            //默认开启上报
    - o3 v8 N2 D8 d0 a2 @0 R
  19.     u8 key;& Y. X& V* R; ?7 I  u3 h
  20.     float pitch,roll,yaw;         //欧拉角
    ( f! ~* W+ T$ G3 b8 u( I
  21.     short aacx,aacy,aacz;        //加速度传感器原始数据: L% C0 T. i  R$ _. I5 x, o
  22.     short gyrox,gyroy,gyroz;    //陀螺仪原始数据
      i. L3 {. y1 r1 o
  23.     short temp;                    //温度3 r8 ^( P2 U, b6 n; e
  24.     SystemInit();
    6 ]& E/ [; U) y) \; P4 @/ z# j
  25.     NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);     //设置NVIC中断分组2:2位抢占优先级,2位响应优先级
    8 J8 _/ |7 U, @5 h/ x
  26.     uart_init(115200);         //串口初始化为500000
    - |+ D0 G( E* J4 U4 q- V
  27.     delay_init();    //延时初始化
    7 c# ]7 Y% `: D. [
  28.     LED_Init();                      //初始化与LED连接的硬件接口; @# C7 I+ C% M& n, O
  29.     KEY_Init();                    //初始化按键6 ~" }4 l# S& E1 E' g/ [: ?0 B, k
  30.     MPU_Init();                    //初始化MPU6050: p- U* c# x. h( l9 K. v1 u
  31.     while(mpu_dmp_init()): B: ^8 v: K3 c; {3 ]) N! M; T
  32.      {
    4 s) i4 c! j( O# k( L4 M  [
  33.         printf("\n\rMPU6050 Error\n\r");, [6 M0 ~2 g* R) p7 n6 w
  34.         delay_ms(200);
    1 s8 @1 p& W, j5 @
  35.     }4 @2 k4 S/ n2 M$ t3 M- e2 C# l
  36.      while(1)& q, v6 n  J. Q7 o& G# u6 |
  37.     {
    - I1 }3 t1 i, R5 t  _% F7 D
  38.         key=KEY_Scan(0);- s% [% \7 j$ m& V( X% l: n, S
  39.         if(key==KEY0_PRES)8 ?, i" ?1 D% ?
  40.         {
    - t0 q+ J  N/ ]5 S
  41.             report=!report;/ q2 d& n/ C9 b( `: Y
  42.             if(report)printf("\n\rUPLOAD ON \n\r");
    6 ^+ }+ a. p  F9 Q0 V8 W, K, F
  43.             else printf("\n\rUPLOAD OFF\n\r");
    9 c$ B0 w# g7 r" D" o
  44.         }
    # V) i( N7 N' i; Y
  45.         if(mpu_dmp_get_data(&pitch,&roll,&yaw)==0)6 J; C$ s0 ~5 y
  46.         {
    , S* \# S+ S3 s
  47.             temp=MPU_Get_Temperature();    //得到温度值
    4 T& D2 H7 v! A. y4 k# v1 |
  48.             MPU_Get_Accelerometer(&aacx,&aacy,&aacz);    //得到加速度传感器数据; @, R& _" n' b) A+ M$ A
  49.             MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);    //得到陀螺仪数据5 X1 @0 N2 o" N( {: S4 z9 _" R
  50.             if(report)mpu6050_send_data(aacx,aacy,aacz,gyrox,gyroy,gyroz);//用自定义帧发送加速度和陀螺仪原始数据
    1 Q2 T; m1 p, g
  51.             if(report)usart1_report_imu(aacx,aacy,aacz,gyrox,gyroy,gyroz,(int)(roll*100),(int)(pitch*100),(int)(yaw*10));
    - X( t' T- W; ~' @' T: n3 i
  52.             if((t%10)==0)
    , ~2 q/ o* j8 m4 K, c
  53.             {
    " j, Z3 w! H' X+ @- @3 `8 t
  54.                 printf("\n\rtemp:%f\n\r",temp/100.0);$ _% j) h  a+ y( t( \: i
  55.                 printf("\n\rpitch:%f\n\r",pitch*10);
    4 w6 f! y% V6 N3 c" t# s2 I2 q
  56.                 printf("\n\rroll:%f\n\r",roll*10);( P2 X$ d3 t, m& E
  57.                 printf("\n\ryaw:%f\n\r",yaw*10);- q5 N6 O. P' L
  58.                 t=0;
    # u/ k1 V2 y$ j* Q9 k1 Y
  59.             }
    $ i+ J: z& P& m6 N; L' t
  60.         }
    * g: e+ M" Z  C% g# Q: X# C
  61.         t++;
    % Z5 a6 [  R5 G
  62.     }
    % \- ]3 O1 c4 J( P; ~# [
  63. }
复制代码
6 u! Y5 M: I: U0 g+ K

, k2 F! A& E$ l, L' u+ C# e% c! [1 _
赞 收藏 评论0 发布时间:2022-2-5 23:00

举报

0个回答

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版