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"
   
8. 
   
9. 
   
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();                     //延时函数初始化          
    
21.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
    
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轴滚转角（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;   //温度
    
54. 
    
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, 下载次数: 30)

2020-3-25 16:14 上传

点击文件名下载附件