久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: 分享一個基于K60讀取顯示姿態(tài)傳感器MPU6050的源程序 [打印本頁]

作者: chm    時間: 2019-4-6 12:11
標題: 分享一個基于K60讀取顯示姿態(tài)傳感器MPU6050的源程序
K60使用山外K60DN,姿態(tài)傳感器使用GY-25(串口輸出式的MPU6050),LCD使用1.44寸128*128的山外液晶屏,傳感器自帶卡爾曼濾波輸出,單片機控制簡單穩(wěn)定。

單片機源程序如下:
  1. #include "common.h"
  2. #include "include.h"

  3. unsigned char Re_buf[11],counter=0;
  4. int Pitch,Roll,Yaw;    //串口mpu6050輸出的3個角度
  5. char angle_reflash=0;

  6. void uart4_handler(void)        //串口4中斷函數(shù)
  7. {
  8.   if(uart_query(UART4) == 1)   //接收數(shù)據(jù)寄存器滿
  9.   {
  10.      uart_getchar(UART4,Re_buf+counter);
  11.      if (counter==0 && Re_buf[0]!=0xAA) return; //第0號數(shù)據(jù)不是幀頭,跳過,重新接收
  12.      counter++;
  13.      if (counter==8 && Re_buf[0]==0xAA && Re_buf[7]==0x55) //接收到8個正確數(shù)據(jù)
  14.      {
  15.        counter=0;//重新賦值,準備下一幀數(shù)據(jù)的接收   
  16.        Yaw   =((short)(Re_buf[1]<<8|Re_buf[2]))/100+180; //航向角Yaw
  17.        Pitch =((short)(Re_buf[3]<<8|Re_buf[4]))/100+180; //俯仰角Pitch
  18.        Roll  =((short)(Re_buf[5]<<8|Re_buf[6]))/100+180; //橫滾角Roll
  19.        angle_reflash=1;     //標志角度更新完成
  20.      }
  21.   }  
  22. }

  23. void main()
  24. {   
  25.     char i=0,j=1;
  26.     Site_t site41 = {88,16};
  27.     Site_t site42 = {88,40};
  28.     Site_t site43 = {88,64};
  29.    
  30.     led_init(LED_MAX);
  31.     LCD_init();
  32.     uart_init(UART4,115200);    //串口MPU6050所用串口初始化
  33.     set_vector_handler(UART4_RX_TX_VECTORn,uart4_handler);
  34.    
  35.     PTB20_OUT=0,PTB21_OUT=0,PTB22_OUT=0,PTB23_OUT=0;//4燈全亮
  36.    
  37.     while(1)
  38.     {
  39.         uart_rx_irq_en (UART4);//開串口4中斷,接收最新角度數(shù)據(jù)
  40.         while ( angle_reflash==0 )  ;
  41.         angle_reflash=0;
  42.         uart_rx_irq_dis(UART4);//關(guān)串口4中斷  
  43.         LCD_num_BC(site41,Pitch,5, BLUE,RED);     //顯示俯仰角
  44.         LCD_num_BC(site42,Roll, 5, BLUE,RED);     //    橫滾角
  45.         LCD_num_BC(site43,Yaw,  5, BLUE,RED);     //    航向角
  46.         i++;
  47.         if (i>70)      //最小系統(tǒng)的4個LED形成流水燈,指示程序正常運行
  48.         {               //PTB20,21,22,23,低電平點亮
  49.           i=0;
  50.           GPIO_SET_NBIT(4,PTB20,15-j);//4位整體賦值。15-j起到把j按位取反的作用
  51.           j=j*2;                       //1,2,4,8——0001,0010,0100,1000
  52.           if (j>=16) j=1;
  53.         }
  54.         DELAY_MS(5);    //相當于5ms定時中斷的作用
  55.     }
  56. }
復(fù)制代碼

所有資料51hei提供下載:
K60 串口6050 LCD.7z (1.01 MB, 下載次數(shù): 51)




作者: 嵐風吟    時間: 2019-7-19 22:27
很好很實用呢
作者: 13680785914    時間: 2019-8-6 22:35
嵐風吟 發(fā)表于 2019-7-19 22:27
很好很實用呢

可以分享一下嗎,幣不夠,很凄涼




歡迎光臨 (http://m.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板: 久久国产区 | 日韩电影一区二区三区 | 日本精品视频在线观看 | 91精品国产99| 亚洲欧美在线一区 | 91久久国产综合久久 | 羞羞视频在线观看免费观看 | 精品在线一区二区三区 | 成人欧美一区二区三区在线播放 | 久久亚洲一区二区三区四区 | 久久伊人免费视频 | 国产在线观看一区 | 围产精品久久久久久久 | 午夜在线 | 国产在线精品一区二区三区 | 中日韩欧美一级片 | 国产999精品久久久影片官网 | 亚洲二区在线观看 | 国产精品久久久久久久久久 | 国产精品久久久久久久免费观看 | 国际精品鲁一鲁一区二区小说 | 亚洲一区二区视频 | av香蕉| 在线看免费 | 成人在线视频网址 | 2018国产大陆天天弄 | 99爱在线免费观看 | 午夜视频在线观看网址 | 国产成人精品一区二 | 亚洲va在线va天堂va狼色在线 | 亚洲精品久 | 色.com | a在线视频 | 五月天婷婷久久 | 美日韩一区二区 | 精品一区二区三区四区视频 | 久久久久国产一区二区三区四区 | 亚洲国产高清高潮精品美女 | 久草新在线 | 亚洲成人天堂 | 久草新在线 |