标题: stm32 mpu6050驱动代码,数码管显示角度 [打印本页]

作者: op123567    时间: 2017-3-13 11:13
标题: stm32 mpu6050驱动代码,数码管显示角度
stm32mpu6050驱动代码,数码管显示角度。程序使用了dmp,且自动校准,用数码管显示一个方向的角度,其余方向也全读出来了,在代码里有

这文件是一些必要的资料


这是源代码:

完整源码下载:
角度仪—数码管.rar (10.55 MB, 下载次数: 85)




主程序预览(完整代码请下载附件):
  1. #include "led.h"                                       
  2. #include "delay.h"                                               
  3. #include "sys.h"
  4. #include "usart.h"
  5. #include "lcd.h"
  6. #include "anbt_dmp_fun.h"
  7. #include "anbt_i2c.h"  
  8. #include "anbt_dmp_mpu6050.h"
  9. #include "anbt_dmp_driver.h"
  10. #include "LED_NUM.h"

  11. void uart_send_status(float Pitch,float Roll,float Yaw)        ;                                                                                                                               

  12. u16 count=10000;                                                   
  13. u8 get_pose_flag = 0;
  14. extern u8 LED[4];
  15.                                                                                                                                        
  16. int main(void)
  17. {
  18.         SystemInit();                 //系统时钟等初始化
  19.         delay_init(72);                      //延时初始化
  20.         uart_init(115200);             //串口初始化为115200       
  21.         LCD_Init();
  22.         LCD_Clear(BLUE);
  23.         BACK_COLOR=BLUE;
  24.         POINT_COLOR=YELLOW;
  25.         LCD_ShowString(24,24,64,16,16,"X_ANGLE:");
  26.         LCD_ShowString(24,48,64,16,16,"Y_ANGLE:");
  27.         LCD_ShowString(24,72,64,16,16,"Z_ANGLE:");
  28.        
  29.         POINT_COLOR=RED;
  30.         LCD_WriteNUM_float(128,24,Pitch,16);
  31.         LCD_WriteNUM_float(128,48,Roll,16);
  32.         LCD_WriteNUM_float(128,72,Yaw,16);
  33.         ANBT_I2C_Configuration();                  //IIC初始化
  34.         AnBT_DMP_MPU6050_Init();                        //6050DMP初始化,关闭去除偏移量,自动水平校准
  35.         NVIC_Configuration();         //设置NVIC中断分组2:2位抢占优先级,2位响应优先级
  36.         LED_NUM_Init();

  37.         while(1)
  38.         {
  39.                         POINT_COLOR=RED;
  40.                         LCD_WriteNUM_float(128,24,Pitch,16);
  41.                         LCD_WriteNUM_float(128,48,Roll,16);
  42.                         LCD_WriteNUM_float(128,72,Yaw,16);
  43. //                        printf(" %8f   %8f   %8f\n\r",Pitch, Roll, Yaw);
  44.                         UART1_Put_Char((int)(Pitch*10)%256);UART1_Put_Char((int)(Pitch*10)/256);
  45.                         UART1_Put_Char((int)(Roll*10)%256);UART1_Put_Char((int)(Roll*10)/256);
  46.                         UART1_Put_Char((int)(Yaw*10)%256);UART1_Put_Char((int)(Yaw*10)/256);
  47.         }
  48. }       

  49. void EXTI1_IRQHandler(void)
  50. {                      

  51.     if(EXTI_GetITStatus(EXTI_Line1) != RESET)
  52.         {   
  53.                 MPU6050_Pose();
  54.                 LED_NUM_Display();
  55.         }
  56.          EXTI_ClearITPendingBit(EXTI_Line1);

  57. }

复制代码



作者: zach009    时间: 2018-11-24 23:47
这个程序很好,很仔细啊,谢谢楼主啦啦啦




欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1