標題: jy-61傳感器STM32F1版本程序 [打印本頁]
作者: 黑客帝國    時間: 2020-3-25 09:25
標題: jy-61傳感器STM32F1版本程序
jy-61傳感器STM32F1版本，供參考使用

單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "key.h"
  4. #include "sys.h"
  5. #include "usart.h"
  6. #include "oled.h"
  7. #include "string.h"


  10. extern unsigned char Re_buf[11],temp_buf[11],counter;
  11. extern unsigned char sign,t,he;
  12. float a[3],w[3],angle[3],T;
  13. extern  unsigned char Temp[11];
  14. char dis_main[20];
  15. int main(void)
  16. {               
  17.         u16 t;  
  18.         u16 len;       
  19.         u16 times=0;
  20.         delay_init();                     //延時函數(shù)初始化          
  21.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //設置NVIC中斷分組2:2位搶占優(yōu)先級，2位響應優(yōu)先級
  22.         uart_init(115200);         //串口初始化為115200
  23.         LED_Init();                             //LED端口初始化
  24.         KEY_Init();          //初始化與按鍵連接的硬件接口
  25.         OLED_Init();
  26.         while(1)
  27.         {
  28.                
  29.                  if(sign)
  30.       {  
  31.          memcpy(Temp,Re_buf,11);
  32.          sign=0;
  33.          if(Re_buf[0]==0x55)       //檢查幀頭
  34.          {  
  35.             switch(Re_buf[1])
  36.             {
  37.                case 0x51: //標識這個包是加速度包
  38.                   a[0] = ((short)(Temp[3]<<8 | Temp[2]))/32768.0*16;      //X軸加速度
  39.                   a[1] = ((short)(Temp[5]<<8 | Temp[4]))/32768.0*16;      //Y軸加速度
  40.                   a[2] = ((short)(Temp[7]<<8 | Temp[6]))/32768.0*16;      //Z軸加速度
  41.                   T    = ((short)(Temp[9]<<8 | Temp[8]))/340.0+36.25;      //溫度
  42.                   break;
  43.                case 0x52: //標識這個包是角速度包
  44.                   w[0] = ((short)(Temp[3]<<8| Temp[2]))/32768.0*2000;      //X軸角速度
  45.                   w[1] = ((short)(Temp[5]<<8| Temp[4]))/32768.0*2000;      //Y軸角速度
  46.                   w[2] = ((short)(Temp[7]<<8| Temp[6]))/32768.0*2000;      //Z軸角速度
  47.                   T    = ((short)(Temp[9]<<8| Temp[8]))/340.0+36.25;      //溫度
  48.                   break;
  49.                case 0x53: //標識這個包是角度包
  50.                   angle[0] = ((short)(Temp[3]<<8| Temp[2]))/32768.0*180;   //X軸滾轉(zhuǎn)角（x 軸）
  51.                   angle[1] = ((short)(Temp[5]<<8| Temp[4]))/32768.0*180;   //Y軸俯仰角（y 軸）
  52.                   angle[2] = ((short)(Temp[7]<<8| Temp[6]))/32768.0*180;   //Z軸偏航角（z 軸）
  53.                   T        = ((short)(Temp[9]<<8| Temp[8]))/340.0+36.25;   //溫度

  55.                   //printf("X軸角度：%.2f   Y軸角度：%.2f   Z軸角度：%.2f\r\n",angle[0],angle[1],angle[2]);
  56.                   break;
  57.                default:  break;
  58.             }
  59.          }
  60.          
  61.       }
  62. //                         sprintf(dis_main,"           ");
  63. //             OLED_ShowString(0,0,(u8*)dis_main);
  64. //                         sprintf(dis_main,"                   ");
  65. //             OLED_ShowString(0,2,(u8*)dis_main);
  66.                        
  67.                          //顯示角度
  68.                          sprintf(dis_main,"X=%d  Y=%d  ",(int )(angle[0]),(int)(angle[1]));
  69.              OLED_ShowString(0,0,(u8*)dis_main);
  70.                          sprintf(dis_main,"Z=%d  T=%d  ",(int )(angle[2]),(int)(T));
  71.              OLED_ShowString(0,2,(u8*)dis_main);
  72.                        
  73.                        
  74.                        
  75.                        
  76.                        
  77.                        
  78.                
  79.         }         
  80. }
復制代碼

所有資料51hei提供下載:
JY61測試代碼.7z (194.9 KB, 下載次數(shù): 30)






歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1