經(jīng)過調(diào)試，LCD2004A可以顯示動態(tài)角度數(shù)據(jù)了，實驗視頻40秒

https://v.youku.com/v_show/id_XNTAyNTI1MDY0MA==.html?spm=a2hzp.8253869.0.0

https://v.youku.com/v_show/id_XNTAyNTI1MDY0MA==.html?spm=a2hzp.8253869.0.0

1. /*
   
2.   【Arduino】168種傳感器模塊系列實驗（資料代碼+圖形編程+仿真編程）
   
3.   實驗一百五十二：GY-25 串口直接輸出角度數(shù)據(jù) 傾斜度角度傳感器模塊 MPU-6050
   
4.   使用步驟：
   
5.   1.先下載GY25_uart程序至arduino
   
6.   2.再接上GY25模塊
   
7.   3.按復位按鍵
   
8.   4.打開串口，波特率115200
   
9.   5、接線
   
10.   GY25                arduino uno
    
11.   VCC----------------------VCC
    
12.   RX-----------------------TX
    
13.   TX-----------------------RX
    
14.   GND----------------------GND
    
15.   ---------------------------------------
    
16.   IICLCD2004           arduino uno
    
17.   VCC----------------------VCC
    
18.   SCL----------------------A5
    
19.   SDA----------------------A4
    
20.   GND----------------------GND
    
21.   實驗之二：IICLCD2004顯示動態(tài)角度數(shù)值
    
22. */
    
23. 
    
24. #include <Wire.h>
    
25. #include <LiquidCrystal_I2C.h>
    
26. int YPR[3];
    
27. unsigned char Re_buf[8], counter = 0;
    
28. unsigned char sign = 0;
    
29. int led = 13;
    
30. LiquidCrystal_I2C lcd(0x27, 20, 4); // set the LCD address to 0x20 for a 20 chars and 4 line display
    
31. 
    
32. //-----------------------------------------------------------
    
33. void setup()
    
34. {
    
35.   lcd.init();                      // initialize the lcd
    
36.   // Print a message to the LCD.
    
37.   Serial.begin(115200);
    
38.   delay(2000);
    
39.   Serial.write(0XA5);
    
40.   Serial.write(0X52);    //初始化GY25,連續(xù)輸出模式
    
41.   lcd.backlight();
    
42.   lcd.setCursor(0, 0);    //I2C接口LCD2004顯示初始值
    
43.   lcd.print("Yaw:");
    
44.   lcd.setCursor(0, 1);
    
45.   lcd.print("Pitch:");
    
46.   lcd.setCursor(0, 2);
    
47.   lcd.print("Roll:");
    
48. }
    
49. //-------------------------------------------------------------
    
50. void loop() {
    
51.   if (sign)
    
52.   {
    
53.     sign = 0;
    
54.     if (Re_buf[0] == 0xAA && Re_buf[7] == 0x55)   //檢查幀頭，幀尾
    
55.     {
    
56.       YPR[0] = (Re_buf[1] << 8 | Re_buf[2]) / 100; //合成數(shù)據(jù)，去掉小數(shù)點后2位
    
57.       YPR[1] = (Re_buf[3] << 8 | Re_buf[4]) / 100;
    
58.       YPR[2] = (Re_buf[5] << 8 | Re_buf[6]) / 100;
    
59. 
    
60.       lcd.setCursor(4, 0);
    
61.       lcd.print("    ");
    
62.       lcd.setCursor(4, 0);
    
63.       lcd.print(YPR[0]);      //顯示航向
    
64. 
    
65.       lcd.setCursor(6, 1);
    
66.       lcd.print("    ");
    
67.       lcd.setCursor(6, 1);   //顯示俯仰角
    
68.       lcd.print(YPR[1]);
    
69. 
    
70.       lcd.setCursor(5, 2);
    
71.       lcd.print("    ");
    
72.       lcd.setCursor(5, 2);    //顯示橫滾角
    
73.       lcd.print(YPR[2]);
    
74.       delay(100);
    
75.     }
    
76.   }
    
77. }
    
78. //----------------------------------------------------------
    
79. void serialEvent() {
    
80.   while (Serial.available()) {
    
81.     Re_buf[counter] = (unsigned char)Serial.read();
    
82.     if (counter == 0 && Re_buf[0] != 0xAA) return; // 檢查幀頭
    
83.     counter++;
    
84.     if (counter == 8)             //接收到數(shù)據(jù)
    
85.     {
    
86.       counter = 0;               //重新賦值，準備下一幀數(shù)據(jù)的接收
    
87.       sign = 1;
    
88.     }
    
89.   }
    
90. }

復制代碼

1. /*
   
2.   【Arduino】168種傳感器模塊系列實驗（資料代碼+圖形編程+仿真編程）
   
3.   實驗一百五十二：GY-25 串口直接輸出角度數(shù)據(jù) 傾斜度角度傳感器模塊 MPU-6050
   
4.   使用步驟：
   
5.   1.先下載GY25_uart程序至arduino
   
6.   2.再接上GY25模塊
   
7.   3.按復位按鍵
   
8.   4.打開串口，波特率115200
   
9.   5、接線
   
10.   GY25                arduino uno
    
11.   VCC----------------------VCC
    
12.   RX-----------------------TX
    
13.   TX-----------------------RX
    
14.   GND----------------------GND
    
15.   實驗之一：串口顯示動態(tài)角度數(shù)值
    
16. */
    
17. 
    
18. #include <Wire.h>
    
19. int YPR[3];
    
20. unsigned char Re_buf[8], counter = 0;
    
21. unsigned char sign = 0;
    
22. int led = 13;
    
23. 
    
24. //-----------------------------------------------------------
    
25. void setup()
    
26. {
    
27.   Serial.begin(115200);
    
28.   delay(2000);
    
29.   Serial.write(0XA5);
    
30.   Serial.write(0X52);    //初始化GY25,連續(xù)輸出模式
    
31. }
    
32. //-------------------------------------------------------------
    
33. void loop() {
    
34.   if (sign)
    
35.   {
    
36.     sign = 0;
    
37.     if (Re_buf[0] == 0xAA && Re_buf[7] == 0x55)   //檢查幀頭，幀尾
    
38.     {
    
39.       YPR[0] = (Re_buf[1] << 8 | Re_buf[2]) / 100; //合成數(shù)據(jù)，去掉小數(shù)點后2位
    
40.       YPR[1] = (Re_buf[3] << 8 | Re_buf[4]) / 100;
    
41.       YPR[2] = (Re_buf[5] << 8 | Re_buf[6]) / 100;
    
42.       Serial.print("YPR:\t");
    
43.       Serial.print(YPR[0], DEC); Serial.print("\t"); //顯示航向
    
44.       Serial.print(YPR[1], DEC); Serial.print("\t"); //顯示俯仰角
    
45.       Serial.println(YPR[2], DEC);                    //顯示橫滾角
    
46.       delay(50);
    
47.     }
    
48.   }
    
49. }
    
50. //---------------------------------------------------------------
    
51. void serialEvent() {
    
52.   while (Serial.available()) {
    
53.     Re_buf[counter] = (unsigned char)Serial.read();
    
54.     if (counter == 0 && Re_buf[0] != 0xAA) return; // 檢查幀頭
    
55.     counter++;
    
56.     if (counter == 8)             //接收到數(shù)據(jù)
    
57.     {
    
58.       counter = 0;               //重新賦值，準備下一幀數(shù)據(jù)的接收
    
59.       sign = 1;
    
60.     }
    
61.   }
    
62. }

復制代碼