Bolla elettronica 2 assi con mpu6050 e Arduino

Ciao!

Questo progetto nasce da un'esigenza di Dino che mi ha scritto nella sezione "chiedi e rispondi".

Il progetto è composto da un accelerometro a 3 assi mpu6050 (link eBay) da un display lcd i2c (io ho usato quello della Seeed, link ebay) e ovviamente dal nostro Arduino.

Il progetto consiste in una bolla elettronica, un oggetto in grado di restituire un valore diverso in base all'angolo di rotazione sugli assi X e Y.

Il limite di questo oggetto è che, mancando il magnetometro, oltre un certo angolo su un asse non si riesce ad ottenere un valore coerente sull'altro asse. 

Nel nostro caso questo problema può non essere rilevante, in quanto l'obbiettivo è misurare variazioni di pochi gradi rispetto al piano perpendicolare all'asse Z.

Ecco un video che ne mostra il funzionamento

Per prima cosa è necessario collegare i componenti in questo modo, ovviamente potete anche utilizzare una breadboard per aiutarvi nel collegare i componenti

Se non l'avete ancora fatto scaricate ed installate questa libreria per il display della Seeed,
poi caricate nell'Arduino lo sketch che trovate qui sotto:

1. #include <Wire.h>
2. #include "rgb_lcd.h"
3. rgb_lcd lcd;
5. const int MPU = 0x68;
6. int16_t AcX, AcY, AcZ, Tmp, GyX, GyY, GyZ;
7. int16_t RollVal, PitchVal, PrevRollVal, PrevPitchVal;
9. void setup() {
11.   Serial.begin(115200);
12.   Wire.begin();
14.   Wire.beginTransmission(MPU);
15.   Wire.write(0x6B);
16.   Wire.write(0);    
17.   Wire.endTransmission(true);
19.   lcd.begin(16, 2);
20.   lcd.setRGB(50, 100, 200);
21.   lcd.setCursor(0, 0);
22.   lcd.print("DanieleAlberti");
23.   lcd.setCursor(13, 1);
24.   lcd.print(".It");
25.   delay(3000);
26.   lcd.clear();
28.   lcd.setRGB(200, 100, 200);
29.   lcd.setCursor(0, 0);
30.   lcd.print("Bolla");
31.   lcd.setCursor(5, 1);
32.   lcd.print("Elettronica");
33.   delay(3000);
34.   lcd.clear();
35.   lcd.setRGB(255, 255, 255);
36. }
38. void loop() {
39.   Wire.beginTransmission(MPU);
40.   Wire.write(0x3B);
41.   Wire.endTransmission(false);
42.   Wire.requestFrom(MPU, 14, true); // request a total of 14 registers
43.   AcX = Wire.read() << 8 | Wire.read(); // 0x3B (ACCEL_XOUT_H) & 0x3C (ACCEL_XOUT_L)
44.   AcY = Wire.read() << 8 | Wire.read(); // 0x3D (ACCEL_YOUT_H) & 0x3E (ACCEL_YOUT_L)
45.   AcZ = Wire.read() << 8 | Wire.read(); // 0x3F (ACCEL_ZOUT_H) & 0x40 (ACCEL_ZOUT_L)
46.   Tmp = Wire.read() << 8 | Wire.read(); // 0x41 (TEMP_OUT_H) & 0x42 (TEMP_OUT_L)
47.   GyX = Wire.read() << 8 | Wire.read(); // 0x43 (GYRO_XOUT_H) & 0x44 (GYRO_XOUT_L)
48.   GyY = Wire.read() << 8 | Wire.read(); // 0x45 (GYRO_YOUT_H) & 0x46 (GYRO_YOUT_L)
49.   GyZ = Wire.read() << 8 | Wire.read(); // 0x47 (GYRO_ZOUT_H) & 0x48 (GYRO_ZOUT_L)
51.   PrevPitchVal = PitchVal;
52.   PrevRollVal = RollVal;
54.   PitchVal = atan2(AcX , AcZ) * 57.3;
55.   RollVal = atan2(AcY , AcZ) * 57.3;
57.   lcd.setCursor(0, 0);
58.   lcd.print("X angle: ");
59.   lcd.print(PitchVal);
61.   lcd.setCursor(0, 1);
62.   lcd.print("Y angle: ");
63.   lcd.print(RollVal);
65.   Serial.print("x: ");
66.   Serial.println(AcX);
68.   Serial.print("y: ");
69.   Serial.println(AcY);
71.   Serial.print("z: ");
72.   Serial.println(AcZ);
74.   Serial.print("Roll: ");
75.   Serial.println(RollVal);
77.   Serial.print("Pitch: ");
78.   Serial.println(PitchVal);
80.   delay(500);
81.   lcd.clear();
82. }

Ora non vi resta che alimentare il tutto (con un power bank o con un pacco batterie come mostrato qui) e costruirvi un case per proteggere l'elettronica.


Questo è tutto!
Seguimi sulle mie pagine per rimanere sempre aggiornato sui nuovi post!