stm32f1想通过mpu6050控制灯带顺时针或逆时针流水一次就停止。

炒豆芽

stm32f1想通过mpu6050控制灯带顺时针或逆时针流水一次就停止。直到标志位MPU6050_GetFlag()变化才再流水。不知道怎么设置程序。目前处于一直流水，标志位MPU6050_GetFlag()变化会更新方向，但是还是一直流水。

1. #include "stm32f10x.h"                  // Device header
   
2. #include "OLED.h"
   
3. #include "MPU6050.h"
   
4. #include "DMP.h"
   
5. #include "Delay.h"
   
6. #include "LED.h"
   
7. #include "Key.h"
   
8. #include "RCC.h"
   
9. #include "IO.h"
   
10. #include "TIM3.h"
    
11. #include "WS2812B.h"
    
12. #include "OLED.h"
    
13. #include <stdlib.h>
    
14. #include "MPU6050_INT.h"
    
15. 
    
16. #define Brightness 0x010101
    
17. 
    
18. //关于MPU6050
    
19. uint8_t ID, INT;
    
20. int16_t AX, AY, AZ, GX, GY, GZ;
    
21. float pitch, roll, yaw;
    
22. uint8_t KeyNum, Count=0;
    
23. uint8_t Lock=0, Flow, FlowCount;
    
24. 
    
25. 
    
26. //关于WS2812B
    
27. uint8_t MODE=1;
    
28. uint8_t UpdateFlag=1;
    
29. uint8_t Light_Mode, Light_Flag, AngleFlag=0;
    
30. uint16_t Light_Time;
    
31. 
    
32. #define WS2812B_LED_QUANTITY        29  //灯珠数量-1
    
33. 
    
34. //后置函数的提前定义
    
35. void Close(void);
    
36. void WhiteLight(void);
    
37. void WhiteLight_Up(void);
    
38. void WhiteLight_Down(void);
    
39. void MainLoop(void);
    
40. 
    
41. void Init(void)
    
42. {
    
43.         RCC_Init();
    
44.         Key_Init();
    
45.         WS2812B_Init();
    
46.         TIM3_SetIRQHandler(MainLoop);
    
47.         TIM3_Init();
    
48.         LED_Init();
    
49.         OLED_Init();
    
50.         MPU6050_Init();
    
51. }
    
52. 
    
53. int main(void)
    
54. {
    
55.         Init();
    
56.         while(1)
    
57.         {
    
58.                 get_angles((float)AX, (float)AY, (float)AZ, (float)GX, (float)GY, (float)GZ, &pitch, &roll, &yaw);
    
59.                
    
60.                 KeyNum=Key_GetNum();
    
61.                 if(KeyNum==0)
    
62.                 {
    
63.                         Lock=!Lock;
    
64.                         if(Lock==1)
    
65.                         {
    
66.                                 Light_Flag=1;
    
67.                                 Close();
    
68.                         }
    
69.                         else
    
70.                         {
    
71.                                 Light_Flag=0;
    
72.                         }               
    
73.                 }
    
74.                 if(Lock==0)
    
75.                 {
    
76. //                        if(MPU6050_GetFlag()==1 && UpdateFlag==1)
    
77. //                        {
    
78.                         if(MPU6050_GetFlag()==1)
    
79.                         {
    
80.                                 if(MPU6050_GetFlag()==1)
    
81.                                 {
    
82.                                         UpdateFlag=0;
    
83.                                 }
    
84.                                 if(MPU6050_GetFlag()==2)
    
85.                                 {
    
86.                                         UpdateFlag=1;
    
87.                                 }
    
88.                                 MODE=2;
    
89.                         }
    
90. //                        if(MPU6050_GetFlag()==2 && UpdateFlag==1)
    
91. //                        {
    
92.                         if(MPU6050_GetFlag()==2)
    
93.                         {
    
94.                                 if(MPU6050_GetFlag()==2)
    
95.                                 {
    
96.                                         UpdateFlag=0;
    
97.                                 }
    
98.                                 if(MPU6050_GetFlag()==1)
    
99.                                 {
    
100.                                         UpdateFlag=1;
     
101.                                 }
     
102.                                 MODE=3;
     
103.                         }
     
104.                 }
     
105.                 else
     
106.                 {
     
107.                         OLED_ShowString(2,11,"LOCK  ");
     
108.                 }
     
109.                 switch(MODE)
     
110.                 {
     
111.                         case 1:Close();break;
     
112.                         case 2:WhiteLight_Up();break;
     
113.                         case 3:WhiteLight_Down();break;
     
114.                 }
     
115.         }
     
116. }
     
117. 
     
118. void Close(void)        //MODE=1
     
119. {
     
120. 
     
121.         WS2812B_SetBuf(0x000000);
     
122.         WS2812B_UpdateBuf();
     
123. 
     
124. }
     
125. 
     
126. void WhiteLight_Up(void)        //MODE=2
     
127. {
     
128.         if(Light_Flag==0)
     
129.         {
     
130. //                if(UpdateFlag==1)
     
131. //                {
     
132.                         uint8_t i;
     
133.                         static uint8_t j;
     
134.                         Light_Time=10;
     
135.                         for(i=0;i<WS2812B_LED_QUANTITY;i++)
     
136.                         {
     
137.                                 WS2812B_Buf[i]=WS2812B_Buf[i+1];
     
138.                         }
     
139.                         if(j<5)
     
140.                         {
     
141.                                 WS2812B_Buf[WS2812B_LED_QUANTITY]=Brightness;
     
142.                         }
     
143.                         else
     
144.                         {
     
145.                                 WS2812B_Buf[WS2812B_LED_QUANTITY]=0;
     
146.                         }
     
147.                        
     
148.                         j++;
     
149.                         j%=40;
     
150.                         WS2812B_UpdateBuf();
     
151. //                }
     
152.         }
     
153. }
     
154. 
     
155. void WhiteLight_Down(void)        //MODE=3
     
156. {
     
157.         if(Light_Flag==0)
     
158.         {
     
159. //                if(UpdateFlag==1)
     
160. //                {
     
161.                         uint8_t i;
     
162.                         static uint8_t j;
     
163.                         Light_Time=10;
     
164.                         for(i=WS2812B_LED_QUANTITY;i>0;i--)
     
165.                         {
     
166.                                 WS2812B_Buf[i]=WS2812B_Buf[i-1];
     
167.                         }
     
168.                         if(j<5)
     
169.                         {
     
170.                                 WS2812B_Buf[0]=Brightness;
     
171.                         }
     
172.                         else
     
173.                         {
     
174.                                 WS2812B_Buf[0]=0;
     
175.                         }
     
176. 
     
177.                         j++;
     
178.                         j%=40;
     
179.                         WS2812B_UpdateBuf();
     
180. //                }
     
181.         }
     
182. }
     
183. 
     
184. void MainLoop(void)
     
185. {
     
186.         static uint16_t LoopCount;
     
187.         LoopCount++;
     
188.         if(LoopCount>=Light_Time)
     
189.         {
     
190.                 LoopCount=0;
     
191.         }
     
192. }
     

复制代码

ctq

Close（）函数是停止函数吗？如果是的话，从给出的代码来看，MODE除了初始化，赋值为2或3后就没有任何一种情况赋值为1，所以
case 1:Close();break;
此判断不会执行，
只有下面的判断才有可能进入Close（）
if(KeyNum==0)
                {
                        Lock=!Lock;
                        if(Lock==1)
                        {
                                Light_Flag=1;
                                Close();
                        }
可以调试查看下KeyNum值的变化情况