ΠΠΈΡΠΎΡΠΊΠΎΠΏ-Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ GY-521 | 2 Π‘Ρ Π΅ΠΌΡ

ΠΠ°Π½Π½ΡΠΉ ΠΌΠΎΠ΄ΡΠ»Ρ ΠΏΡΠ΅Π΄ΡΡΠ°Π²Π»ΡΠ΅Ρ ΡΠΎΠ±ΠΎΠΉ ΠΊΠΎΠΌΠ±ΠΈΠ½ΠΈΡΠΎΠ²Π°Π½Π½ΡΠΉ Π΄Π°ΡΡΠΈΠΊ, ΠΎΠ±ΡΠ΅Π΄ΠΈΠ½ΡΡΡΠΈΠΉ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ, Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΈ ΡΠ΅ΡΠΌΠΎΠΌΠ΅ΡΡ. ΠΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ β ΡΡΠΎ ΠΏΡΠΈΠ±ΠΎΡ, ΠΊΠΎΡΠΎΡΡΠΉ ΠΈΠ·ΠΌΠ΅ΡΡΠ΅Ρ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΠ΅ ΡΠ΅Π»Π°. Π ΡΠΎΡΡΠΎΡΠ½ΠΈΠΈ ΠΏΠΎΠΊΠΎΡ, Π»ΠΈΠ±ΠΎ ΡΠ°Π²Π½ΠΎΠΌΠ΅ΡΠ½ΠΎΠ³ΠΎ ΠΏΡΡΠΌΠΎΠ»ΠΈΠ½Π΅ΠΉΠ½ΠΎΠ³ΠΎ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΡ Π½Π° ΠΏΠΎΠ²Π΅ΡΡ Π½ΠΎΡΡΠΈ ΠΠ΅ΠΌΠ»ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΏΠΎΠΊΠ°ΠΆΠ΅Ρ ΡΠΎΠ»ΡΠΊΠΎ Π½Π°Π»ΠΈΡΠΈΠ΅ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΡ, ΠΎΠ±ΡΡΠ»ΠΎΠ²Π»Π΅Π½Π½ΠΎΠ³ΠΎ Π΄Π΅ΠΉΡΡΠ²ΠΈΠ΅ΠΌ ΠΏΠΎΠ»Ρ ΡΠΈΠ»Ρ ΡΡΠΆΠ΅ΡΡΠΈ ΠΠ΅ΠΌΠ»ΠΈ. ΠΠΈΡΠΎΡΠΊΠΎΠΏ ΡΠΏΠΎΡΠΎΠ±Π΅Π½ ΡΠ΅Π°Π³ΠΈΡΠΎΠ²Π°ΡΡ Π½Π° ΠΈΠ·ΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ ΠΎΡΠΈΠ΅Π½ΡΠ°ΡΠΈΠΈ ΡΠ΅Π»Π° Π² ΠΏΡΠΎΡΡΡΠ°Π½ΡΡΠ²Π΅. Π Π³ΠΈΡΠΎΡΠΊΠΎΠΏ, ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΡΠ°Π±ΠΎΡΠ°ΡΡ Π²Π΄ΠΎΠ»Ρ 3-Ρ ΠΊΠΎΠΎΡΠ΄ΠΈΠ½Π°ΡΠ½ΡΡ ΠΎΡΠ΅ΠΉ. ΠΠ»Ρ ΠΏΠ΅ΡΠ΅Π΄Π°ΡΠΈ ΠΈΠ½ΡΠΎΡΠΌΠ°ΡΠΈΠΈ ΡΡΡΡΠΎΠΉΡΡΠ²ΠΎ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅Ρ ΠΈΠ½ΡΠ΅ΡΡΠ΅ΠΉΡ I2C, ΡΡΠΎ ΠΏΠΎΡΠ»Π΅Π΄ΠΎΠ²Π°ΡΠ΅Π»ΡΠ½ΡΠΉ ΠΈΠ½ΡΠ΅ΡΡΠ΅ΠΉΡ ΠΏΠΎΠ·Π²ΠΎΠ»ΡΡΡΠΈΠΉ ΠΎΡΠ³Π°Π½ΠΈΠ·ΠΎΠ²Π°ΡΡ ΠΎΠ±ΠΌΠ΅Π½ ΡΠΎΠΎΠ±ΡΠ΅Π½ΠΈΡΠΌΠΈ ΠΏΠΎ Π΄Π²ΡΡ ΠΏΡΠΎΠ²ΠΎΠ΄Π½ΠΎΠΉ Π»ΠΈΠ½ΠΈΠΈ ΠΌΠ΅ΠΆΠ΄Ρ 128 ΡΡΡΡΠΎΠΉΡΡΠ²Π°ΠΌΠΈ, ΠΎΠ΄Π½ΠΎ ΠΈΠ· ΠΊΠΎΡΠΎΡΡΡ ΡΠ²Π»ΡΠ΅ΡΡΡ Π³Π»Π°Π²Π½ΡΠΌ, Π° ΠΎΡΡΠ°Π»ΡΠ½ΡΠ΅ Π²Π΅Π΄ΠΎΠΌΡΠΌΠΈ [1-2]. ΠΠΎΠ΄ΡΠ»Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ-Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΏΡΠΈΠΎΠ±ΡΠ΅ΡΠ΅Π½ Π½Π° Aliexpress.com

ΠΠΎΠ½ΡΡΡΡΠΊΡΠΈΠ²Π½ΠΎ ΠΌΠΎΠ΄ΡΠ»Ρ ΠΏΡΠ΅Π΄ΡΡΠ°Π²Π»ΡΠ΅Ρ ΡΠΎΠ±ΠΎΠΉ ΠΏΠ΅ΡΠ°ΡΠ½ΡΡ ΠΏΠ»Π°ΡΡ ΡΠ°Π·ΠΌΠ΅ΡΠΎΠΌ 20 Ρ 15 ΠΌΠΌ, ΠΌΠ°ΡΡΠ° 1,5 Π³ Ρ ΠΏΡΠΈΠΏΠ°ΡΠ½Π½ΠΎΠΉ Π³ΡΠ΅Π±Π΅Π½ΠΊΠΎΠΉ ΠΊΠΎΠ½ΡΠ°ΠΊΡΠΎΠ².

Π£ΡΡΡΠΎΠΉΡΡΠ²ΠΎ ΠΏΠΎΡΡΠ°Π²Π»ΡΠ΅ΡΡΡ Π² Π°Π½ΡΠΈΡΡΠ°ΡΠΈΡΠ΅ΡΠΊΠΎΠΌ ΠΏΠ°ΠΊΠ΅ΡΠ΅ Π² ΠΊΠΎΠΌΠΏΠ»Π΅ΠΊΡΠ΅ Ρ ΠΏΠ°ΡΠΎΠΉ Π½Π΅ ΠΏΡΠΈΠΏΠ°ΡΠ½Π½ΡΡ ΠΊΠΎΠ½ΡΠ°ΠΊΡΠ½ΡΡ Π³ΡΠ΅Π±Π΅Π½ΠΎΠΊ.
ΠΠ΅ΠΏΠΎΡΡΠ΅Π΄ΡΡΠ²Π΅Π½Π½ΠΎ Π½Π° ΠΏΠ΅ΡΠ°ΡΠ½ΠΎΠΉ ΠΏΠ»Π°ΡΠ΅ ΠΈΠΌΠ΅Π΅ΡΡΡ ΠΌΠ°ΡΠΊΠΈΡΠΎΠ²ΠΊΠ° ΠΊΠΎΠ½ΡΠ°ΠΊΡΠ½ΡΡ ΠΏΠ»ΠΎΡΠ°Π΄ΠΎΠΊ, Π° ΡΠ°ΠΊΠΆΠ΅ ΠΎΠ±ΠΎΠ·Π½Π°ΡΠ΅Π½Ρ Π΄Π²Π΅ Π³Π΅ΠΎΠΌΠ΅ΡΡΠΈΡΠ΅ΡΠΊΠΈΡ ΠΎΡΠΈ X ΠΈ Y, ΡΡΠ΅ΡΡΡ ΠΎΡΡ Z ΠΏΠ΅ΡΠΏΠ΅Π½Π΄ΠΈΠΊΡΠ»ΡΡΠ½ΠΎ ΠΏΠ»ΠΎΡΠΊΠΎΡΡΠΈ ΠΏΠ»Π°ΡΡ, ΠΎΡ Π½Π°Π±Π»ΡΠ΄Π°ΡΠ΅Π»Ρ, Π΅ΡΠ»ΠΈ ΡΠΌΠΎΡΡΠ΅ΡΡ ΡΠΎ ΡΡΠΎΡΠΎΠ½Ρ ΡΠ°Π΄ΠΈΠΎΠΊΠΎΠΌΠΏΠΎΠ½Π΅Π½ΡΠΎΠ².
ΠΡΡΠ΅ΡΡΠ²Π΅Π½Π½ΠΎ Π΄Π°Π½Π½ΠΎΠ΅ ΡΡΡΡΠΎΠΉΡΡΠ²ΠΎ ΠΎΡΠ½ΠΎΡΠΈΡΡΡ ΠΊ Π²Π΅ΡΡΠΌΠ° ΡΠ»ΠΎΠΆΠ½ΡΠΌ Π΄Π°ΡΡΠΈΠΊΠ°ΠΌ. ΠΠΎΡΠΊΠΎΠ½Π°Π»ΡΠ½ΠΎ ΡΠ°Π·ΠΎΠ±ΡΠ°ΡΡΡΡ Π² ΡΠ°Π±ΠΎΡΠ΅ ΠΏΠΎΠ΄ΠΎΠ±Π½ΡΡ ΡΡΡΡΠΎΠΉΡΡΠ² ΡΠ»ΠΎΠΆΠ½ΠΎ, Π΄Π° ΠΈ Π½Π΅ Π²ΡΠ΅Π³Π΄Π° Π½ΡΠΆΠ½ΠΎ, ΠΌΠΎΠΆΠ½ΠΎ ΠΏΡΠΎΡΡΠΎ Π²ΠΎΡΠΏΡΠΈΠ½ΠΈΠΌΠ°ΡΡ ΡΡΡΡΠΎΠΉΡΡΠ²ΠΎ ΠΊΠ°ΠΊ Β«ΡΠ΅ΡΠ½ΡΠΉ ΡΡΠΈΠΊΒ», ΠΊΠΎΠ³Π΄Π° ΠΌΡ Π·Π½Π°Π΅ΠΌ ΡΠΎΠ»ΡΠΊΠΎ ΠΊΠ°ΠΊΠΈΠ΅ ΡΠΈΠ³Π½Π°Π»Ρ Π½Π°Π΄ΠΎ Π² ΡΡΠΎΡ ΡΠ΅ΡΠ½ΡΠΉ ΡΡΠΈΠΊ ΠΎΡΠΏΡΠ°Π²ΠΈΡ, ΠΈ ΠΊΠ°ΠΊΠΈΠ΅ ΡΠΈΠ³Π½Π°Π»Ρ Π² ΠΎΡΠ²Π΅Ρ ΠΈΠ· Π½Π΅Π³ΠΎ ΠΌΡ ΠΌΠΎΠΆΠ΅ΠΌ ΠΏΠΎΠ»ΡΡΠΈΡΡ. Π₯ΠΎΡΡ ΡΠ°Π·ΡΠΌΠ΅Π΅ΡΡΡ ΡΠ΅ΠΌ Π±ΠΎΠ»ΡΡΠ΅ Π·Π½Π°Π½ΠΈΠΉ, ΡΠ΅ΠΌ Π»ΡΡΡΠ΅.
ΠΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΊΒ Arduino
ΠΠΏΠΏΠ°ΡΠ°ΡΠ½Π°Ρ ΠΏΠ»Π°ΡΡΠΎΡΠΌΠ° Arduino ΡΠ΅ΠΌ ΠΈ Ρ ΠΎΡΠΎΡΠ°, ΡΡΠΎ Π΄Π»Ρ Π±ΠΎΠ»ΡΡΠΎΠ³ΠΎ ΠΊΠΎΠ»ΠΈΡΠ΅ΡΡΠ²Π° ΡΡΠ°Π½Π΄Π°ΡΡΠ½ΡΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ² ΠΌΠΎΠΆΠ½ΠΎ Π½Π°ΠΉΡΠΈ Π³ΠΎΡΠΎΠ²ΡΠ΅ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΠ½ΡΠ΅ ΡΠ΅ΡΠ΅Π½ΠΈΡ. ΠΠ΅ ΡΠ²Π»ΡΠ΅ΡΡΡ ΠΈΡΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ΠΌ ΠΈ Π΄Π°Π½Π½ΠΎΠ΅ ΡΡΡΡΠΎΠΉΡΡΠ²ΠΎ [3-5].
Π₯ΠΎΡΡ Π² ΠΎΠ±ΡΠ΅ΠΉ ΡΠ»ΠΎΠΆΠ½ΠΎΡΡΠΈ GY-521 ΠΈΠΌΠ΅Π΅Ρ 8 ΠΊΠΎΠ½ΡΠ°ΠΊΡΠΎΠ² Π΄Π»Ρ Π΄Π΅ΠΌΠΎΠ½ΡΡΡΠ°ΡΠΈΠΈ ΡΠΎΠ²ΠΌΠ΅ΡΡΠ½ΠΎΠΉ ΡΠ°Π±ΠΎΡΡ Ρ Arduino UNO Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ Π²ΡΠ΅Π³ΠΎ ΡΠ΅ΡΡΡΠ΅Ρ ΠΏΡΠΎΠ²ΠΎΠ΄ΠΎΠ², ΠΎΡΡΠ°Π»ΡΠ½ΡΠ΅ ΠΊΠΎΠ½ΡΠ°ΠΊΡΡ Π½ΡΠΆΠ½Ρ Π΄Π»Ρ Π±ΠΎΠ»Π΅Π΅ ΡΠ»ΠΎΠΆΠ½ΡΡ Π²Π°ΡΠΈΠ°Π½ΡΠΎΠ² Π²Π·Π°ΠΈΠΌΠΎΠ΄Π΅ΠΉΡΡΠ²ΠΈΡ [6]. Π Π΄Π°Π½Π½ΠΎΠΌ ΠΏΡΠΎΡΡΠ΅ΠΉΡΠ΅ΠΌ ΡΠ»ΡΡΠ°Π΅ Π² ΠΊΠ°ΡΠ΅ΡΡΠ²Π΅ Π²Π΅Π΄ΡΡΠ΅Π³ΠΎ ΡΡΡΡΠΎΠΉΡΡΠ²Π° Π²ΡΡΡΡΠΏΠ°Π΅Ρ ΠΏΠ»Π°ΡΠ° Arduino UNO. ΠΡΠ²ΠΎΠ΄Ρ SDA ΠΈ SLC Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ°ΡΡΡΡ ΡΠΎΠΎΡΠ²Π΅ΡΡΡΠ²Π΅Π½Π½ΠΎ ΠΊ ΠΊΠΎΠ½ΡΠ°ΠΊΡΠ°ΠΌ A4 ΠΈ A5 ΠΏΠ»Π°ΡΡ Arduino [7]. ΠΠΌΠ΅Π½Π½ΠΎ ΡΠ΅ΡΠ΅Π· ΡΡΠΈ Π²ΡΠ²ΠΎΠ΄Ρ Π½Π° Arduino UNO ΡΠ΅Π°Π»ΠΈΠ·ΠΎΠ²Π°Π½ Π΄Π°Π½Π½ΡΠΉ ΠΈΠ½ΡΠ΅ΡΡΠ΅ΠΉΡ.
ΠΠΎΠΎΠ±ΡΠ΅-ΡΠΎ Π»ΠΈΠ½ΠΈΠΈ ΠΈΠ½ΡΠ΅ΡΡΠ΅ΠΉΡΠ° I2C Π΄ΠΎΠ»ΠΆΠ½Ρ Π±ΡΡΡ ΡΠΎΠ΅Π΄ΠΈΠ½Π΅Π½Ρ Ρ ΡΠΈΠ½ΠΎΠΉ ΠΏΠΈΡΠ°Π½ΠΈΡ ΡΠ΅ΡΠ΅Π· ΡΠ΅Π·ΠΈΡΡΠΎΡΡ ΡΠΎΠΏΡΠΎΡΠΈΠ²Π»Π΅Π½ΠΈΠ΅ΠΌ 4,7 ΠΊΠΠΌ [1-2], Π½ΠΎ Π² ΡΠ»ΡΡΠ°Π΅ ΠΎΠ΄Π½ΠΎΠ³ΠΎ Π΄Π°ΡΡΠΈΠΊΠ° Π½Π° ΠΌΠ°ΠΊΠ΅ΡΠ½ΠΎΠΉ ΠΏΠ»Π°ΡΠ΅, Π²ΡΠ΅ ΡΠ°Π±ΠΎΡΠ°Π»ΠΎ ΠΈ ΡΠ°ΠΊ. ΠΠ²Π° Π²Π°ΡΠΈΠ°Π½ΡΠ° ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ Π΄Π»Ρ Arduino, ΠΊΠΎΡΠΎΡΡΠ΅ ΠΎΠΏΡΠ°ΡΠΈΠ²Π°ΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ-Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ GY-521 ΠΌΠΎΠΆΠ½ΠΎ ΡΠΊΠ°ΡΠ°ΡΡ Π·Π΄Π΅ΡΡ [8].
ΠΠΈΡΠΎΡΠΊΠΎΠΏ-Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΏΠΈΡΠ°Π΅ΡΡΡ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅ΠΌ 3,3 Π ΠΎΡ Arduino, ΡΠΎΠΊ ΠΏΠΎΡΡΠ΅Π±Π»Π΅Π½ΠΈΡ ΡΠΎΡΡΠ°Π²Π»ΡΠ΅Ρ ΠΎΠΊΠΎΠ»ΠΎ 5 ΠΌΠ.
ΠΠ° ΠΏΠ»Π°ΡΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°-Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΡΠ°ΡΠΏΠΎΠ»Π°Π³Π°Π΅ΡΡΡ ΠΈΠ½Π΄ΠΈΠΊΠ°ΡΠΎΡ ΠΏΠΈΡΠ°Π½ΠΈΡ.

Π ΠΌΠΎΠ½ΠΈΡΠΎΡΠ΅ ΠΏΠΎΡΠ»Π΅Π΄ΠΎΠ²Π°ΡΠ΅Π»ΡΠ½ΠΎΠ³ΠΎ ΠΏΠΎΡΡΠ° Arduino IDE. ΠΠΈΠ΄Π½ΠΎ, ΡΡΠΎ Π΅ΡΠ»ΠΈ ΠΏΡΠΈΠΊΠΎΡΠ½ΡΡΡΡΡ ΠΊ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ΅ Π½Π° ΠΏΠ»Π°ΡΠ΅ Π΄Π°ΡΡΠΈΠΊΠ° ΡΡΠΊΠΎΠΉ, ΡΠΎ Π΄Π°ΡΡΠΈΠΊ ΠΏΠΎΠΊΠ°ΠΆΠ΅Ρ ΡΠΎΡΡ ΡΠ΅ΠΌΠΏΠ΅ΡΠ°ΡΡΡΡ.

ΠΡΠΈ ΠΈΠ·ΠΌΠ΅Π½Π΅Π½ΠΈΠΈ ΠΎΡΠΈΠ΅Π½ΡΠ°ΡΠΈΠΈ ΠΌΠΎΠ΄ΡΠ»Ρ Π² ΠΏΡΠΎΡΡΡΠ°Π½ΡΡΠ²Π΅ ΠΈΠ·ΠΌΠ΅Π½ΡΠ΅ΡΡΡ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°, ΠΎΡΠΎΠ±ΡΠ°ΠΆΠ°ΡΡΠΈΠ΅, Π²Π΄ΠΎΠ»Ρ ΠΊΠ°ΠΊΠΎΠΉ ΠΎΡΠΈ (X,Y,Z ΡΠΎΠΎΡΠ²Π΅ΡΡΡΠ²Π΅Π½Π½ΠΎ) ΠΏΡΠΈΠ±ΠΎΡΠ° Π΄Π΅ΠΉΡΡΠ²ΡΠ΅Ρ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΠ΅ ΡΠ²ΠΎΠ±ΠΎΠ΄Π½ΠΎΠ³ΠΎ ΠΏΠ°Π΄Π΅Π½ΠΈΡ.
ΠΠ»ΠΈΡΠ½ΠΈΠ΅ ΡΠ΅Π·ΠΊΠΎΠ³ΠΎ ΠΏΠΎΠ²ΠΎΡΠΎΡΠ° Π²Π΄ΠΎΠ»Ρ ΠΊΠ°ΠΆΠ΄ΠΎΠΉ ΠΈΠ· ΠΎΡΠ΅ΠΉ Π½Π° ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°.
ΠΠΎΠΌΠΈΠΌΠΎ ΡΠ°ΠΌΠΎΠ³ΠΎ ΠΎΡΠ΅Π²ΠΈΠ΄Π½ΠΎΠ³ΠΎ ΠΏΡΠΈΠΌΠ΅Π½Π΅Π½ΠΈΡ Π² Π»Π΅ΡΠ°ΡΠ΅Π»ΡΠ½ΡΡ Π°ΠΏΠΏΠ°ΡΠ°ΡΠ°Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ-Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΌΠΎΠΆΠ΅Ρ ΠΎΠΊΠ°Π·Π°ΡΡΡΡ ΠΏΠΎΠ»Π΅Π·Π½ΡΠΌ Π² ΡΠΌΠ½ΠΎΠΉ ΠΎΠ΄Π΅ΠΆΠ΄Π΅, Π²ΡΠ΅Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΡΡ ΡΡΡΡΠΎΠΉΡΡΠ²Π°Ρ ΡΠΏΡΠ°Π²Π»Π΅Π½ΠΈΡ, Π±Π°Π»Π°Π½ΡΠΈΡΡΡΡΠΈΡ ΡΠΎΠ±ΠΎΡΠ°Ρ [9], ΡΠΈΡΡΠ΅ΠΌΠ°Ρ ΡΠΈΠ³Π½Π°Π»ΠΈΠ·Π°ΡΠΈΠΈ ΠΈ Ρ.ΠΏ. ΠΠ΄Π½ΠΈΠΌ ΡΠ»ΠΎΠ²ΠΎΠΌ ΠΈΠ½ΡΠ΅ΡΠ΅ΡΠ½ΠΎΠ΅ ΠΈ Π½Π΅Π΄ΠΎΡΠΎΠ³ΠΎΠ΅ ΡΡΡΡΠΎΠΉΡΡΠ²ΠΎ Ρ ΡΠΈΡΠΎΠΊΠΈΠΌΠΈ Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎΡΡΡΠΌΠΈ. ΠΠ²ΡΠΎΡ ΠΎΠ±Π·ΠΎΡΠ° β Denev.
- ΠΠ»ΡΠΌ Π. ΠΠ·ΡΡΠ°Π΅ΠΌ Arduino: ΠΈΠ½ΡΡΡΡΠΌΠ΅Π½ΡΡ ΠΈ ΠΌΠ΅ΡΠΎΠ΄Ρ ΡΠ΅Ρ Π½ΠΈΡΠ΅ΡΠΊΠΎΠ³ΠΎ Π²ΠΎΠ»ΡΠ΅Π±ΡΡΠ²Π°: ΠΠ΅Ρ. Ρ Π°Π½Π³Π». β Π‘ΠΠ±.: ΠΠ₯Π-ΠΠ΅ΡΠ΅ΡΠ±ΡΡΠ³, 2015. β 336 Ρ.
- http://robocraft.ru/blog/communication/780.html
- http://forumdvrobot.ru/forum/3-41-1
- https://ngin.pro/index.php?newsid=188
- http://arduinoprojects.ru/2014/10/ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅-Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°-gy-521-mpu-6050-ΠΊ-arduio/
- https://arduino-kit.ru/catalog/id/modul-3-h-osevogo-giroskopa-i-akselerometra-gy-521-mpu-6050
- https://mysku.ru/blog/china-stores/40178.html
- http://playground.arduino.cc/Main/MPU-6050#sketch
- http://robocraft.ru/blog/projects/570.html
ΠΠ°Π³ΡΡΠ·ΠΊΠ°…
2shemi.ru
ΠΠΎΠ΄ΡΠ»Ρ 3-Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° GY-521 MPU-6050
ΠΠ°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅ ΠΏΠΈΡΠ°Π½ΠΈΡ 2,3 β 3,6 Π. ΠΠΎΠΌΠΈΠ½Π°Π»ΡΠ½ΠΎΠ΅ 3,3 Π. ΠΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ° MPU-6050 ΡΠΎΠ΄Π΅ΡΠΆΠΈΡ Π·Π°ΠΏΠ°ΡΠ΅Π½ΡΠΎΠ²Π°Π½Π½ΡΠΉ ΠΊΠΎΠΌΠΏΠ°Π½ΠΈΠ΅ΠΉ InvenSense ΠΏΡΠΎΡΠ΅ΡΡΠΎΡ ΠΎΠ±ΡΠ°Π±ΠΎΡΠΊΠΈ ΡΠΈΠ³Π½Π°Π»ΠΎΠ², Π²ΡΠ·Π²Π°Π½Π½ΡΡ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠ΅ΠΌ Digital Motion Processor (DMP), ΡΠΏΠΎΡΠΎΠ±Π½ΡΠΉ ΠΎΠ±ΡΠ°Π±Π°ΡΡΠ²Π°ΡΡ Π°Π»Π³ΠΎΡΠΈΡΠΌΡ MotionFusion. DMP ΠΌΠΎΠΆΠ΅Ρ Π±ΡΡΡ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ Π΄Π»Ρ ΡΠ»ΠΎΠΆΠ½ΡΡ ΡΠ°ΡΡΠ΅ΡΠΎΠ². Π‘ΠΎΠ±ΡΡΠ²Π΅Π½Π½ΡΠΉ ΠΏΡΠΎΡΠ΅ΡΡΠΎΡ ΠΌΠΎΠΆΠ΅Ρ Π΄Π΅Π»Π°ΡΡ ΡΠ°ΡΡΠ΅ΡΡ, Π½Π΅ ΠΎΡΠ²Π»Π΅ΠΊΠ°Ρ ΠΌΠΈΠΊΡΠΎΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅Ρ ΠΈ Π΄Π°ΠΆΠ΅ ΡΠΏΠΎΡΠΎΠ±Π΅Π½ ΠΎΠ±ΡΠ°Π±Π°ΡΡΠ²Π°ΡΡ ΠΈΠ½ΡΠΎΡΠΌΠ°ΡΠΈΡ ΠΎΡ Π΄ΡΡΠ³ΠΎΠ³ΠΎ Π΄Π°ΡΡΠΈΠΊΠ°, ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½Π½ΠΎΠ³ΠΎ ΠΊΠΎ Π²ΡΠΎΡΠΎΠΉ ΡΠΈΠ½Π΅ I2C. Π‘ΠΏΠ΅ΡΠΈΠ°Π»ΡΠ½Π°Ρ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΠ° Π½Π° ΡΠ·ΡΠΊΠ΅ ΠΊΠΎΠΌΠ°Π½Π΄ DMP Π·Π°ΠΏΠΈΡΡΠ²Π°Π΅ΡΡΡ Π² ΠΏΠ°ΠΌΡΡΡ ΠΊΠ°ΠΆΠ΄ΡΠΉ ΡΠ°Π· ΠΏΠΎΡΠ»Π΅ ΠΏΠΎΠ΄Π°ΡΠΈ ΠΏΠΈΡΠ°Π½ΠΈΡ. ΠΡΠΎ Π·Π°Π½ΠΈΠΌΠ°Π΅Ρ ΠΎΠΊΠΎΠ»ΠΎ ΡΠ΅ΠΊΡΠ½Π΄Ρ. ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠ° ΡΠΈΠ»ΡΡΡΡΠ΅Ρ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°. ΠΠ°Π½Π½ΡΠ΅ ΠΏΠ΅ΡΠ΅Π΄Π°ΡΡΡΡ Π² Π±ΡΡΠ΅Ρ FIFO. ΠΠ΅ΠΊΠΎΡΠΎΡΡΠ΅ ΡΠ°ΡΡΡΠΆΠ΄Π΅Π½ΠΈΡ ΠΎΠ± ΡΡΠΎΠΌ Π·Π΄Π΅ΡΡ.ΠΠ»Ρ ΡΠΎΡΠ½ΠΎΠ³ΠΎ ΠΎΡΡΠ»Π΅ΠΆΠΈΠ²Π°Π½ΠΈΡ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠΉ ΠΏΡΠ΅Π΄ΡΡΠΌΠΎΡΡΠ΅Π½Π° Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎΡΡΡ Π·Π°ΠΏΠΈΡΠΈ Π² ΠΏΠ°ΠΌΡΡΡ MPU-6050 Π°ΠΊΡΡΠ°Π»ΡΠ½ΡΡ ΠΏΡΠ΅Π΄Π΅Π»ΠΎΠ² ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ. ΠΠ°Π½Π½ΡΠ΅ ΠΌΠΎΠΆΠ½ΠΎ ΡΡΠΈΡΡΠ²Π°ΡΡ ΠΈΠ· ΡΠ΅Π³ΠΈΡΡΡΠΎΠ² Ρ ΡΠ°Π½Π΅Π½ΠΈΡ ΠΈΠ»ΠΈ Π±ΡΡΠ΅ΡΠ° FIFO ΡΠ°Π·ΠΌΠ΅ΡΠΎΠΌ 1024 Π±Π°ΠΉΡ. ΠΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ° MPU-6050 ΠΌΠΎΠΆΠ΅Ρ ΡΠ°Π±ΠΎΡΠ°ΡΡ Π² ΡΠ΅ΠΆΠΈΠΌΠ΅ ΠΌΠ°ΡΡΠ΅Ρ Π½Π° ΡΠΈΠ½Π΅ I2C Π΄Π»Ρ ΠΊΠΎΠ½ΡΠ°ΠΊΡΠΎΠ² XDA ΠΈ XCL. Π‘ΠΎΠ΄Π΅ΡΠΆΠΈΡ ΠΠ¦Π 16 Π±ΠΈΡ. ΠΡΡΡ ΡΠ΅Π³ΠΈΡΡΡ ΠΏΠΎΠ΄ Π½Π°Π·Π²Π°Π½ΠΈΠ΅ΠΌ Who am I (ΠΊΠ°ΠΊ ΠΌΠ΅Π½Ρ Π·ΠΎΠ²ΡΡ) Ρ ΡΠ°Π½ΡΡΠΈΠΉ Π°Π΄ΡΠ΅Ρ ΠΌΠΎΠ΄ΡΠ»Ρ GY-521 Π½Π° ΡΠΈΠ½Π΅ I2C. ΠΠ½Π°ΡΠ΅Π½ΠΈΠ΅ Π² ΡΠ΅Π³ΠΈΡΡΡΠ΅ 104 Π΄Π΅ΡΡΡΠΈΡΠ½ΠΎΠ΅ ΠΈΠ»ΠΈ 68 ΡΠ΅ΡΡΠ½Π°Π΄ΡΠ°ΡΠ΅ΡΠΈΡΠ½ΠΎΠ΅. ΠΡΡΡ Π²ΡΡ ΠΎΠ΄ Π΄Π»Ρ ΠΏΡΠ΅ΡΡΠ²Π°Π½ΠΈΠΉ ΠΠ, ΠΊΠΎΡΠΎΡΡΠΉ Π½Π°ΡΡΡΠ°ΠΈΠ²Π°Π΅ΡΡΡ ΠΏΠΎΠ΄ ΠΈΠ½ΡΠ΅ΡΠ΅ΡΡΡΡΠ΅Π΅ ΡΠΎΠ±ΡΡΠΈΠ΅. ΠΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ° MPU-6050 ΡΠΎΠ΄Π΅ΡΠΆΠΈΡ Π±ΠΎΠ»Π΅Π΅ 100 ΡΠ΅Π³ΠΈΡΡΡΠΎΠ².
ΠΠ΄ΡΠ΅Ρ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΡ ΠΌΠΎΠΆΠ΅Ρ Π±ΡΡΡ Π΄Π²ΡΡ Π·Π½Π°ΡΠ΅Π½ΠΈΠΉ (Π±Π΅Π· Π±ΠΈΡΠ° ΡΡΠ΅Π½ΠΈΡ / Π·Π°ΠΏΠΈΡΠΈ) Π² Π·Π°Π²ΠΈΡΠΈΠΌΠΎΡΡΠΈ ΠΎΡ ΡΠΎΡΡΠΎΡΠ½ΠΈΡ Π²ΡΠ²ΠΎΠ΄Π° AD0 ΠΌΠΎΠ΄ΡΠ»Ρ 3-Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° GY-521 MPU-6050.
Β
68 (ΡΠ΅ΡΡΠ½Π°Π΄ΡΠ°ΡΠΈΡΠΈΡΠ½ΠΎΠ΅), Π΅ΡΠ»ΠΈ AD0 ΡΠΎΠ΅Π΄ΠΈΠ½Π΅Π½ Ρ ΠΎΠ±ΡΠΈΠΌ ΠΏΡΠΎΠ²ΠΎΠ΄ΠΎΠΌ.
69 (ΡΠ΅ΡΡΠ½Π°Π΄ΡΠ°ΡΠΈΡΠΈΡΠ½ΠΎΠ΅), Π΅ΡΠ»ΠΈ AD0 ΡΠΎΠ΅Π΄ΠΈΠ½Π΅Π½ Ρ ΠΏΠΎΡΠ΅Π½ΡΠΈΠ°Π»ΠΎΠΌ Π»ΠΎΠ³. 1.
Β
ΠΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΡ MPU-6050 ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅Ρ ΠΏΡΠ΅Π·ΠΎΡΠ»Π΅ΠΊΡΡΠΈΡΠ΅ΡΠΊΠΈΠΉ ΡΡΡΠ΅ΠΊΡ. ΠΡΠ΅Π΄ΡΡΠ°Π²ΡΡΠ΅ ΠΊΡΠ±ΠΈΡΠ΅ΡΠΊΠΈΠΉ ΡΡΠΈΠΊ, ΠΈΠΌΠ΅ΡΡΠΈΠΉ Π²Π½ΡΡΡΠΈ ΠΌΠ°Π»Π΅Π½ΡΠΊΠΈΠΉ ΡΠ°ΡΠΈΠΊ. Π‘ΡΠ΅Π½ΠΊΠΈ ΡΡΠΎΠΉ ΠΊΠΎΡΠΎΠ±ΠΊΠΈ Π²ΡΠΏΠΎΠ»Π½Π΅Π½Ρ ΠΈΠ· ΠΏΡΠ΅Π·ΠΎΡΠ»Π΅ΠΊΡΡΠΈΡΠ΅ΡΠΊΠΈΡ ΠΊΡΠΈΡΡΠ°Π»Π»ΠΎΠ². ΠΠΎΠ³Π΄Π° Π²Ρ Π½Π°ΠΊΠ»ΠΎΠ½ΠΈΡΠ΅ ΠΊΠΎΡΠΎΠ±ΠΊΡ, ΡΠ°Ρ Π±ΡΠ΄Π΅Ρ Π΄Π²ΠΈΠ³Π°ΡΡΡΡ Π² Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠΈ Π½Π°ΠΊΠ»ΠΎΠ½Π°. Π‘ΡΠ΅Π½Π°, Ρ ΠΊΠΎΡΠΎΡΠΎΠΉ ΡΠ°Ρ ΡΡΠ°Π»ΠΊΠΈΠ²Π°Π΅ΡΡΡ, ΡΠΎΠ·Π΄Π°Π΅Ρ ΠΊΡΠΎΡΠ΅ΡΠ½ΡΠ΅ ΠΏΡΠ΅Π·ΠΎΡΠ»Π΅ΠΊΡΡΠΈΡΠ΅ΡΠΊΠΈΠ΅ ΡΠΎΠΊΠΈ. Π Π·Π°Π²ΠΈΡΠΈΠΌΠΎΡΡΠΈ ΠΎΡ ΡΠΎΠΊΠ°, ΠΏΠΎΠ»ΡΡΠ°Π΅ΠΌΠΎΠ³ΠΎ ΠΎΡ ΡΡΠ΅Π½, ΠΎΠΏΡΠ΅Π΄Π΅Π»ΡΠ΅ΡΡΡ Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠ΅ Π½Π°ΠΊΠ»ΠΎΠ½Π° ΠΈ Π΅Π³ΠΎ Π²Π΅Π»ΠΈΡΠΈΠ½Π°.
ΠΠΈΡΠΎΡΠΊΠΎΠΏ ΠΏΡΠ΅Π΄ΡΡΠ°Π²Π»ΡΠ΅Ρ ΡΠΎΠ±ΠΎΠΉ ΠΊΠΎΠ»Π΅Π±Π»ΡΡΡΡΡΡ ΠΏΡΠ΅Π·ΠΎΡΠ»Π΅ΠΊΡΡΠΈΡΠ΅ΡΠΊΡΡ ΠΏΠ»Π°ΡΡΠΈΠ½Ρ. ΠΡΠΈ ΠΏΠΎΠ²ΠΎΡΠΎΡΠ΅ ΠΏΠ»Π°ΡΡΠΈΠ½Π° ΠΈΡΠΊΡΠΈΠ²Π»ΡΠ΅ΡΡΡ ΠΈ Π΅Π΅ ΡΠ»Π΅ΠΊΡΡΠΈΡΠ΅ΡΠΊΠΈΠ΅ ΠΏΠ°ΡΠ°ΠΌΠ΅ΡΡΡ ΠΌΠ΅Π½ΡΡΡΡΡ. ΠΡΠΎ ΡΠ΅Π³ΠΈΡΡΡΠΈΡΡΠ΅Ρ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ°. ΠΠΎΠ΄ΡΠΎΠ±Π½Π΅Π΅ Π½Π° Π²ΠΈΠ΄Π΅ΠΎ.
Β
Β
Π Π°Π·ΡΠ°Π±ΠΎΡΡΠΈΠΊΠΈ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΡ MPU-6050 ΠΏΡΠ΅Π΄ΠΎΡΡΠ°Π²Π»ΡΡΡ ΠΈΠ½ΡΡΡΡΠΌΠ΅Π½ΡΡ, Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΡΠ΅ Π΄Π»Ρ ΡΠΎΠ·Π΄Π°Π½ΠΈΡ ΠΏΡΠΈΠ»ΠΎΠΆΠ΅Π½ΠΈΠΉ.
Β
Π‘Ρ Π΅ΠΌΠ° ΠΌΠΎΠ΄ΡΠ»Ρ GY-521
Β

Β
ΠΠΈΡΠ°Π½ΠΈΠ΅ ΠΌΠΎΠ΄ΡΠ»Ρ GY-521 ΠΏΠΎΡΡΡΠΏΠ°Π΅Ρ Π½Π° Π²Ρ ΠΎΠ΄ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·Π°ΡΠΎΡΠ° Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΡ Q2 ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ° MIC5205-3.3BM5 Ρ Π²ΡΡ ΠΎΠ΄Π½ΡΠΌ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅ΠΌ 3,3 Π. ΠΠ° ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·Π°ΡΠΎΡΠ΅ ΠΏΡΠΎΠΈΡΡ ΠΎΠ΄ΠΈΡ Π½Π΅Π±ΠΎΠ»ΡΡΠΎΠ΅ ΠΏΠ°Π΄Π΅Π½ΠΈΠ΅ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΡ 0,3 β 0,4 Π, ΠΏΠΎΡΡΠΎΠΌΡ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅ ΠΏΠΈΡΠ°Π½ΠΈΡ ΠΌΠΎΠ΄ΡΠ»Ρ Π΄ΠΎΠ»ΠΆΠ½ΠΎ Π±ΡΡΡ Π²ΡΡΠ΅ 3,3 Π. ΠΠ½Π΄ΠΈΠΊΠ°ΡΠΎΡ ΠΏΠΈΡΠ°Π½ΠΈΡ ΠΌΠΎΠ΄ΡΠ»Ρ 3-Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° GY-521 MPU-6050 β ΡΠ²Π΅ΡΠΎΠ΄ΠΈΠΎΠ΄ D1. ΠΠ΅Π»ΠΈΡΠΈΠ½Π° ΡΠ΅Π·ΠΈΡΡΠΎΡΠΎΠ² R4 ΠΈ R5 ΠΌΠΎΠΆΠ΅Ρ ΠΎΡΠ»ΠΈΡΠ°ΡΡΡΡ ΠΎΡ ΡΠΊΠ°Π·Π°Π½Π½ΡΡ Π½Π° ΡΡ Π΅ΠΌΠ΅.
Β
ΠΠ°Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ ΠΊΠΎΠ½ΡΠ°ΠΊΡΠΎΠ²
Β
VCC β Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅ ΠΏΠΈΡΠ°Π½ΠΈΡ
GND β ΠΎΠ±ΡΠΈΠΉ ΠΏΡΠΎΠ²ΠΎΠ΄
SCL β ΡΠ°ΠΊΡΠΎΠ²ΡΠΉ ΡΠΈΠ³Π½Π°Π» I2C
SDA β Π΄Π°Π½Π½ΡΠ΅ I2C
XDA β Π΄Π°Π½Π½ΡΠ΅ ΡΠΈΠ½Ρ I2C ΠΏΡΠΈ ΡΠ°Π±ΠΎΡΠ΅ Π² ΡΠ΅ΠΆΠΈΠΌΠ΅ ΠΌΠ°ΡΡΠ΅ΡΠ°
XCL β ΡΠ°ΠΊΡΠΎΠ²ΡΠΉ ΡΠΈΠ³Π½Π°Π» ΡΠΈΠ½Ρ I2C ΠΏΡΠΈ ΡΠ°Π±ΠΎΡΠ΅ Π² ΡΠ΅ΠΆΠΈΠΌΠ΅ ΠΌΠ°ΡΡΠ΅ΡΠ°
AD0 β Π±ΠΈΡ 0 Π°Π΄ΡΠ΅ΡΠ° I2C
INT β Π²ΡΡ ΠΎΠ΄ ΡΠΈΠ³Π½Π°Π»Π° ΠΎ Π³ΠΎΡΠΎΠ²Π½ΠΎΡΡΠΈ Π΄Π°Π½Π½ΡΡ Π΄Π»Ρ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΡ ΠΊΠ°ΠΊ Π²Π½Π΅ΡΠ½Π΅Π³ΠΎ ΠΏΡΠ΅ΡΡΠ²Π°Π½ΠΈΡ ΠΠ
Β ΠΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ ΠΌΠΎΠ΄ΡΠ»Ρ 3-Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° GY-521 MPU-6050 ΠΊ Arduino UNO.
Β
5 V Arduino β VCC
Β
GND Arduino β GND
Β
A4 Arduino β SDA
Β
A5 Arduino β SCL
Β
GND Arduino β AD0
Β
Π Π·Π°Π²ΠΈΡΠΈΠΌΠΎΡΡΠΈ ΠΎΡ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ β INT
Β
ΠΠΎΠ΄Π²ΠΎΠ΄Π½ΡΠ΅ ΠΊΠ°ΠΌΠ½ΠΈ, ΡΠΈΡΡ ΠΈ ΡΡΡΠ±ΡΠ»Π΅Π½ΡΠ½ΠΎΡΡΡ
Β
ΠΡΠΈ ΠΈΠ·ΡΡΠ΅Π½ΠΈΠΈ ΡΠ°Π±ΠΎΡΡ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΡ MPU-6050 Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΡΠ»Π΅Π΄ΡΠ΅Ρ ΠΏΠΎΠΌΠ½ΠΈΡΡ, ΡΡΠΎ ΠΌΠ΅Ρ Π°Π½ΠΈΡΠ΅ΡΠΊΠΈΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΡ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·ΠΈΡΡΡΡΡΡ Π² ΠΏΡΠΎΡΡΡΠ°Π½ΡΡΠ²Π΅ Π·Π° ΡΡΠ΅Ρ ΡΠ²ΠΎΠΈΡ ΡΠΈΠ·ΠΈΡΠ΅ΡΠΊΠΈΡ ΡΠ²ΠΎΠΉΡΡΠ². ΠΠ»Π΅ΠΊΡΡΠΎΠ½Π½ΡΠΉ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ ΡΠ°ΠΊ ΡΠ°Π±ΠΎΡΠ°ΡΡ Π½Π΅ ΠΌΠΎΠΆΠ΅Ρ. ΠΠ½ Π»ΠΈΡΡ ΠΈΠ·ΠΌΠ΅ΡΡΠ΅Ρ ΡΠΊΠΎΡΠΎΡΡΡ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ.
ΠΠ°ΠΆΠ΄ΡΠΉ ΠΌΠΎΠ΄ΡΠ»Ρ GY-521 ΡΡΠ΅Π±ΡΠ΅Ρ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠΈ. ΠΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ² ΠΈΠΌΠ΅ΡΡ Π½Π΅ΠΊΠΎΡΠΎΡΠΎΠ΅ ΡΠΌΠ΅ΡΠ΅Π½ΠΈΠ΅ ΠΎΡΠ½ΠΎΡΠΈΡΠ΅Π»ΡΠ½ΠΎ Π½ΡΠ»Ρ, ΡΡΠΎ Π²Π½ΠΎΡΠΈΡ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΡ Π² ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΡ. ΠΡΠΆΠ½ΠΎ ΡΡΠ΅ΡΡΡ ΡΡΠΎ ΡΠΌΠ΅ΡΠ΅Π½ΠΈΠ΅ Π΄Π»Ρ ΠΊΠ°ΠΆΠ΄ΠΎΠΉ ΠΎΡΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ ΠΊΠ°ΠΆΠ΄ΠΎΠΉ ΠΎΡΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°, Π²Π½Π΅ΡΡΠΈ ΠΊΠΎΡΡΠ΅ΠΊΡΠΈΡΠΎΠ²ΠΊΡ Π² ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ. ΠΡΠΈ ΠΏΡΠΎΠΈΠ·Π²ΠΎΠ΄ΡΡΠ²Π΅ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌ Π½Π΅Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎ ΠΏΠΎΠ»ΡΡΠΈΡΡ Π°Π±ΡΠΎΠ»ΡΡΠ½ΡΡ ΡΠΎΡΠ½ΠΎΡΡΡ ΡΠ³Π»Π° ΠΌΠ΅ΠΆΠ΄Ρ ΠΎΡΡΠΌΠΈ Π΄Π°ΡΡΠΈΠΊΠΎΠ², ΠΏΠΎΡΡΠΎΠΌΡ ΡΠ³ΠΎΠ» ΠΌΠ΅ΠΆΠ΄Ρ Π½ΠΈΠΌΠΈ ΡΠΎΠ΄Π΅ΡΠΆΠΈΡ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΡ. Π’Π°ΠΊΠΆΠ΅ Π½Π΅Π»ΡΠ·Ρ Π·Π°Π±ΡΠ²Π°ΡΡ ΠΎ ΡΠΎΠΌ, ΡΡΠΎ Π΄Π°Π½Π½ΡΠ΅ ΠΎΡ ΡΡΠ΅Ρ ΠΎΡΠ΅ΠΉ ΠΌΠΎΠ³ΡΡ ΠΈΠΌΠ΅ΡΡ ΡΠ°Π·Π½ΡΡ ΠΏΡΠΎΠΏΠΎΡΡΠΈΠΎΠ½Π°Π»ΡΠ½ΠΎΡΡΡ.
ΠΠ°ΠΈΠ±ΠΎΠ»ΡΡΠ°Ρ ΡΠΎΡΠ½ΠΎΡΡΡ ΡΠ΅Π·ΡΠ»ΡΡΠ°ΡΠΎΠ² ΠΌΠ°ΡΠ΅ΠΌΠ°ΡΠΈΡΠ΅ΡΠΊΠΈΡ ΠΏΡΠ΅ΠΎΠ±ΡΠ°Π·ΠΎΠ²Π°Π½ΠΈΠΉ Π΄Π»Ρ ΠΏΠΎΠ»ΡΡΠ΅Π½ΠΈΡ ΠΏΠ°ΡΠ°ΠΌΠ΅ΡΡΠΎΠ² Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΡ Π±ΡΠ΄Π΅Ρ ΠΏΠΎΠ»ΡΡΠ΅Π½Π° ΠΏΡΠΈ ΡΠΈΠ½Ρ ΡΠΎΠ½Π½ΠΎΠΌ ΡΡΠΈΡΡΠ²Π°Π½ΠΈΠΈ Π΄Π°Π½Π½ΡΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°.
ΠΡΠΈ ΠΏΠΎΡΡΡΠΎΠ΅Π½ΠΈΠΈ ΡΠΏΡΠ°Π²Π»ΡΠ΅ΠΌΠΎΠΉ ΠΌΠ°ΡΠΈΠ½Ρ ΡΠ»Π΅Π΄ΡΠ΅Ρ ΠΈΠ·Π±Π΅Π³Π°ΡΡ Π² ΠΌΠ΅Ρ Π°Π½ΠΈΠ·ΠΌΠ°Ρ ΠΈΡΡΠΎΡΠ½ΠΈΠΊΠΎΠ² ΠΊΠΎΠ»Π΅Π±Π°Π½ΠΈΠΉ ΠΈ ΠΈΡ Π³Π°ΡΠΌΠΎΠ½ΠΈΠΊ Ρ ΡΠ°ΡΡΠΎΡΠΎΠΉ ΡΠ΅Π·ΠΎΠ½Π°Π½ΡΠ° ΡΠΊΠ°Π·Π°Π½Π½ΠΎΠΉ Π² Ρ Π°ΡΠ°ΠΊΡΠ΅ΡΠΈΡΡΠΈΠΊΠ°Ρ .
ΠΡΠΈ ΠΏΠ΅ΡΠ²ΠΎΠΌ ΠΎΠ·Π½Π°ΠΊΠΎΠΌΠ»Π΅Π½ΠΈΠΈ Ρ ΠΌΠΎΠ΄ΡΠ»Π΅ΠΌ ΠΏΡΠΎΠ²Π΅ΡΡΡΡ Π΅Π³ΠΎ ΡΠ°Π±ΠΎΡΡ Π½Π° ΡΠΈΠ½Π΅ Π΄Π°Π½Π½ΡΡ I2C. ΠΠ»Ρ ΡΡΠΎΠ³ΠΎ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΡΡ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ I2C ΡΠΊΠ°Π½Π΅Ρ.
ΠΠ½ΡΡΡΠ΅Π½Π½Π΅Π΅ ΠΠ¦Π ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΡ ΠΎΡΠ΅Π½Ρ ΡΡΠ²ΡΡΠ²ΠΈΡΠ΅Π»ΡΠ½ΠΎ, Π΅Π³ΠΎ ΡΠ°Π·ΡΡΠ΄Π½ΠΎΡΡΡ 16 Π±ΠΈΡ. ΠΡΠΈ ΡΠ°ΠΊΠΎΠΉ ΡΡΠ²ΡΡΠ²ΠΈΡΠ΅Π»ΡΠ½ΠΎΡΡΠΈ ΠΏΡΠ΅Π΄ΡΡΠ²Π»ΡΡΡΡΡ ΠΏΠΎΠ²ΡΡΠ΅Π½Π½ΡΠ΅ ΡΡΠ΅Π±ΠΎΠ²Π°Π½ΠΈΡ ΠΊ ΠΏΠΈΡΠ°Π½ΠΈΡ ΠΌΠΎΠ΄ΡΠ»Ρ, Π½Π΅ΡΠΌΠΎΡΡΡ Π½Π° ΡΠΎΠ±ΡΡΠ²Π΅Π½Π½ΡΠΉ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·Π°ΡΠΎΡ. ΠΠ΄Π΅ΡΡ Π½Π΅ ΠΏΠΎΠ΄Ρ ΠΎΠ΄ΠΈΡ ΠΈΡΡΠΎΡΠ½ΠΈΠΊ ΠΏΠΈΡΠ°Π½ΠΈΡ ΠΊΠ»Π°ΡΡΠ° βΠΊΠ°ΠΊΠΎΠΉ Π΅ΡΡΡβ Π½Π° 5 Π. ΠΡΠ΅ΠΆΠ΄Π΅ Π²ΡΠ΅Π³ΠΎ Π½Π°Π΄ΠΎ ΡΠ°Π·ΠΎΠ±ΡΠ°ΡΡΡΡ Ρ ΠΏΠ°ΡΠ°ΠΌΠ΅ΡΡΠΎΠΌ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅ΠΌΠΎΠ³ΠΎ Π±Π»ΠΎΠΊΠ° ΠΏΠΈΡΠ°Π½ΠΈΡ Π²Π΅Π»ΠΈΡΠΈΠ½Π° ΠΏΡΠ»ΡΡΠ°ΡΠΈΠΉ ΠΈΠ»ΠΈ ΡΡΠΎΠ²Π΅Π½Ρ ΡΡΠΌΠΎΠ² Ρ ΠΏΠΎΠΌΠΎΡΡΡ ΠΎΡΡΠΈΠ»Π»ΠΎΠ³ΡΠ°ΡΠ°. ΠΠ΅Π»ΠΈΡΠΈΠ½Π° ΡΡΠΌΠ° Π² Π»ΠΈΠ½ΠΈΠΈ ΠΏΠΈΡΠ°Π½ΠΈΡ Π½Π΅ Π΄ΠΎΠ»ΠΆΠ½Π° ΠΏΡΠ΅Π²ΡΡΠ°ΡΡ 50 ΠΌΠ. ΠΡΠΈΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ Π±Π°ΡΠ°ΡΠ΅ΠΉ Π² ΡΡΠΈΡ ΡΡΠ»ΠΎΠ²ΠΈΡ ΡΠΌΠ΅ΡΡΠ½ΠΎ, Π½ΠΎ ΡΡΠΎ Π΄ΠΎΡΠΎΠ³ΠΎ. Π£ΡΡΠ°Π½ΠΎΠ²ΠΊΠ° ΠΊΠΎΠ½Π΄Π΅Π½ΡΠ°ΡΠΎΡΠΎΠ² Π½Π΅ ΡΠ½ΠΈΠ·ΠΈΡ ΡΡΠΌΡ Π½Π΅ΠΊΠ°ΡΠ΅ΡΡΠ²Π΅Π½Π½ΠΎΠ³ΠΎ Π±Π»ΠΎΠΊΠ° ΠΏΠΈΡΠ°Π½ΠΈΡ. ΠΡΠ»ΠΈ Π±Π»ΠΎΠΊ ΠΏΠΈΡΠ°Π½ΠΈΡ ΡΡΠΌΠΈΡ ΠΎΡ Π½Π΅Π³ΠΎ Π½Π°Π΄ΠΎ ΠΎΡΠΊΠ°Π·Π°ΡΡΡΡ, Π·Π°ΠΌΠ΅Π½ΠΈΡΡ ΠΈΠ»ΠΈ ΡΠΎΠ±ΡΠ°ΡΡ Π΄ΡΡΠ³ΠΎΠΉ. Π ΡΠΎΠΆΠ΅ Π²ΡΠ΅ΠΌΡ ΡΡΡΠ°Π½ΠΎΠ²ΠΊΠ° ΠΊΠΎΠ½Π΄Π΅Π½ΡΠ°ΡΠΎΡΠΎΠ² Π½Π° Π»ΠΈΠ½ΠΈΡΡ ΠΏΠΈΡΠ°Π½ΠΈΡ Π²ΠΎΠ·Π»Π΅ ΠΌΠΎΠ΄ΡΠ»Ρ GY-521 ΡΠ½ΠΈΠ·ΠΈΡ Π²Π»ΠΈΡΠ½ΠΈΠ΅ ΠΌΠΎΡΠ½ΡΡ ΡΠ»Π΅ΠΊΡΡΠΎΠΌΠ°Π³Π½ΠΈΡΠ½ΡΡ ΠΏΠΎΠΌΠ΅Ρ . Π Π΅ΠΊΠΎΠΌΠ΅Π½Π΄ΡΠ΅ΡΡΡ ΠΏΡΠΎΠ²ΠΎΠ΄Π° ΠΏΠΈΡΠ°Π½ΠΈΡ ΠΏΠ΅ΡΠ΅Π²ΠΈΡΡ Π² Π²ΠΈΡΡΡ ΠΏΠ°ΡΡ. ΠΠ΅Π»ΡΠ·Ρ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡ Π±Π»ΠΎΠΊ ΠΏΠΈΡΠ°Π½ΠΈΡ ΠΎΠ΄ΠΈΠ½ ΠΈ ΡΠΎΡ ΠΆΠ΅ Π΄Π»Ρ ΠΌΠΎΠ΄ΡΠ»Ρ ΠΈ Π΄Π»Ρ ΠΏΠΈΡΠ°Π½ΠΈΡ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»Π΅ΠΉ. ΠΡΠΈ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠ΅ ΠΌΠΎΠ΄ΡΠ»Ρ 3-Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° GY-521 MPU-6050 Π΄ΠΎΠ»ΠΆΠ΅Π½ ΠΈΠΌΠ΅ΡΡ ΡΠΎΠ±ΡΡΠ²Π΅Π½Π½ΡΠΉ ΠΈΡΡΠΎΡΠ½ΠΈΠΊ, ΠΎΡΠ΄Π΅Π»ΡΠ½ΡΠΉ ΠΎΡ ΠΌΠΎΠ΄ΡΠ»Ρ ΠΠ ΠΈ Π΄ΡΡΠ³ΠΈΡ ΠΏΠΎΡΡΠ΅Π±ΠΈΡΠ΅Π»Π΅ΠΉ. ΠΡΠ»ΠΈ Π½Π° ΡΡΠ°ΠΏΠ΅ ΠΏΠ΅ΡΠ²ΠΎΠ³ΠΎ Π·Π°ΠΏΡΡΠΊΠ° Π΅ΡΠ΅ ΠΌΠΎΠΆΠ½ΠΎ ΡΠΌΠΈΡΠΈΡΡΡΡ Ρ ΠΏΠΎΠ²ΡΡΠ΅Π½Π½ΡΠΌ ΡΡΠΌΠΎΠΌ Π² ΠΏΠΈΡΠ°Π½ΠΈΠΈ, ΡΠΎ Π½Π° ΡΡΠ°ΠΏΠ΅ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠΈ ΡΡΠΎ ΠΏΡΠΈΠ²Π΅Π΄Π΅Ρ ΠΊ ΠΎΡΠΈΠ±ΠΊΠ°ΠΌ, Π° ΠΎ Π²ΡΡΠΎΠΊΠΎΠΉ ΡΠΎΡΠ½ΠΎΡΡΠΈ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ Π±Π΅Π· ΠΊΠ°ΡΠ΅ΡΡΠ²Π΅Π½Π½ΠΎΠ³ΠΎ ΠΏΠΈΡΠ°Π½ΠΈΡ Π³ΠΎΠ²ΠΎΡΠΈΡΡ Π½Π΅ ΠΏΡΠΈΡ ΠΎΠ΄ΠΈΡΡΡ.
Β
ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠΈΡΠΎΠ²Π°Π½ΠΈΠ΅ Π½Π° Π°ΡΠ΄ΡΠΈΠ½ΠΎ ΠΈ ΠΌΠ°ΡΠ΅ΠΌΠ°ΡΠΈΠΊΠ°
Β
ΠΠ΄ΠΈΠ½ ΠΈΠ· ΡΠΏΠΎΡΠΎΠ±ΠΎΠ² ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΡ ΠΌΠΎΠ΄ΡΠ»Ρ GY-521 β ΠΏΡΠΈΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ ΠΌΠΈΠΊΡΠΎΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΠ½ΠΎΠ³ΠΎ ΠΌΠΎΠ΄ΡΠ»Ρ Arduino. ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠ½ΠΎΠ΅ ΠΎΠ±Π΅ΡΠΏΠ΅ΡΠ΅Π½ΠΈΠ΅ Arduino ΠΏΠΎΠ·Π²ΠΎΠ»ΡΠ΅Ρ ΡΡΡΠ°Π½ΠΎΠ²ΠΈΡΡ Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΠΈ Π΄Π»Ρ GY-521. ΠΡΡΡ ΡΠ»ΠΎΠΆΠ½Π°Ρ Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΠ° I2Cdevlib Π΄Π»Ρ Π΄ΠΎΡΡΡΠΏΠ° ΠΊ MPU-6050 ΠΈ Π΄ΡΡΠ³ΠΈΠΌ ΡΡΡΡΠΎΠΉΡΡΠ²Π°ΠΌ Π½Π° ΡΠΈΠ½Π΅ I2C.
Β

Β
Β ΠΠ½Π° ΡΡΡΠ°Π½Π°Π²Π»ΠΈΠ²Π°Π΅ΡΡΡ Π² ΠΏΠ°ΠΏΠΊΡ MPU6050. ΠΡΠΏΠΎΠ»ΡΠ·ΡΠ΅Ρ Π°ΠΏΠΏΠ°ΡΠ°ΡΠ½ΡΠΉ Π±ΡΡΠ΅Ρ ΠΌΠΈΠΊΡΠΎΡΡ Π΅ΠΌΡ ΠΈ Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎΡΡΠΈ ΡΠΈΡΡΠΎΠ²ΠΎΠΉ ΠΎΠ±ΡΠ°Π±ΠΎΡΠΊΠΈ ΠΏΠ°ΡΠ°ΠΌΠ΅ΡΡΠΎΠ² Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΡ MPU-6050 Π΄Π»Ρ Π²ΡΠΏΠΎΠ»Π½Π΅Π½ΠΈΡ ΠΏΡΠ΅ΠΎΠ±ΡΠ°Π·ΠΎΠ²Π°Π½ΠΈΡ Π΄Π°Π½Π½ΡΡ ΠΌΠ΅ΠΆΠ΄Ρ ΡΠ°Π·Π»ΠΈΡΠ½ΡΠΌΠΈ ΡΠΈΡΡΠ΅ΠΌΠ°ΠΌΠΈ ΠΊΠΎΠΎΡΠ΄ΠΈΠ½Π°Ρ ΠΈ ΠΎΠ±ΡΠ΅Π΄ΠΈΠ½ΡΠ΅Ρ Π΄Π°Π½Π½ΡΠ΅ ΠΎΡ Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΈΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ². ΠΡΠ΅ ΠΎΠ΄Π½Π° ΠΏΠΎΠ»Π΅Π·Π½Π°Ρ Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΠ° FreeIMU, ΠΎΡΠΈΠ΅Π½ΡΠΈΡΠΎΠ²Π°Π½Π½Π°Ρ Π½Π° ΠΈΠ½Π΅ΡΡΠΈΠ°Π»ΡΠ½ΡΠΉ ΠΈΠ·ΠΌΠ΅ΡΠΈΡΠ΅Π»ΡΠ½ΡΠΉ Π±Π»ΠΎΠΊ ΠΈΠ· Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΈΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ² ΠΈ ΠΌΠΎΠΆΠ΅Ρ Π²ΡΠΏΠΎΠ»Π½ΡΡΡ ΡΠ»ΠΎΠΆΠ½ΡΡ ΠΎΠ±ΡΠ°Π±ΠΎΡΠΊΡ Π΄Π°Π½Π½ΡΡ . FreeIMU ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅Ρ I2Cdevlib, Π½ΠΎ ΠΏΠΎΡΠ»Π΅Π΄Π½ΡΡ Π²Π΅ΡΡΠΈΡ I2Cdevlib Π² ΠΊΠΎΠΌΠΏΠ»Π΅ΠΊΡΠ΅ Ρ FreeIMU Π²ΡΠ·ΡΠ²Π°Π΅Ρ ΠΊΠΎΠ½ΡΠ»ΠΈΠΊΡ Π²Π΅ΡΡΠΈΠΉ. ΠΠ΅ΡΠ΅Π΄ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΠ΅ΠΌ ΡΠ»Π΅Π΄ΡΠ΅Ρ ΡΠ±Π΅Π΄ΠΈΡΡΡΡ Π² ΠΏΡΠ°Π²ΠΈΠ»ΡΠ½ΠΎΠΌ Π²ΡΠ±ΠΎΡΠ΅ Π²Π΅ΡΡΠΈΠΈ I2Cdevlib.
Π ΠΊΠΎΠ½ΡΠ΅ ΡΡΠΎΠ³ΠΎ ΡΠ°Π·Π΄Π΅Π»Π° ΠΏΡΠΈΠ²Π΅Π΄Π΅Π½Ρ ΡΡΡΠ»ΠΊΠΈ Π½Π° Π°Π΄Π°ΠΏΡΠΈΡΠΎΠ²Π°Π½Π½ΡΠ΅ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ. ΠΡΠΈ ΡΠ°Π±ΠΎΡΠ΅ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌ Π±ΡΠ΄ΡΡ ΠΏΠΎΠ»ΡΡΠ΅Π½Ρ ΠΏΡΠΈΠΌΠ΅ΡΠ½ΠΎ ΡΠ»Π΅Π΄ΡΡΡΠΈΠ΅ ΡΠΈΡΠ»Π°, Π½ΠΎ ΠΈΡ Π½ΡΠΆΠ½ΠΎ ΠΏΡΠ΅ΠΎΠ±ΡΠ°Π·ΠΎΠ²Π°ΡΡ Π² Π·Π½Π°ΡΠΈΠΌΡΠ΅ Π΄Π°Π½Π½ΡΠ΅.
Β
MPU-6050Β
ReadΒ accel,Β tempΒ andΒ gyro,Β errorΒ =Β 0Β
accelΒ x,y,z:Β -123,Β -180,Β 14547Β
temperature:Β 27.235Β degreesΒ CelsiusΒ
gyroΒ x,y,zΒ :Β -6,Β -20,Β 52,
Β
MPU-6050Β
ReadΒ accel,Β tempΒ andΒ gyro,Β errorΒ =Β 0Β
accelΒ x,y,z:Β -195,Β -203,Β 14510Β
temperature:Β 27.128Β degreesΒ CelsiusΒ
gyroΒ x,y,zΒ :Β -15,Β 14,Β 72,
Β
MPU-6050Β
ReadΒ accel,Β tempΒ andΒ gyro,Β errorΒ =Β 0Β
accelΒ x,y,z:Β -232,Β -268,Β 14490Β
temperature:Β 27.190Β degreesΒ CelsiusΒ
gyroΒ x,y,zΒ :Β -4,Β -7,Β 45,
Β
MPU-6050Β
ReadΒ accel,Β tempΒ andΒ gyro,Β errorΒ =Β 0Β
accelΒ x,y,z:Β -189,Β -170,Β 14632
temperature:Β 27.199Β degreesΒ CelsiusΒ
gyroΒ x,y,zΒ :Β -4,Β -7,Β 50,
…
Β
Π Π½Π°ΡΠ°Π»Π΅ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ Π΄ΠΎΠ»ΠΆΠ½Π° ΠΏΡΠΎΠΈΡΡ ΠΎΠ΄ΠΈΡΡ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠ° ΠΏΠΎ ΠΏΠ΅ΡΠ²ΡΠΌ 10 Π΄Π°Π½Π½ΡΠΌ Π΄Π»Ρ ΠΏΠΎΠ»ΡΡΠ΅Π½ΠΈΡ ΠΏΠΎΡΡΠΎΡΠ½Π½ΡΡ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΠ΅ΠΉ (ΡΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ) ΠΎΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ². Π‘ΠΌΠ΅ΡΠ΅Π½ΠΈΡ Π²ΡΡΠΈΡΠ°Π΅ΠΌ ΠΈΠ· Π½Π΅ΠΎΠ±ΡΠ°Π±ΠΎΡΠ°Π½Π½ΡΡ Π·Π½Π°ΡΠ΅Π½ΠΈΠΉ Π΄Π°ΡΡΠΈΠΊΠ° Π΄ΠΎ ΠΏΡΠ΅ΠΎΠ±ΡΠ°Π·ΠΎΠ²Π°Π½ΠΈΡ Π΄Π°Π½Π½ΡΡ Π² ΡΠ³Π»Ρ.
ΠΠ»Ρ Π²ΡΡΠΈΡΠ»Π΅Π½ΠΈΡ ΠΎΡΠΈΠ΅Π½ΡΠ°ΡΠΈΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠΎΠΌ, ΠΌΡ ΠΎΠΏΠΈΡΠ°Π΅ΠΌΡΡ Π½Π° ΡΠΎΡ ΡΠ°ΠΊΡ, ΡΡΠΎ ΠΏΡΠΎΠΈΡΡ ΠΎΠ΄ΠΈΡ ΠΏΠΎΡΡΠΎΡΠ½Π½ΠΎΠ΅ Π³ΡΠ°Π²ΠΈΡΠ°ΡΠΈΠΎΠ½Π½ΠΎΠ΅ ΠΏΡΠΈΡΡΠΆΠ΅Π½ΠΈΠ΅ 1 g. ΠΡΠ»ΠΈ Π½Π΅Ρ Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡΠ΅Π»ΡΠ½ΡΡ ΡΠΈΠ», Π΄Π΅ΠΉΡΡΠ²ΡΡΡΠΈΡ Π½Π° Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ, ΡΠΎ ΠΎΠ±Π½Π°ΡΡΠΆΠ΅Π½Π½Π°Ρ Π²Π΅Π»ΠΈΡΠΈΠ½Π° ΡΡΠΊΠΎΡΠ΅Π½ΠΈΡ Π±ΡΠ΄Π΅Ρ 1 g.
Π‘ΠΎΠ³Π»Π°ΡΠ½ΠΎ ΠΎΠΏΠΈΡΠ°Π½ΠΈΡ MPU-6050 Ρ. 13 (Sensitivity Scale Factor), ΡΡΡΡΠ΅ Π΄Π°Π½Π½ΡΠ΅ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΠΎΠΉ ΠΏΡΠ΅ΠΎΠ±ΡΠ°Π·ΡΡΡΡΡ Π² ΡΡΠΊΠΎΡΠ΅Π½ΠΈΠ΅ ΡΠ²ΠΎΠ±ΠΎΠ΄Π½ΠΎΠ³ΠΎ ΠΏΠ°Π΄Π΅Π½ΠΈΡ g=9,8 ΠΌ/Ρ^2 ΠΏΡΡΠ΅ΠΌ Π΄Π΅Π»Π΅Π½ΠΈΡ Π½Π° ΠΊΠΎΡΡΡΠΈΡΠΈΠ΅Π½Ρ 16384. ΠΡΠΈ ΠΏΠ΅ΡΠ΅ΠΌΠ΅ΡΠ΅Π½ΠΈΠΈ ΠΈ Π²ΡΠ°ΡΠ΅Π½ΠΈΠΈ Π΄Π°ΡΡΠΈΠΊΠ°, Π΄Π°Π½Π½ΡΠ΅ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΡΠΈΠ»ΡΠ½ΠΎ ΠΊΠΎΠ»Π΅Π±Π»ΡΡΡΡ. ΠΡΠ»ΠΈ ΠΎΠ½ΠΈ ΠΌΠΎΠ³ΡΡ Π±ΡΡΡ ΠΎΡΠΈΡΠ΅Π½Ρ ΠΎΡ ΡΡΠΌΠΎΠ², ΡΠΎ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΎΠ±Π΅ΡΠΏΠ΅ΡΠΈΡ ΡΠΎΡΠ½ΡΠ΅ ΡΠ΅Π·ΡΠ»ΡΡΠ°ΡΡ.
ΠΠ»Ρ Π²ΡΡΠΈΡΠ»Π΅Π½ΠΈΡ ΠΎΡΠΈΠ΅Π½ΡΠ°ΡΠΈΠΈ, ΠΌΡ Π΄ΠΎΠ»ΠΆΠ½Ρ ΡΠ½Π°ΡΠ°Π»Π° ΠΈΠ½ΠΈΡΠΈΠ°Π»ΠΈΠ·ΠΈΡΠΎΠ²Π°ΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ Ρ ΠΈΠ·Π²Π΅ΡΡΠ½ΡΠΌ Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ΠΌ (Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎ, ΠΎΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°), Π·Π°ΡΠ΅ΠΌ ΠΈΠ·ΠΌΠ΅ΡΡΡΡ ΡΠ³Π»ΠΎΠ²ΡΡ ΡΠΊΠΎΡΠΎΡΡΡ Ο ΡΠ΅ΡΠ΅Π· ΠΈΠ½ΡΠ΅ΡΠ²Π°Π»Ρ Π²ΡΠ΅ΠΌΠ΅Π½ΠΈ Ξt. Π’ΠΎΠ³Π΄Π° Ο Γ Ξt = ΠΈΠ·ΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ ΡΠ³Π»Π°. ΠΡΠΎΠ±Π»Π΅ΠΌΠ° Ρ ΡΡΠΈΠΌ ΠΏΠΎΠ΄Ρ ΠΎΠ΄ΠΎΠΌ Π·Π°ΠΊΠ»ΡΡΠ°Π΅ΡΡΡ Π² ΡΠΎΠΌ, ΡΡΠΎ ΠΌΡ ΠΈΠ½ΡΠ΅Π³ΡΠΈΡΡΠ΅ΠΌ. ΠΠ½ΠΎΠ³ΠΎΠΊΡΠ°ΡΠ½ΠΎΠ΅ ΡΡΠΌΠΌΠΈΡΠΎΠ²Π°Π½ΠΈΠ΅ ΠΏΡΠΈΡΠ°ΡΠ΅Π½ΠΈΡ Ο Γ Ξt ΠΏΡΠΈΠ²Π΅Π΄Π΅Ρ ΠΊ ΡΠ²Π΅Π»ΠΈΡΠΈΠ²Π°ΡΡΠ΅ΠΉΡΡ ΡΠΎ Π²ΡΠ΅ΠΌΠ΅Π½Π΅ΠΌ ΠΎΡΠΈΠ±ΠΊΠ΅. ΠΡΠΎ ΡΠ²Π»ΡΠ΅ΡΡΡ ΠΏΡΠΈΡΠΈΠ½ΠΎΠΉ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠΈΡΠ΅ΡΠΊΠΎΠ³ΠΎ Π΄ΡΠ΅ΠΉΡΠ°.
ΠΠ΅Π»Π΅Π½ΠΈΠ΅ ΡΡΡΡΡ Π΄Π°Π½Π½ΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° Π½Π° 131 Π΄Π°Π΅Ρ ΡΠ³Π»ΠΎΠ²ΡΡ ΡΠΊΠΎΡΠΎΡΡΡ Π² Π³ΡΠ°Π΄ΡΡΠ°Ρ Π² ΡΠ΅ΠΊΡΠ½Π΄Ρ. 131 — ΠΊΠΎΡΡΡΠΈΡΠΈΠ΅Π½Ρ ΡΡΠ²ΡΡΠ²ΠΈΡΠ΅Π»ΡΠ½ΠΎΡΡΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° Π² Π·Π°Π΄Π°Π½Π½ΠΎΠΌ ΡΠ΅ΠΆΠΈΠΌΠ΅ 250 Π³ΡΠ°Π΄/Ρ. ΠΠΎΡΠΊΠΎΠ»ΡΠΊΡ Ρ Π½Π΅Π³ΠΎ ΠΠ¦Π 16 Π±ΠΈΡ, ΡΠΎ ΠΌΠΎΠ΄ΡΠ»Ρ ΠΌΠ°ΠΊΡΠΈΠΌΠ°Π»ΡΠ½ΠΎΠ³ΠΎ Π½Π΅ΠΎΠ±ΡΠ°Π±ΠΎΡΠ°Π½Π½ΠΎΠ³ΠΎ Π·Π½Π°ΡΠ΅Π½ΠΈΡ ΡΠ°Π²Π΅Π½ 32767. Π’Π΅ΠΏΠ΅ΡΡ 32767 / 250 = 131 ΡΡΠ»ΠΎΠ²Π½ΡΡ Π΅Π΄ΠΈΠ½ΠΈΡ Π½Π° Π³ΡΠ°Π΄ΡΡ Π² ΡΠ΅ΠΊΡΠ½Π΄Ρ. Π’ΠΎ Π΅ΡΡΡ, Π΅ΡΠ»ΠΈ Π½Π΅ΠΎΠ±ΡΠ°Π±ΠΎΡΠ°Π½Π½ΠΎΠ΅ Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ ΡΠ°Π²Π½ΠΎ 131, ΡΠΎ ΡΠ³Π»ΠΎΠ²Π°Ρ ΡΠΊΠΎΡΠΎΡΡΡ ΡΠ°Π²Π½Π° 1 Π³ΡΠ°Π΄ΡΡ Π² ΡΠ΅ΠΊΡΠ½Π΄Ρ.
Β Π‘ ΠΏΠΎΠΌΠΎΡΡΡ ΡΡΠΈΡ Π΄Π°Π½Π½ΡΡ ΠΌΠΎΠΆΠ½ΠΎ ΠΏΠΎΠ»ΡΡΠΈΡΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ ΠΎΠ±ΡΠ΅ΠΊΡΠ°. ΠΠ»Ρ ΡΡΠΎΠ³ΠΎ ΠΌΠ³Π½ΠΎΠ²Π΅Π½Π½ΠΎΠ΅ Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ ΡΠ³Π»ΠΎΠ²ΠΎΠΉ ΡΠΊΠΎΡΠΎΡΡΠΈ ΡΠΌΠ½ΠΎΠΆΠΈΠΌ Π½Π° ΠΏΡΠΎΠΌΠ΅ΠΆΡΡΠΎΠΊ Π²ΡΠ΅ΠΌΠ΅Π½ΠΈ ΠΌΠ΅ΠΆΠ΄Ρ ΠΎΠΏΡΠΎΡΠ°ΠΌΠΈ Π΄Π°ΡΡΠΈΠΊΠ° Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°. ΠΠ°ΠΏΡΠΈΠΌΠ΅Ρ, ΡΠ°Π·ΡΠ΅ΡΠ΅Π½ΠΈΠ΅ 2000 Π³ΡΠ°Π΄ΡΡΠΎΠ² Π² ΡΠ΅ΠΊΡΠ½Π΄Ρ, Π²ΡΠ΅ΠΌΡ ΠΌΠ΅ΠΆΠ΄Ρ ΠΎΠΏΡΠΎΡΠ°ΠΌΠΈ 0,1 Ρ, Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ ΠΌΠ³Π½ΠΎΠ²Π΅Π½Π½ΠΎΠΉ ΡΠΊΠΎΡΠΎΡΡΠΈ 210, Π·Π½Π°ΡΠΈΡ 210*0,1=21 β Π·Π° ΡΡΠΎ Π²ΡΠ΅ΠΌΡ ΠΏΡΠΎΠΈΠ·ΠΎΡΠ΅Π» ΠΏΠΎΠ²ΠΎΡΠΎΡ Π½Π° 21 Π³ΡΠ°Π΄ΡΡ. ΠΠ°Π»Π΅Π΅ ΠΊΠ°ΠΆΠ΄ΠΎΠ΅ ΠΏΠΎΠ»ΡΡΠ΅Π½Π½ΠΎΠ΅ Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ Π½ΡΠΆΠ½ΠΎ ΡΠ»ΠΎΠΆΠΈΡΡ Ρ ΠΏΡΠ΅Π΄ΡΠ΄ΡΡΠΈΠΌ.
ΠΠ°ΠΊ ΠΎΠ±ΡΡΡΠ½Π΅Π½ΠΎ Π²ΡΡΠ΅ Π΄Π°Π½Π½ΡΠ΅ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΡΠΊΠ»ΠΎΠ½Π½Ρ ΠΊ ΡΠΈΡΡΠ΅ΠΌΠ°ΡΠΈΡΠ΅ΡΠΊΠΈΠΌ ΠΎΡΠΈΠ±ΠΊΠ°ΠΌ. ΠΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΎΠ±Π΅ΡΠΏΠ΅ΡΠΈΠ²Π°Π΅Ρ ΠΏΠΎΠ»ΡΡΠ΅Π½ΠΈΠ΅ ΡΠΎΡΠ½ΡΡ Π΄Π°Π½Π½ΡΡ Π² Π΄ΠΎΠ»Π³ΠΎΡΡΠΎΡΠ½ΠΎΠΉ ΠΏΠ΅ΡΡΠΏΠ΅ΠΊΡΠΈΠ²Π΅, Π½ΠΎ Π΄Π°Π΅Ρ ΡΠΈΠ»ΡΠ½ΡΠΉ ΡΡΠΌ ΠΏΡΠΈ ΡΠ°ΡΡΠΌΠΎΡΡΠ΅Π½ΠΈΠΈ Π·Π° ΠΊΠΎΡΠΎΡΠΊΠΈΠΉ ΠΏΡΠΎΠΌΠ΅ΠΆΡΡΠΎΠΊ Π²ΡΠ΅ΠΌΠ΅Π½ΠΈ. ΠΠΈΡΠΎΡΠΊΠΎΠΏ ΠΎΠ±Π΅ΡΠΏΠ΅ΡΠΈΠ²Π°Π΅Ρ ΠΏΠΎΠ»ΡΡΠ΅Π½ΠΈΠ΅ ΡΠΎΡΠ½ΡΡ Π΄Π°Π½Π½ΡΡ ΠΎ ΠΈΠ·ΠΌΠ΅Π½Π΅Π½ΠΈΠΈ ΠΎΡΠΈΠ΅Π½ΡΠ°ΡΠΈΠΈ Π·Π° ΠΊΠΎΡΠΎΡΠΊΠΈΠΉ ΠΏΡΠΎΠΌΠ΅ΠΆΡΡΠΎΠΊ Π²ΡΠ΅ΠΌΠ΅Π½ΠΈ, Π½ΠΎ ΠΏΡΠΈ ΠΈΠ½ΡΠ΅Π³ΡΠ°ΡΠΈΠΈ Π΄Π°Π½Π½ΡΡ ΠΏΡΠΎΠΈΡΡ ΠΎΠ΄ΠΈΡ Π΄ΡΠ΅ΠΉΡ.
Π Π΅ΡΠ΅Π½ΠΈΠ΅ ΡΡΠΈΡ ΠΏΡΠΎΠ±Π»Π΅ΠΌ Π·Π°ΠΊΠ»ΡΡΠ°Π΅ΡΡΡ Π² ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΠΈ Π΄Π°Π½Π½ΡΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° Π²ΠΌΠ΅ΡΡΠ΅ ΡΠ°ΠΊΠΈΠΌ ΠΎΠ±ΡΠ°Π·ΠΎΠΌ, ΡΡΠΎΠ±Ρ ΠΎΡΠΈΠ±ΠΊΠΈ Π²Π·Π°ΠΈΠΌΠ½ΠΎ ΡΠ½ΠΈΡΡΠΎΠΆΠ°Π»ΠΈΡΡ. Π‘ΡΠ°Π½Π΄Π°ΡΡΠ½ΡΠΉ ΡΠΏΠΎΡΠΎΠ± ΠΎΠ±ΡΠ΅Π΄ΠΈΠ½Π΅Π½ΠΈΡ β ΠΏΡΠΈΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ ΡΠΈΠ»ΡΡΡΠ° ΠΠ°Π»ΠΌΠ°Π½Π°, ΠΊΠΎΡΠΎΡΡΠΉ ΡΠ²Π»ΡΠ΅ΡΡΡ Π΄ΠΎΠ²ΠΎΠ»ΡΠ½ΠΎ ΡΠ»ΠΎΠΆΠ½ΠΎΠΉ ΠΌΠ΅ΡΠΎΠ΄ΠΈΠΊΠΎΠΉ. ΠΡΡΡ Π±ΠΎΠ»Π΅Π΅ ΠΏΡΠΎΡΡΠ°Ρ Π°ΠΏΠΏΡΠΎΠΊΡΠΈΠΌΠ°ΡΠΈΡ Π΄Π»Ρ ΠΎΠ±ΡΠ΅Π΄ΠΈΠ½Π΅Π½ΠΈΡ ΡΡΠΈΡ Π΄Π²ΡΡ ΡΠΈΠΏΠΎΠ² Π΄Π°Π½Π½ΡΡ β ΠΊΠΎΠΌΠΏΠ»Π΅ΠΌΠ΅Π½ΡΠ°ΡΠ½ΡΠΉ ΡΠΈΠ»ΡΡΡ. Π₯ΠΎΡΠΎΡΠΎ ΠΎΠ±ΡΡΡΠ½Π΅Π½ΠΎ Π·Π΄Π΅ΡΡ ΠΈ Π·Π΄Π΅ΡΡ. ΠΠΎΡ ΡΠΎΡΠΌΡΠ»Π° ΠΊΠΎΠΌΠ±ΠΈΠ½ΠΈΡΠΎΠ²Π°Π½ΠΈΡ Π΄Π°Π½Π½ΡΡ ΠΎΠ±ΠΎΠΈΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ²:
Β
Π£Π³ΠΎΠ» ΡΠΈΠ»ΡΡΡΠ° = Ξ± Γ (Π£Π³ΠΎΠ» ΠΎΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°) + (1 β Ξ±) Γ (Π£Π³ΠΎΠ» ΠΎΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°)
Ξ±=Ο/(Ο + Ξt)
Π£Π³ΠΎΠ» ΠΎΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° = (ΠΠΎΡΠ»Π΅Π΄Π½ΠΈΠΉ ΡΠ³ΠΎΠ» ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½Π½ΡΠΉ ΡΠΈΠ»ΡΡΡΠΎΠΌ) + ΟΓΞt
Ξt = Π²ΡΠ΅ΠΌΡ Π²ΡΠ±ΠΎΡΠΊΠΈ
Β Ο = ΠΏΠΎΡΡΠΎΡΠ½Π½Π°Ρ Π²ΡΠ΅ΠΌΠ΅Π½ΠΈ ΠΏΡΠ΅Π²ΡΡΠ°ΡΡΠ°Ρ ΠΈΠ½ΡΠ΅ΡΠ²Π°Π»Ρ ΠΌΠ΅ΠΆΠ΄Ρ ΡΡΠΌΠ°ΠΌΠΈ
Π£Π³ΠΎΠ» ΡΠΈΠ»ΡΡΡΠ° β ΠΎΡΡΠΈΠ»ΡΡΡΠΎΠ²Π°Π½Π½ΡΠΉ, ΡΠ΅Π·ΡΠ»ΡΡΠΈΡΡΡΡΠΈΠΉ ΡΠ³ΠΎΠ» Π½Π°ΠΊΠ»ΠΎΠ½Π°
Π Π΅ΠΊΠΎΠΌΠ΅Π½Π΄ΡΠ΅ΡΡΡ Π²ΡΠ΅ΠΌΡ Π²ΡΠ±ΠΎΡΠΊΠΈ ΠΎΠΊΠΎΠ»ΠΎ 0,04 Ρ ΠΈ ΠΏΠΎΡΡΠΎΡΠ½Π½Π°Ρ Π²ΡΠ΅ΠΌΠ΅Π½ΠΈ ΠΎΠΊΠΎΠ»ΠΎ 1 Ρ, ΡΡΠΎ Π΄Π°Π΅Ρ Ξ±β0,96.
Β
ΠΠ΅Π»ΠΈΡΠΈΠ½Π° ΡΠ³Π»Π° Π½Π°ΠΊΠ»ΠΎΠ½Π° ΠΏΡΠ΅Π΄ΡΡΠ°Π²Π»ΡΠ΅Ρ ΡΠΎΠ±ΠΎΠΉ ΡΡΠΌΠΌΡ ΠΈΠ½ΡΠ΅Π³ΡΠΈΡΠΎΠ²Π°Π½Π½ΠΎΠ³ΠΎ Π·Π½Π°ΡΠ΅Π½ΠΈΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ ΠΌΠ³Π½ΠΎΠ²Π΅Π½Π½ΠΎΠ³ΠΎ Π·Π½Π°ΡΠ΅Π½ΠΈΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. ΠΠ»Π°Π²Π½Π°Ρ Π·Π°Π΄Π°ΡΠ° ΠΊΠΎΠΌΠΏΠ»Π΅ΠΌΠ΅Π½ΡΠ°ΡΠ½ΠΎΠ³ΠΎ ΡΠΈΠ»ΡΡΡΠ° Π² ΡΠΎΠΌ, ΡΡΠΎΠ±Ρ Π»ΠΈΠΊΠ²ΠΈΠ΄ΠΈΡΠΎΠ²Π°ΡΡ Π΄ΡΠ΅ΠΉΡ Π½ΡΠ»Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ ΠΎΡΠΈΠ±ΠΊΠΈ Π΄ΠΈΡΠΊΡΠ΅ΡΠ½ΠΎΠ³ΠΎ ΠΈΠ½ΡΠ΅Π³ΡΠΈΡΠΎΠ²Π°Π½ΠΈΡ. ΠΠ° ΠΊΠ°ΠΆΠ΄ΠΎΠΌ ΡΠ°Π³Π΅ ΠΈΠ½ΡΠ΅Π³ΡΠΈΡΠΎΠ²Π°Π½ΠΈΡ (ΡΠ°Π³Π΅ ΡΠΈΠΊΠ»Π° ΡΠΏΡΠ°Π²Π»Π΅Π½ΠΈΡ ΠΌΠ°ΡΠΈΠ½ΠΎΠΉ) ΠΊΠΎΡΡΠ΅ΠΊΡΠΈΡΡΠ΅ΡΡΡ ΠΈΠ½ΡΠ΅Π³ΡΠ°Π» ΡΠ³Π»Π° Π½Π°ΠΊΠ»ΠΎΠ½Π° Ρ ΠΏΠΎΠΌΠΎΡΡΡ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΠΉ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. Π‘ΠΈΠ»Π° ΡΡΠΎΠΉ ΠΊΠΎΡΡΠ΅ΠΊΡΠΈΠΈ ΠΎΠΏΡΠ΅Π΄Π΅Π»ΡΠ΅ΡΡΡ ΠΊΠΎΡΡΡΠΈΡΠΈΠ΅Π½ΡΠΎΠΌ ΡΠΈΠ»ΡΡΡΠ° Ξ±. ΠΡΠ±ΠΎΡ ΠΊΠΎΡΡΡΠΈΡΠΈΠ΅Π½ΡΠ° Ξ± Π·Π°Π²ΠΈΡΠΈΡ ΠΎΡ Π²Π΅Π»ΠΈΡΠΈΠ½Ρ Π΄ΡΠ΅ΠΉΡΠ° Π½ΡΠ»Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°, ΠΎΡ ΡΠΊΠΎΡΠΎΡΡΠΈ Π½Π°ΠΊΠΎΠΏΠ»Π΅Π½ΠΈΡ ΠΎΡΠΈΠ±ΠΎΠΊ Π²ΡΡΠΈΡΠ»Π΅Π½ΠΈΡ ΠΈ ΠΎΡ ΡΡΠ»ΠΎΠ²ΠΈΠΉ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΡ ΠΌΠ°ΡΠΈΠ½Ρ. Π’Π°ΠΊ, ΡΠ»ΠΈΡΠΊΠΎΠΌ ΠΌΠ°Π»ΠΎΠ΅ Π·Π½Π°ΡΠ΅Π½ΠΈΠ΅ Ξ± ΠΏΡΠΈΠ²Π΅Π΄Π΅Ρ ΠΊ ΡΠΎΠΌΡ, ΡΡΠΎ Π½Π° ΡΠ΅Π·ΡΠ»ΡΡΠ°Ρ ΡΠ°Π±ΠΎΡΡ ΡΠΈΠ»ΡΡΡΠ° Π±ΡΠ΄Π΅Ρ Π²Π»ΠΈΡΡΡ Π²ΠΈΠ±ΡΠ°ΡΠΈΡ ΠΊΠΎΡΠΏΡΡΠ°. ΠΠ°ΠΊ ΠΏΡΠ°Π²ΠΈΠ»ΠΎ, ΠΊΠΎΡΡΡΠΈΡΠΈΠ΅Π½Ρ ΠΊΠΎΠΌΠΏΠ»Π΅ΠΌΠ΅Π½ΡΠ°ΡΠ½ΠΎΠ³ΠΎ ΡΠΈΠ»ΡΡΡΠ° ΠΏΠΎΠ΄Π±ΠΈΡΠ°Π΅ΡΡΡ Π²ΡΡΡΠ½ΡΡ Π΄Π»Ρ ΠΊΠ°ΠΆΠ΄ΠΎΠ³ΠΎ ΡΠ»ΡΡΠ°Ρ.
Β
ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠ½ΠΎΠ΅ ΠΎΠ±Π΅ΡΠΏΠ΅ΡΠ΅Π½ΠΈΠ΅ ΠΌΠΎΠ΄ΡΠ»Ρ 3-Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° GY-521 MPU-6050 Π΄Π»Ρ Π°ΡΠ΄ΡΠΈΠ½ΠΎ:
GY_521_send_serial
ShowGY521Data
Β
ΠΠ½Π³Π»ΠΎΡΠ·ΡΡΠ½Π°Ρ Π²Π΅ΡΡΠΈΡ ΡΡΠΎΠ³ΠΎ ΡΠ°Π·Π΄Π΅Π»Π°, Π° ΠΏΡΠΎΠ΄ΠΎΠ»ΠΆΠ΅Π½ΠΈΠ΅ ΡΠ°Π·Π³ΠΎΠ²ΠΎΡΠ° Π·Π΄Π΅ΡΡ.
Β
Π‘ΠΎΠ²ΡΠ΅ΠΌΠ΅Π½Π½ΠΎΠ΅ ΠΏΡΠΈΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°:
Β
Β
Β
ΠΠΈΠΊΡΠΎΡΡ Π΅ΠΌΠ° MPU-6050
Β Β Β Β Β Β Β Β Β Β Β ΠΠΏΠΈΡΠ°Π½ΠΈΠ΅
Β Β Β Β Β Β Β Β Β Β Β Π‘ΡΡΠ°Π½ΠΈΡΠ° ΠΏΡΠΎΠΈΠ·Π²ΠΎΠ΄ΠΈΡΠ΅Π»Ρ 1
Β Β Β Β Β Β Β Β Β Β Β Π‘ΡΡΠ°Π½ΠΈΡΠ° ΠΏΡΠΎΠΈΠ·Π²ΠΎΠ΄ΠΈΡΠ΅Π»Ρ 2
Β Β Β Β Β Β Β Β Β Β Β Π ΡΠ΅Π³ΠΈΡΡΡΠ°Ρ
Β Β Β Β Β Β Β Β Β Β Β ΠΎΠΏΠΈΡΠ°Π½ΠΈΠ΅
Β Β Β Β Β Β Β Β Β Β Β on-line
ΠΠΎΠΌΠ°ΡΠ½ΡΡ ΡΡΡΠ°Π½ΠΈΡΠ° MPU-6050 Accelerometer + Gyro
Β Β Β Β Β Β Β Β Β Β Β ΠΎΠ±ΡΠ΅ΠΌΠ½Π°Ρ
Β Β Β Β Β Β Β Β Β Β Β ΠΊΠΎΡΠΎΡΠΊΠ°Ρ
ΠΠΈΠΊΠΈ
ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠ° Krodal
Β
arduino-kit.ru
MPU-6050 β Π³ΠΈΡΠΎΡΠΊΠΎΠΏ β Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ
Π’ΡΠ΅Ρ ΠΎΡΠ΅Π²ΠΎΠΉ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ Ρ ΡΡΠ΅Ρ ΠΎΡΠ΅Π²ΡΠΌ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠΎΠΌ MPU-6050 ΠΎΡΠ΅Π½Ρ Π΄ΠΎΡΡΡΠΏΠ΅Π½ ΠΏΠΎ ΡΠ΅Π½Π΅, ΡΠ΅ΠΌ ΠΈ ΠΏΡΠΈΠΎΠ±ΡΠ΅Π» ΡΠ΅Π±Π΅ ΠΏΠΎΠΏΡΠ»ΡΡΠ½ΠΎΡΡΡ. ΠΡΠΎΡ Π΄Π°ΡΡΠΈΠΊ ΠΏΡΠΈΠΌΠ΅Π½ΡΠ΅ΡΡΡ Π΄Π»Ρ ΠΎΠΏΡΠ΅Π΄Π΅Π»Π΅Π½ΠΈΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΡ Π² ΠΏΡΠΎΡΡΡΠ°Π½ΡΡΠ²Π΅, Π² ΡΠΈΡΡΠ΅ΠΌΠ°Ρ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·Π°ΡΠΈΠΈ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΡ, ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·Π°ΡΠΈΠΈ ΠΏΡΡΠΌΠΎΠ»ΠΈΠ½Π΅ΠΉΠ½ΠΎΠ³ΠΎ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΡ ΠΈ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΡ ΠΏΠΎ Π·Π°Π΄Π°Π½Π½ΠΎΠΉ ΠΊΡΠΈΠ²ΠΎΠΉ. ΠΠ°ΠΏΡΠΈΠΌΠ΅Ρ, Π² Π±Π°Π»Π°Π½ΡΠΈΡΠ½ΡΡ ΡΠΎΠ±ΠΎΡΠ°Ρ , Π² ΠΈΠ³ΡΠΎΠ²ΡΡ ΠΏΡΠΈΡΡΠ°Π²ΠΊΠ°Ρ , ΠΏΡΠΈΠΌΠ΅Π½ΡΠ΅ΡΡΡ Π² ΡΠΎΠ±ΠΎΡΠΎΡΠ΅Ρ Π½ΠΈΠΊΠ΅, Π΄Π»Ρ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΡ ΡΠ³Π»ΠΎΠ² Π½Π°ΠΊΠ»ΠΎΠ½Π°, ΡΠΊΠΎΡΠΎΡΡΠΈ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ, Π² Π°Π²ΠΈΠ°ΠΌΠΎΠ΄Π΅Π»ΠΈΠ·ΠΌΠ΅ Π΅Π³ΠΎ ΠΏΡΠΈΠΌΠ΅Π½ΡΡΡ Π² Π°Π²ΡΠΎΠΏΠΈΠ»ΠΎΡΠ°Ρ . ΠΠ°ΡΡΠΈΠΊ ΠΌΠΎΠΆΠ΅Ρ ΠΏΡΠΈΠΌΠ΅Π½ΡΡΡΡΡ Π΄Π»Ρ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΡ ΠΏΠ΅ΡΠ΅Π³ΡΡΠ·ΠΎΠΊ ΠΈ ΡΠΎΠΌΡ ΠΏΠΎΠ΄ΠΎΠ±Π½ΠΎΠ΅.
Π‘Ρ Π΅ΠΌΠ° ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΡ
ΠΠ»Ρ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΡ ΠΊ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΡ ΠΈΠ»ΠΈ ΠΌΠΈΠΊΡΠΎΠΊΠΎΠΌΠΏΡΡΡΠ΅ΡΡ, Ρ Π΄Π°ΡΡΠΈΠΊΠ° ΠΈΠΌΠ΅Π΅ΡΡΡ ΡΠΈΠ½Π° I2C.
ΠΠΎΠΊΡΠΌΠ΅Π½ΡΠ°ΡΠΈΡ ΠΏΠΎ Π΄Π°ΡΡΠΈΠΊΡ ΡΠΊΠ°ΡΠ°ΡΡ Π·Π΄Π΅ΡΡ: MPU-6000 and MPU-6050 Product Specification Revision 3.2
ΠΠΏΠΈΡΠ°Π½ΠΈΠ΅ ΡΠ΅Π³ΠΈΡΡΡΠΎΠ² Π·Π΄Π΅ΡΡ: MPU-6000 and MPU-6050 Register Map and Descriptions Revision 4.0
Π‘ΠΊΠ°ΡΠ°ΡΡ ΠΏΡΠΈΠΌΠ΅ΡΡ Π½Π° Python
ΠΠ»Ρ Raspberry Pi (OS: Raspbian) ΠΏΡΠΈΠΌΠ΅ΡΡ ΡΠΊΡΠΈΠΏΡΠΎΠ² ΠΌΠΎΠΆΠ½ΠΎ ΡΠΊΠ°ΡΠ°ΡΡ ΠΈ ΡΠ°Π·Π²Π΅ΡΠ½ΡΡΡ ΡΠ°ΠΊ:
git clone https://github.com/avislab/sensorstest.git
ΠΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠ°
ΠΡΠ»ΠΈ ΡΡΠΈΡΠ°ΡΡ Π΄Π°Π½Π½ΡΠ΅ Ρ Π΄Π°ΡΡΠΈΠΊΠ° ΠΌΠΎΠΆΠ½ΠΎ Π·Π°ΠΌΠ΅ΡΠΈΡΡ Π½Π΅ΠΊΠΎΡΠΎΡΡΡ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΡ. ΠΠ°ΠΏΡΠΈΠΌΠ΅Ρ, ΠΏΡΠΈ Π°Π±ΡΠΎΠ»ΡΡΠ½ΠΎΠΌ ΠΏΠΎΠΊΠΎΠ΅ Π΄Π°ΡΡΠΈΠΊΠ° ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° Π±ΡΠ΄ΡΡ ΠΎΡΠ»ΠΈΡΠ°ΡΡΡΡ ΠΎΡ Π½ΡΠ»Ρ.
ΠΠ° ΡΠ°ΠΌΠΎΠΌ Π΄Π΅Π»Π΅ ΠΏΡΠΈΡΡΡΡΡΠ²ΡΡΡ ΠΈ Π΄ΡΡΠ³ΠΈΠ΅ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΠΈ. ΠΠ°ΠΏΡΠΈΠΌΠ΅Ρ, ΡΡΠ΅Ρ ΠΎΡΠ΅Π²ΡΠ΅ Π΄Π°ΡΡΠΈΠΊΠΈ Π΄ΠΎΠ»ΠΆΠ½Ρ ΡΠ°ΡΠΏΠΎΠ»Π°Π³Π°ΡΡΡΡ Π²Π·Π°ΠΈΠΌΠ½ΠΎ ΠΏΠ΅ΡΠΏΠ΅Π½Π΄ΠΈΠΊΡΠ»ΡΡΠ½ΠΎ. ΠΠΎ ΠΏΡΠΈ ΠΏΡΠΎΠΈΠ·Π²ΠΎΠ΄ΡΡΠ²Π΅ ΡΡΡΠ΄Π½ΠΎ Π΄ΠΎΠ±ΠΈΡΡΡΡ Π°Π±ΡΠΎΠ»ΡΡΠ½ΠΎΠΉ ΡΠΎΡΠ½ΠΎΡΡΠΈ, ΠΏΠΎΡΡΠΎΠΌΡ ΡΡΠΎΡ ΡΠ³ΠΎΠ» ΡΠ°ΠΊΠΆΠ΅ ΠΈΠΌΠ΅Π΅Ρ ΠΎΠΏΡΠ΅Π΄Π΅Π»Π΅Π½Π½ΡΠ΅ Π΄ΠΎΠΏΡΡΠΊΠΈ ΠΈ Π²Π»ΠΈΡΠ΅Ρ Π½Π° ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΡ. ΠΡΠΎΠΌΠ΅ ΡΠΎΠ³ΠΎ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ² Ρ ΡΡΠ΅Ρ ΠΎΡΠ΅ΠΉ ΠΌΠΎΠ³ΡΡ ΠΈΠΌΠ΅ΡΡ ΡΠ°Π·Π½ΡΡ ΠΏΡΠΎΠΏΠΎΡΡΠΈΠΎΠ½Π°Π»ΡΠ½ΠΎΡΡΡ. Π Π΄Π°Π½Π½ΠΎΠΌ ΡΠ»ΡΡΠ°Π΅ Π½Π°ΠΈΠ±ΠΎΠ»ΡΡΠ°Ρ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΡ ΠΈΠ·-Π·Π° ΡΠΌΠ΅ΡΠ΅Π½ΠΈΡ ΠΎΡΠ½ΠΎΡΠΈΡΠ΅Π»ΡΠ½ΠΎ Π½ΡΠ»Ρ.
Π ΠΏΡΠΈΠΌΠ΅ΡΠ΅ Ρ ΠΏΡΠ΅Π΄ΡΡΠΌΠΎΡΡΠ΅Π» ΠΏΡΠΎΡΠ΅Π΄ΡΡΡ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠΈ. Π‘ΠΊΡΠΈΠΏΡ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠΈ: mpu6050_calibr.py. ΠΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠ° Π²ΡΠΏΠΎΠ»Π½ΡΠ΅ΡΡΡ Π² Π΄Π²Π° ΡΡΠ°ΠΏΠ°. Π‘Π½Π°ΡΠ°Π»Π° Π΄Π°ΡΡΠΈΠΊ Π΄ΠΎΠ»ΠΆΠ΅Π½ Π±ΡΡΡ Π½Π΅ΠΏΠΎΠ΄Π²ΠΈΠΆΠ΅Π½. ΠΠΎΠ΄ΡΠ°Π·ΡΠΌΠ΅Π²Π°Π΅ΡΡΡ, ΡΡΠΎ ΡΠ³Π»ΠΎΠ²ΡΠ΅ ΡΠΊΠΎΡΠΎΡΡΠΈ ΡΠ°Π²Π½Ρ Π½ΡΠ»Ρ. ΠΠ°Π»ΠΈΠ±ΡΡΠ΅ΡΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ. ΠΠ°ΡΠ΅ΠΌ ΠΊΠ°Π»ΠΈΠ±ΡΡΠ΅ΡΡΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ. ΠΡΠΆΠ½ΠΎ Π΅Π³ΠΎ Π½Π΅ ΡΠΏΠ΅ΡΠ° ΠΏΠΎΠ²ΠΎΡΠ°ΡΠΈΠ²Π°ΡΡ Π²ΠΎ Π²ΡΠ΅Ρ
Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΡΡ
. ΠΡΠ° ΠΏΡΠΎΡΠ΅Π΄ΡΡΠ° Π·Π°Π½ΠΈΠΌΠ°Π΅Ρ ΠΎΠΊΠΎΠ»ΠΎ ΠΌΠΈΠ½ΡΡΡ. ΠΠΎΡΠ»Π΅ ΡΠ΅Π³ΠΎ ΡΡΠ½ΠΊΡΠΈΡ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠΈ Π²ΡΠ΄Π°Π΅Ρ Π²ΡΡΠΈΡΠ»Π΅Π½Π½ΡΠ΅ Π·Π½Π°ΡΠ΅Π½ΠΈΡ, ΠΊΠΎΡΠΎΡΡΠ΅ Π½ΡΠΆΠ½ΠΎ ΠΏΡΠΎΠΏΠΈΡΠ°ΡΡ Π² ΡΠΊΡΠΈΠΏΡΠ΅. ΠΠ° ΡΡΠΎΠΌ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠ° Π·Π°ΠΊΠΎΠ½ΡΠ΅Π½Π°. ΠΠΎΡΠ»Π΅ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΠΈ ΠΏΠΎΠ³ΡΠ΅ΡΠ½ΠΎΡΡΡ Π·Π½Π°ΡΠΈΡΠ΅Π»ΡΠ½ΠΎ ΡΠ½ΠΈΠ·ΠΈΡΡΡ. Π‘ΠΌ. Π‘ΠΊΡΠΈΠΏΡ: mpu6050_get_raw.py. Π ΡΡΠΎΠΌ ΡΠΊΡΠΈΠΏΡΠ΅ Π² ΡΠ»Π΅Π΄ΡΡΡΠΈΡ
ΡΡΡΠΎΠΊΠ°Ρ
ΡΠΊΠ°Π·ΡΠ²Π°ΡΡΡΡ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΎΡΠ½ΡΠ΅ Π΄Π°Π½Π½ΡΠ΅:
mpu.gyro_offs = {'x': -178, 'y': 259, 'z': -104} mpu.accel_offs = {'y': -354, 'x': 389, 'z': -1482}
ΠΠΈΡΠΎΡΠΊΠΎΠΏ
ΠΠΈΡΠΎΡΠΊΠΎΠΏ ΠΈΠ·ΠΌΠ΅ΡΡΠ΅Ρ ΡΠ³Π»ΠΎΠ²ΡΠ΅ ΡΠΊΠΎΡΠΎΡΡΠΈ ΠΏΠΎ ΡΡΠ΅ΠΌ ΠΎΡΡΠΌ Ρ ΡΠ°Π·Π½ΡΠΌΠΈ ΠΏΡΠ΅Π΄Π΅Π»Π°ΠΌΠΈ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ: 250, 500, 1000, ΠΈ 2000 Π³ΡΠ°Π΄ΡΡΠΎΠ² Π² ΡΠ΅ΠΊΡΠ½Π΄Ρ. ΠΡΠ΅Π΄Π΅Π»Ρ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΡ ΠΌΠΎΠ³ΡΡ Π±ΡΡΡ Π²ΡΡΡΠ°Π²Π»Π΅Π½Ρ Π² ΡΠΎΠΎΡΠ²Π΅ΡΡΡΠ²ΠΈΠΈ Ρ ΠΠ°ΡΠΈΠΌΠΈ Π·Π°Π΄Π°ΡΠ°ΠΌΠΈ. ΠΠ΅ ΡΡΠΎΠΈΡ ΡΡΡΠ°Π½Π°Π²Π»ΠΈΠ²Π°ΡΡ Π±Π΅Π· Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎΡΡΠΈ ΠΌΠ°ΠΊΡΠΈΠΌΠ°Π»ΡΠ½ΡΠ΅ ΠΏΡΠ΅Π΄Π΅Π»Ρ, Π΅ΡΠ»ΠΈ Ρ Π²Π°Ρ Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ ΠΌΠ΅Π΄Π»Π΅Π½Π½Π°Ρ ΡΠΈΡΡΠ΅ΠΌΠ°. ΠΡΠ°Π²ΠΈΠ»ΡΠ½ΠΎ Π²ΡΠ±ΡΠ°Π½Π½ΡΠ΅ ΠΏΡΠ΅Π΄Π΅Π»Ρ ΠΏΠΎΠ²ΡΡΡΡ ΡΠΎΡΠ½ΠΎΡΡΡ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ.
ΠΠ»Ρ ΡΠ΅Ρ , ΠΊΡΠΎ ΡΠ°Π½Π΅Π΅ Π±ΡΠ» Π·Π½Π°ΠΊΠΎΠΌ Ρ ΠΌΠ΅Ρ Π°Π½ΠΈΡΠ΅ΡΠΊΠΈΠΌΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°ΠΌΠΈ, ΠΌΠΎΠ³ΡΡ Π²ΠΎΠ·Π½ΠΈΠΊΠ½ΡΡΡ Π½Π΅ΠΊΠΎΡΠΎΡΡΠ΅ Π½Π΅ΠΎΠΏΡΠ΅Π΄Π΅Π»Π΅Π½Π½ΠΎΡΡΠΈ. ΠΠ΅Π»ΠΎ Π² ΡΠΎΠΌ, ΡΡΠΎ ΠΌΠ΅Ρ Π°Π½ΠΈΡΠ΅ΡΠΊΠΈΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΡ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·ΠΈΡΡΡΡΡΡ Π² ΠΏΡΠΎΡΡΡΠ°Π½ΡΡΠ²Π΅ Π·Π° ΡΡΠ΅Ρ ΡΠ²ΠΎΠΈΡ ΡΠΈΠ·ΠΈΡΠ΅ΡΠΊΠΈΡ ΡΠ²ΠΎΠΉΡΡΠ². ΠΠ»Π΅ΠΊΡΡΠΎΠ½Π½ΡΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΡ ΡΡΠΎΠ³ΠΎ Π΄Π΅Π»Π°ΡΡ Π½Π΅ ΠΌΠΎΠ³ΡΡ, ΠΎΠ½ΠΈ Π»ΠΈΡΡ ΠΈΠ·ΠΌΠ΅ΡΡΡΡ ΡΠΊΠΎΡΠΎΡΡΡ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ Π²ΠΎΠΊΡΡΠ³ ΠΎΡΠ΅ΠΉ ΠΈ Π½ΠΈΡΠ΅Π³ΠΎ Π½Π΅ ΠΌΠΎΠ³ΡΡ ΡΠΎΠΎΠ±ΡΠΈΡΡ ΠΎ ΡΠ΅ΠΊΡΡΠ΅ΠΌ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠΈ ΡΠΈΡΡΠ΅ΠΌΡ.
Π‘ ΠΏΠΎΠΌΠΎΡΡΡ ΡΠ»Π΅ΠΊΡΡΠΎΠ½Π½ΠΎΠ³ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΌΠΎΠΆΠ½ΠΎ ΠΎΠΏΡΠ΅Π΄Π΅Π»ΠΈΡΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ ΡΠΈΡΡΠ΅ΠΌΡ ΡΠ»Π΅Π΄ΡΡΡΠΈΠΌ ΠΎΠ±ΡΠ°Π·ΠΎΠΌ. ΠΡΠΈ Π²ΠΊΠ»ΡΡΠ΅Π½ΠΈΠΈ ΠΏΡΠΈΠ½ΡΡΡ Π½Π°ΡΠ°Π»ΡΠ½ΠΎΠ΅ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ Π·Π° Π½ΡΠ»Π΅Π²ΡΡ ΠΏΠΎΠ·ΠΈΡΠΈΡ. ΠΠ°ΡΠ΅ΠΌ ΠΎΠΏΡΠ°ΡΠΈΠ²Π°ΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ Ρ Π·Π°Π΄Π°Π½Π½ΡΠΌ ΠΈΠ½ΡΠ΅ΡΠ²Π°Π»ΠΎΠΌ, Π·Π½Π°Ρ ΠΈΠ½ΡΠ΅ΡΠ²Π°Π» ΠΈ ΡΠΊΠΎΡΠΎΡΡΡ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ, Π²ΡΡΠΈΡΠ»ΡΡΡ ΡΠΌΠ΅ΡΠ΅Π½ΠΈΠ΅ ΠΈ Π΄ΠΎΠ±Π°Π²Π»ΡΡΡ ΠΊ ΡΠ΅ΠΊΡΡΠ΅ΠΌΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΡ. ΠΡΠΈ ΡΡΠΎΠΌ ΠΌΡ ΠΏΡΠ΅Π΄ΠΏΠΎΠ»Π°Π³Π°Π΅ΠΌ, ΡΡΠΎ ΠΌΠ΅ΠΆΠ΄Ρ Π΄Π²ΡΠΌΡ ΠΎΠΏΡΠΎΡΠ°ΠΌΠΈ Π΄Π°ΡΡΠΈΠΊΠ° ΡΠΈΡΡΠ΅ΠΌΠ° ΠΏΠΎΠ²ΠΎΡΠ°ΡΠΈΠ²Π°Π»Π°ΡΡ Ρ ΠΏΠΎΡΡΠΎΡΠ½Π½ΠΎΠΉ ΡΠΊΠΎΡΠΎΡΡΡΡ. Π’Π°ΠΊΠΎΠΉ ΠΏΠΎΠ΄Ρ ΠΎΠ΄ Π²Π΅Π΄Π΅Ρ ΠΊ Π½Π΅ΠΈΠ·Π±Π΅ΠΆΠ½ΠΎΠΌΡ Π½Π°ΠΊΠΎΠΏΠ»Π΅Π½ΠΈΡ ΠΎΡΠΈΠ±ΠΊΠΈ. Π§ΡΠΎ Π²ΠΈΠ΄Π½ΠΎ Π½Π° ΠΏΡΠΈΠΌΠ΅ΡΠ΅. Π‘ΠΌΠΎΡΡΠΈ ΡΠ°Π±ΠΎΡΡ ΡΠΊΡΠΈΠΏΡΠ°: mpu5060_gyro.pyΒ ΠΈΠ»ΠΈ ΡΠΊΡΠΈΠΏΡΠ°, Π³ΡΠ°ΡΠΈΡΠ΅ΡΠΊΠΈ ΠΎΡΠΎΠ±ΡΠ°ΠΆΠ°ΡΡΠ΅Π³ΠΎ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° pyplay_gyro.py.
ΠΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ
ΠΠ»Ρ ΠΎΠΏΡΠ΅Π΄Π΅Π»Π΅Π½ΠΈΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΡ ΡΠΈΡΡΠ΅ΠΌΡ ΠΌΠΎΠΆΠ½ΠΎ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡ ΡΡΠ΅Ρ ΠΎΡΠ΅Π²ΠΎΠΉ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ. ΠΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΡΠ°ΠΊΠΆΠ΅ ΠΈΠΌΠ΅Π΅Ρ Π½Π°ΡΡΡΠ°ΠΈΠ²Π°Π΅ΠΌΡΠ΅ ΠΏΡΠ΅Π΄Π΅Π»Ρ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ Β±2g, Β±4g, Β±8g Ρ Β±16g. ΠΡΠΈ ΠΏΡΠ΅Π΄Π΅Π»Ρ ΡΡΡΠ°Π½Π°Π²Π»ΠΈΠ²Π°ΡΡΡΡ Π² Π·Π°Π²ΠΈΡΠΈΠΌΠΎΡΡΠΈ ΠΎΡ Π΄ΠΈΠ½Π°ΠΌΠΈΡΠ½ΠΎΡΡΠΈ ΠΠ°ΡΠ΅ΠΉ ΡΠΈΡΡΠ΅ΠΌΡ. ΠΠ°ΠΏΠΎΠΌΠ½Ρ, ΡΡΠΎ Π½Π° Π»ΡΠ±ΠΎΠ΅ ΡΠ΅Π»ΠΎ Π΄Π΅ΠΉΡΡΠ²ΡΠ΅Ρ ΡΠΈΠ»Π° ΠΏΡΠΈΡΡΠΆΠ΅Π½ΠΈΡ. Π ΡΠΎΡΡΠΎΡΠ½ΠΈΠΈ ΠΏΠΎΠΊΠΎΡ g=1. Π ΡΠΎΡΡΠΎΡΠ½ΠΈΠΈ ΡΠ²ΠΎΠ±ΠΎΠ΄Π½ΠΎΠ³ΠΎ ΠΏΠ°Π΄Π΅Π½ΠΈΡ, ΠΊΠΎΠ³Π΄Π° ΡΠ΅Π»ΠΎ Π΄Π²ΠΈΠΆΠ΅ΡΡΡ ΠΊ Π·Π΅ΠΌΠ»Π΅ Ρ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΠ΅ΠΌ 9,81 ΠΌ/Ρ2 β g=0. ΠΡΠΈ ΡΠ°Π·Π½ΡΡ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΡΡ g Π±ΡΠ΄Π΅Ρ ΡΠ°Π·Π½ΡΠΌ. Π§Π΅ΠΌ Π²ΡΡΠ΅ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΠ΅, ΡΠ΅ΠΌ Π±ΠΎΠ»ΡΡΠ΅ g. ΠΠΎΡΡΠΎΠΌΡ Π΅ΡΠ»ΠΈ Ρ ΠΠ°Ρ Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ ΠΌΠ΅Π΄Π»Π΅Π½Π½Π°Ρ, Π·Π°Π΄Π΅ΠΌΠΏΡΠΈΡΠΎΠ²Π°Π½Π½Π°Ρ ΡΠΈΡΡΠ΅ΠΌΠ°, ΠΊΠΎΡΠΎΡΠ°Ρ ΡΠΈΠ·ΠΈΡΠ΅ΡΠΊΠΈ Π½Π΅ ΡΠΏΠΎΡΠΎΠ±Π½Π° Π±ΡΡΡΡΠΎ ΡΡΠΊΠΎΡΡΡΡΡΡ, Π½Π΅ ΡΡΠΎΠΈΡ ΡΡΡΠ°Π½Π°Π²Π»ΠΈΠ²Π°ΡΡ ΠΌΠ°ΠΊΡΠΈΠΌΠ°Π»ΡΠ½ΡΠ΅ ΠΏΡΠ΅Π΄Π΅Π»Ρ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ. ΠΡΠ°Π²ΠΈΠ»ΡΠ½ΠΎ Π²ΡΠ±ΡΠ°Π½Π½ΡΠΉ Π΄ΠΈΠ°ΠΏΠ°Π·ΠΎΠ½ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΠΉ ΡΠΏΡΠΎΡΡΠΈΡ Π² Π±ΡΠ΄ΡΡΠ΅ΠΌ ΡΠΈΠ»ΡΡΡΠ°ΡΠΈΡ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΠΉ Π΄Π°ΡΡΠΈΠΊΠ°.
ΠΠΎΠ³Π΄Π° ΠΌΡ ΠΏΠΎΠ²ΠΎΡΠ°ΡΠΈΠ²Π°Π΅ΠΌ Π΄Π°ΡΡΠΈΠΊ Π² ΠΏΡΠΎΡΡΡΠ°Π½ΡΡΠ²Π΅, ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° Π½Π° ΠΊΠ°ΠΆΠ΄ΠΎΠΉ ΠΈΠ· ΡΡΠ΅Ρ ΠΎΡΠ΅ΠΉ Π±ΡΠ΄Π΅Ρ ΠΈΠ·ΠΌΠ΅Π½ΡΡΡΡΡ Π² Π·Π°Π²ΠΈΡΠΈΠΌΠΎΡΡΠΈ ΠΎΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΡ. Π’Π°ΠΊ, Ρ ΠΏΠΎΠΌΠΎΡΡΡ ΡΡΠ΅Ρ ΠΎΡΠ΅Π²ΠΎΠ³ΠΎ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΏΠΎΠ΄ Π²ΠΎΠ·Π΄Π΅ΠΉΡΡΠ²ΠΈΠ΅ΠΌ ΡΠΈΠ»Ρ ΡΡΠΆΠ΅ΡΡΠΈ ΠΌΠΎΠΆΠ½ΠΎ ΠΎΠΏΡΠ΅Π΄Π΅Π»ΠΈΡΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ ΡΠΈΡΡΠ΅ΠΌΡ. Π‘ΠΌ. ΡΠ°Π±ΠΎΡΡ ΡΠΊΡΠΈΠΏΡΠ° mpu6050_accel_no_filter.py.
ΠΡ Π²ΠΈΠ΄ΠΈΠΌ, ΡΡΠΎ Π·Π½Π°ΡΠ΅Π½ΠΈΡ Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ Π·Π°ΡΡΠΌΠ»Π΅Π½Ρ. ΠΠΎΠΏΡΠΎΠ±ΡΠ΅ΠΌ ΠΈΡ ΡΠΈΠ»ΡΡΡΠΎΠ²Π°ΡΡ. Π― ΠΏΡΠΈΠΌΠ΅Π½ΠΈΠ» ΠΎΡΠ΅Π½Ρ ΡΠΏΡΠΎΡΠ΅Π½Π½ΡΠΉ ΡΠΈΠ»ΡΡΡ ΠΠ°Π»ΠΌΠ°Π½Π°. Π‘ΠΌ. ΡΠ°Π±ΠΎΡΡ ΡΠΊΡΠΈΠΏΡΠ° mpu6050_accel_kf.py. ΠΠΎΠΊΠ°Π·Π°Π½ΠΈΡ ΡΡΠ°Π»ΠΈ Π±ΠΎΠ»Π΅Π΅ ΡΡΠ°Π±ΠΈΠ»ΡΠ½ΡΠΌΠΈ, ΠΎΠ΄Π½Π°ΠΊΠΎ Π² Π½Π°ΡΠ΅ΠΌ ΡΠ»ΡΡΠ°Π΅ ΡΠΈΠ»ΡΡΡ ΠΌΠ°Π»ΠΎΠΏΠΎΠ»Π΅Π·Π΅Π½. ΠΡΠ»ΠΈ Π΄Π°ΡΡΠΈΠΊ ΠΏΠΎΡΡΡΡΡΠΈ, ΠΌΡ ΡΠ²ΠΈΠ΄ΠΈΠΌ, ΡΡΠΎ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ ΡΠ³Π»ΠΎΠ² ΠΈΠ·ΠΌΠ΅Π½ΡΡΡΡΡ ΠΈ ΠΈΠ½ΠΎΠ³Π΄Π° ΠΎΡΠ΅Π½Ρ ΡΠΈΠ»ΡΠ½ΠΎ, Ρ ΠΎΡΡ ΠΌΡ Π΅Π³ΠΎ Π½Π΅ ΠΏΠΎΠ²ΠΎΡΠ°ΡΠΈΠ²Π°Π΅ΠΌ, Π° ΠΏΠ΅ΡΠ΅ΠΌΠ΅ΡΠ°Π΅ΠΌ Ρ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΠ΅ΠΌ Π²Π΄ΠΎΠ»Ρ ΠΎΡΠ΅ΠΉ. ΠΡΠΎ Π»ΠΎΠ³ΠΈΡΠ½ΠΎ, ΠΏΠΎΡΠΊΠΎΠ»ΡΠΊΡ Π½Π° Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΡΠ΅ΠΏΠ΅ΡΡ ΠΊΡΠΎΠΌΠ΅ ΡΠΈΠ»Ρ ΡΡΠΆΠ΅ΡΡΠΈ Π΄Π΅ΠΉΡΡΠ²ΡΠ΅Ρ Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡΠ΅Π»ΡΠ½Π°Ρ ΡΠΈΠ»Π°, ΠΈ ΡΠ΅Π·ΡΠ»ΡΡΠΈΡΡΡΡΠΈΠΉ Π²Π΅ΠΊΡΠΎΡ ΠΈΠ·ΠΌΠ΅Π½ΡΠ΅Ρ Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠ΅. ΠΠ°Π³Π»ΡΠ΄Π½ΠΎ ΡΡΠΎ Π²ΠΈΠ΄Π½ΠΎ Π½Π° ΠΏΡΠΈΠΌΠ΅ΡΠ΅ ΡΠΊΡΠΈΠΏΡΠ° pyplay_accel.py (Π² ΡΡΠΎΠΌ ΡΠΊΡΠΈΠΏΡΠ΅ ΡΠΈΠ»ΡΡΡΠ°ΡΠΈΡ Π½Π΅ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅ΡΡΡ). ΠΠ΄Π΅ΡΡ ΠΏΡΠΎΡΡΠ°Ρ ΡΠΈΠ»ΡΡΡΠ°ΡΠΈΡ ΡΠΎΠ»ΡΠΊΠΎ ΡΠ°ΡΡΠΈΡΠ½ΠΎ ΡΠ»ΡΡΡΠ°Π΅Ρ ΡΠΈΡΡΠ°ΡΠΈΡ. Π ΡΠ΅ΡΠ΅Π½ΠΈΠΈ ΡΡΠΎΠΉ ΠΏΡΠΎΠ±Π»Π΅ΠΌΡ Π½Π°ΠΌ ΠΏΠΎΠΌΠΎΠΆΠ΅Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ. ΠΠΌΠ΅Π½Π½ΠΎ ΠΎΠ½ ΠΌΠΎΠΆΠ΅Ρ Π½Π°ΠΌ ΡΠΊΠ°Π·Π°ΡΡ, ΡΡΠΎ ΡΠΈΡΡΠ΅ΠΌΠ°-ΡΠΎ Π½Π΅ Π²ΡΠ°ΡΠ°Π»Π°ΡΡ, ΠΈ ΠΏΠΎΡΡΠΎΠΌΡ ΠΌΡ ΠΌΠΎΠΆΠ΅ΠΌ ΡΡΠΈ ΠΊΠΎΠ»Π΅Π±Π°Π½ΠΈΡ ΠΎΡΡΠΈΠ»ΡΡΡΠΎΠ²Π°ΡΡ.
Π‘ΠΎΠ²ΠΌΠ΅ΡΡΠ½ΠΎΠ΅ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°
ΠΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΠ΅ ΠΎΡΠ΄Π΅Π»ΡΠ½ΠΎ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈΠ»ΠΈ ΠΎΡΠ΄Π΅Π»ΡΠ½ΠΎ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° Π½Π΅ Π΄Π°ΡΡ ΠΆΠ΅Π»Π°Π΅ΠΌΠΎΠ³ΠΎ ΡΠ΅Π·ΡΠ»ΡΡΠ°ΡΠ°, ΡΠΎΠ»ΡΠΊΠΎ ΠΈΡ
ΡΠΎΠ²ΠΌΠ΅ΡΡΠ½ΠΎΠ΅ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π½ΠΈΠ΅ Ρ ΠΏΡΠΈΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ΠΌ ΡΠΈΠ»ΡΡΡΠ°ΡΠΈΠΈ Ρ ΡΡΠ΅ΡΠΎΠΌ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΠΉ Π΄Π²ΡΡ
Π΄Π°ΡΡΠΈΠΊΠΎΠ² Π΄Π°Π΅Ρ ΠΏΡΠΈΠ΅ΠΌΠ»Π΅ΠΌΡΠΉ ΡΠ΅Π·ΡΠ»ΡΡΠ°Ρ. Π ΠΏΡΠΈΠΌΠ΅ΡΠ΅ ΡΠ΅Π°Π»ΠΈΠ·ΠΎΠ²Π°Π½ ΠΎΠ΄ΠΈΠ½ ΠΈΠ· ΡΠΏΠΎΡΠΎΠ±ΠΎΠ² ΠΊΠΎΠΌΠΏΠ»Π΅ΠΌΠ΅Π½ΡΠ°ΡΠ½ΠΎΠ³ΠΎ ΡΠΈΠ»ΡΡΡΠ°. ΠΠ½ Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ ΠΏΡΠΎΡΡ ΠΈ ΡΠ°Π±ΠΎΡΠ°Π΅Ρ ΡΠ»Π΅Π΄ΡΡΡΠΈΠΌ ΠΎΠ±ΡΠ°Π·ΠΎΠΌ.
ΠΠ° ΠΏΠ΅ΡΠ²ΠΎΠ½Π°ΡΠ°Π»ΡΠ½ΠΎΠ΅ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ ΠΏΡΠΈΠ½ΠΈΠΌΠ°Π΅ΡΡΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅, Π²ΡΡΠΈΡΠ»Π΅Π½Π½ΠΎΠ΅ Π½Π° ΠΎΡΠ½ΠΎΠ²Π°Π½ΠΈΠΈ Π΄Π°Π½Π½ΡΡ
Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. ΠΠ°ΡΠ΅ΠΌ Ρ Π·Π°Π΄Π°Π½Π½ΡΠΌ ΠΈΠ½ΡΠ΅ΡΠ²Π°Π»ΠΎΠΌ Π²ΡΡΠΈΡΠ»ΡΡΡΡΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ Π½Π° ΠΎΡΠ½ΠΎΠ²Π΅ Π΄Π°Π½Π½ΡΡ
Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ Π½Π° ΠΎΡΠ½ΠΎΠ²Π΅ Π΄Π°Π½Π½ΡΡ
Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. ΠΠ°ΡΠ΅ΠΌ Π²ΡΡΠΈΡΠ»Π΅Π½Π½ΡΠ΅ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ ΡΠ²ΠΎΠ΄ΡΡΡΡ Π² ΠΎΠ±ΡΠΈΠΉ ΡΠΈΠ½Π°Π»ΡΠ½ΡΠΉ ΡΠ΅Π·ΡΠ»ΡΡΠ°Ρ. ΠΡΠΈ ΡΡΠΎΠΌ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΊΠΎΡΡΠ΅ΠΊΡΠΈΡΡΠ΅Ρ βΠ΄ΡΠ΅ΠΉΡβ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°, Π° Π³ΠΈΡΠΎΡΠΊΠΎΠΏ ΡΠ³Π»Π°ΠΆΠΈΠ²Π°Π΅Ρ ΡΠΊΠ°ΡΠΊΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΏΡΠΈ Π²ΠΈΠ±ΡΠ°ΡΠΈΡΡ
ΠΈ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΡΡ
. ΠΠ°ΡΠ΅ΠΌΠ°ΡΠΈΡΠ΅ΡΠΊΠΈ ΡΡΠΎ ΠΏΡΠ΅Π΄ΡΡΠ°Π²Π»ΡΠ΅ΡΡΡ ΡΠ»Π΅Π΄ΡΡΡΠ΅ΠΉ ΡΠΎΡΠΌΡΠ»ΠΎΠΉ.
Π‘ΠΌ. ΡΠ°Π±ΠΎΡΡ ΡΠΊΡΠΈΠΏΡΠ° mpu6050_final.py ΠΈΠ»ΠΈ ΡΠΊΡΠΈΠΏΡΠ° pyplay_final.py, ΠΊΠΎΡΠΎΡΡΠΉ Π³ΡΠ°ΡΠΈΡΠ΅ΡΠΊΠΈ ΠΈΠ·ΠΎΠ±ΡΠ°ΠΆΠ°Π΅Ρ ΠΏΡΠΎΡΠ΅ΡΡ ΡΠ°Π±ΠΎΡΡ MPU-6050
MotionApps
ΠΡΠ»ΠΈ ΠΠ°ΠΌ Π½Π΅ Ρ ΠΎΡΠ΅ΡΡΡ ΡΡΠ»ΠΎΠΆΠ½ΡΡΡ ΡΠ΅Π±Π΅ ΠΆΠΈΠ·Π½Ρ Ρ ΡΠ΅Π°Π»ΠΈΠ·Π°ΡΠΈΠ΅ΠΉ ΡΠΎΠ±ΡΡΠ²Π΅Π½Π½ΠΎΠ³ΠΎ ΡΠΈΠ»ΡΡΡΠ°, ΠΈΠ»ΠΈ Π²ΡΡΠΈΡΠ»ΠΈΡΠ΅Π»ΡΠ½ΡΡ ΠΌΠΎΡΠ½ΠΎΡΡΠ΅ΠΉ Π½Π΅ Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ Π΄Π»Ρ Π΅Π³ΠΎ ΡΠ°Π±ΠΎΡΡ, ΠΌΠΎΠΆΠ½ΠΎ ΠΏΠΎΠΉΡΠΈ Π΄ΡΡΠ³ΠΈΠΌ ΠΏΡΡΠ΅ΠΌ. ΠΡΠΈΠΌΠ΅Π½ΠΈΡΠ΅Π»ΡΠ½ΠΎ ΠΊ ΡΡΠΎΠΌΡ Π΄Π°ΡΡΠΈΠΊΡ ΡΡΡΠ΅ΡΡΠ²ΡΠ΅Ρ ΠΏΠΎΠ½ΡΡΠΈΠ΅ MotionApps. ΠΡΠΎ Π½Π΅ΠΊΠΈΠΉ Π±ΠΈΠ½Π°ΡΠ½ΡΠΉ ΠΊΠΎΠ΄, ΠΊΠΎΡΠΎΡΡΠΉ Π·Π°ΠΏΠΈΡΡΠ²Π°Π΅ΡΡΡ Π² ΠΏΠ°ΠΌΡΡΡ Π΄Π°ΡΡΠΈΠΊΠ°. ΠΠΎΠ΄ Π·Π°ΠΏΠΈΡΡΠ²Π°Π΅ΡΡΡ Π² ΡΠ½Π΅ΡΠ³ΠΎΠ·Π°Π²ΠΈΡΠΈΠΌΡΡ ΠΏΠ°ΠΌΡΡΡ, ΠΏΠΎΡΡΠΎΠΌΡ Π΅Π³ΠΎ Π½ΡΠΆΠ½ΠΎ Π·Π°ΠΏΠΈΡΡΠ²Π°ΡΡ ΠΊΠ°ΠΆΠ΄ΡΠΉ ΡΠ°Π· ΠΏΠΎΡΠ»Π΅ ΠΏΠΎΠ΄Π°ΡΠΈ ΠΏΠΈΡΠ°Π½ΠΈΡ. ΠΡΠΎ Π·Π°Π½ΠΈΠΌΠ°Π΅Ρ ΠΎΠΊΠΎΠ»ΠΎ ΡΠ΅ΠΊΡΠ½Π΄Ρ. ΠΠΎΠ΄ ΡΠΎΠ±ΠΈΡΠ°Π΅Ρ ΠΈ ΡΠΈΠ»ΡΡΡΡΠ΅Ρ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡ ΡΠΎ Π²ΡΠ΅Ρ ΠΎΡΠ΅ΠΉ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° ΠΈ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°. ΠΠ°Π½Π½ΡΠ΅ ΡΠΊΠ»Π°Π΄ΡΠ²Π°ΡΡΡΡ Π² Π±ΡΡΠ΅Ρ FIFO. Π‘ΠΎΠ±ΡΡΠ²Π΅Π½Π½ΠΎ, ΠΠ°ΠΌ ΠΎΡΡΠ°Π΅ΡΡΡ Π΄ΠΎΠΆΠ΄Π°ΡΡΡΡ Π³ΠΎΡΠΎΠ²Π½ΠΎΡΡΠΈ Π΄Π°Π½Π½ΡΡ ΠΈ ΡΡΠΈΡΠ°ΡΡ Π±ΡΡΠ΅Ρ ΡΠΎ Π²ΡΠ΅ΠΌΠΈ ΠΏΠΎΠΊΠ°Π·Π°Π½ΠΈΡΠΌΠΈ. ΠΡΠΈΠΌΠ΅Ρ Π½Π° ΠΠΈΡΠΎΠ½Π΅, ΠΊΠΎΡΠΎΡΡΠΉ Ρ Π½Π°ΡΠ΅Π» Π½Π° GiHub: https://github.com/cTn-dev/PyComms/tree/master/MPU6050
ΠΡΠΎ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅Ρ Arduino, ΡΠΎΠΆΠ΅ Π±Π΅Π· ΡΡΡΠ΄Π° Π½Π°ΠΉΠ΄ΡΡ Π² ΠΈΠ½ΡΠ΅ΡΠ½Π΅ΡΠ΅ Π°Π½Π°Π»ΠΎΠ³ΠΈΡΠ½ΡΠ΅ ΠΏΡΠΈΠΌΠ΅ΡΡ.
Π ΠΎΡΠΎΠ±Π΅Π½Π½ΠΎΡΡΠΈ ΡΠ°Π±ΠΎΡΡ MotionApps Ρ Π½Π΅ Π²Π½ΠΈΠΊΠ°Π». ΠΡΠΌΠ°Ρ, ΡΡΠΎ ΡΠ΅ΠΌΠ° Π΄Π»Ρ ΠΎΡΠ΄Π΅Π»ΡΠ½ΠΎΠΉ ΡΡΠ°ΡΡΠΈ. ΠΠ΅Π½Ρ Π±ΠΎΠ»ΡΡΠ΅ ΠΈΠ½ΡΠ΅ΡΠ΅ΡΠΎΠ²Π°Π»Π° ΡΠΎΠ±ΡΡΠ²Π΅Π½Π½Π°Ρ ΡΠ΅Π°Π»ΠΈΠ·Π°ΡΠΈΡ Π½Π° Python.
ΠΠΈΠ·ΡΠ°Π»ΠΈΠ·Π°ΡΠΈΡ
ΠΠ»Ρ Π½Π°Π³Π»ΡΠ΄Π½ΠΎΡΡΠΈ Ρ ΠΏΡΠΈΠ²Π΅Π» Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΎ ΠΏΡΠΎΡΡΡΡ ΠΏΡΠΈΠΌΠ΅ΡΠΎΠ² Π΄Π»Ρ Π³ΡΠ°ΡΠΈΡΠ΅ΡΠΊΠΎΠ³ΠΎ ΠΎΡΠΎΠ±ΡΠ°ΠΆΠ΅Π½ΠΈΡ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΡ ΡΠΈΡΡΠ΅ΠΌΡ. Π ΡΡΠΈΡ ΠΏΡΠΈΠΌΠ΅ΡΠ°Ρ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅ΡΡΡ pygame. ΠΠ°ΠΏΡΡΠΊ ΡΡΠΈΡ ΡΠΊΡΠΈΠΏΡΠΎΠ² ΡΠ΅ΠΊΠΎΠΌΠ΅Π½Π΄ΡΠ΅ΡΡΡ Π²ΡΠΏΠΎΠ»Π½ΡΡΡ ΠΈΠ· Π³ΡΠ°ΡΠΈΡΠ΅ΡΠΊΠΎΠΉ ΠΎΠ±ΠΎΠ»ΠΎΡΠΊΠΈ.
Π£ΡΠΏΠ΅Ρ ΠΎΠ².
Π‘ΠΌΠΎΡΡΠΈ ΡΠ°ΠΊΠΆΠ΅:www.avislab.com
ΠΏΠΎΡΡΠ°ΠΏΠ½Π°Ρ ΡΠ±ΠΎΡΠΊΠ° ΠΈ Π½Π°ΡΡΡΠΎΠΉΠΊΠ° ΡΠ²ΠΎΠΈΠΌΠΈ ΡΡΠΊΠ°ΠΌΠΈ
ΠΠ΄ΡΠ°Π²ΡΡΠ²ΡΠΉΡΠ΅, Π½Π°ΡΠΈ ΡΠ²Π°ΠΆΠ°Π΅ΠΌΡΠ΅ ΡΠΈΡΠ°ΡΠ΅Π»ΠΈ. Π ΡΡΠΎΠΉ ΡΡΠ°ΡΡΠ΅ ΠΌΡ ΠΏΠΎΠ³ΠΎΠ²ΠΎΡΠΈΠΌ ΠΏΡΠΎ ΡΠΎ, ΠΊΠ°ΠΊ ΡΠΎΠ±ΡΠ°ΡΡ ΠΊΠ²Π°Π΄ΡΠΎΠΊΠΎΠΏΡΠ΅Ρ Π½Π° ΠΡΠ΄ΡΠΈΠ½ΠΎ. ΠΡΠΎ Π½Π΅ ΡΠ°ΠΌΠ°Ρ ΠΏΡΠΎΡΡΠ°Ρ, Ρ ΠΎΡΡ ΠΈ ΠΎΡΠ΅Π½Ρ ΡΠ²Π»Π΅ΠΊΠ°ΡΠ΅Π»ΡΠ½Π°Ρ Π·Π°Π΄Π°ΡΠ°, ΡΠ΅Π·ΡΠ»ΡΡΠ°ΡΠΎΠΌ ΡΠ΅ΡΠ΅Π½ΠΈΡ ΠΊΠΎΡΠΎΡΠΎΠΉ ΡΡΠ°Π½Π΅Ρ ΠΏΠΎΡΠ²Π»Π΅Π½ΠΈΠ΅ Π½Π΅Π±ΠΎΠ»ΡΡΠΎΠ³ΠΎ Π±Π΅ΡΠΏΠΈΠ»ΠΎΡΠ½ΠΈΠΊΠ°, ΡΠΏΡΠΎΠ΅ΠΊΡΠΈΡΠΎΠ²Π°Π½Π½ΠΎΠ³ΠΎ, ΡΠΎΠ±ΡΠ°Π½Π½ΠΎΠ³ΠΎ, ΠΈ Π½Π°ΡΡΡΠΎΠ΅Π½Π½ΠΎΠ³ΠΎ ΡΠΎΠ±ΡΡΠ²Π΅Π½Π½ΡΠΌΠΈ ΡΡΠΊΠ°ΠΌΠΈ. Π‘ΡΠ°Π·Ρ ΠΎΠ³ΠΎΠ²ΠΎΡΠΈΠΌΡΡ, ΡΡΠΎ ΡΠ΅ΡΡ ΠΈΠ΄Π΅Ρ ΠΎ ΠΌΠ°ΠΊΡΠΈΠΌΠ°Π»ΡΠ½ΠΎ Π΄Π΅ΡΠ΅Π²ΠΎΠΌ Π΄ΡΠΎΠ½Π΅ ΠΈΠ· Π½Π°ΠΈΠ±ΠΎΠ»Π΅Π΅ Π΄ΠΎΡΡΡΠΏΠ½ΡΡ ΠΏΠΎ ΡΠ΅Π½Π΅ ΠΊΠΎΠΌΠΏΠ»Π΅ΠΊΡΡΡΡΠΈΡ .
ΠΠ΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΡΠ΅ Π΄Π΅ΡΠ°Π»ΠΈ ΠΈ ΡΠ·Π»Ρ
ΠΡΠ΅ΠΆΠ΄Π΅ ΡΠ΅ΠΌ ΠΏΡΠΈΡΡΡΠΏΠΈΡΡ ΠΊ ΡΠ±ΠΎΡΠΊΠ΅ ΠΊΠ²Π°Π΄ΡΠΎΠΊΠΎΠΏΡΠ΅ΡΠ° ΡΠ²ΠΎΠΈΠΌΠΈ ΡΡΠΊΠ°ΠΌΠΈ, Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΠΎΠ±Π·Π°Π²Π΅ΡΡΠΈΡΡ Π²ΡΠ΅ΠΌΠΈ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΡΠΌΠΈ Π΄Π΅ΡΠ°Π»ΡΠΌΠΈ. ΠΠΎΠ·Π³ΠΎΠΌ Π½Π°ΡΠ΅ΠΉ ΡΠ°ΠΌΠΎΠ΄Π΅Π»ΠΊΠΈ ΡΡΠ°Π½Π΅Ρ ΠΏΠΎΠ»Π΅ΡΠ½ΡΠΉ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅Ρ Arduino Uno. ΠΠ³ΠΎ Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎΡΡΠ΅ΠΉ Π±ΠΎΠ»Π΅Π΅ ΡΠ΅ΠΌ Π΄ΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ Π΄Π»Ρ ΡΠΎΠ³ΠΎ, ΡΡΠΎΠ±Ρ ΡΠΏΡΠ°Π²Π»ΡΡΡ Π±Π΅ΡΠΏΠΈΠ»ΠΎΡΠ½ΠΈΠΊΠΎΠΌ.
ΠΠΎΠΌΠΈΠΌΠΎ ΠΌΠΈΠΊΡΠΎΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΠ°, Π½Π°ΠΌ ΠΏΠΎΠ½Π°Π΄ΠΎΠ±ΡΡΡΡ:
- ΠΠΊΠΊΡΠΌΡΠ»ΡΡΠΎΡ (Π»ΡΡΡΠ΅ Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΎ) Π½Π° 3.7Π
- ΠΠ»Π°ΡΠ° MPU-6050 (Π½Π° Π½Π΅ΠΉ ΡΡΡΠ°Π½ΠΎΠ²Π»Π΅Π½Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ)
- Π’ΡΠ°Π½Π·ΠΈΡΡΠΎΡ ULN2003A
- ΠΠΎΠ»Π»Π΅ΠΊΡΠΎΡΠ½ΡΠ΅ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»ΠΈ Ρ ΠΏΠΎΠ»ΡΠΌ ΡΠΎΡΠΎΡΠΎΠΌ 0820
- ΠΡΠΎΠ²ΠΎΠ΄Π°
ΠΠ΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΡΠ΄Π΅Π»Π°ΡΡ Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΎ Π·Π°ΠΌΠ΅ΡΠ°Π½ΠΈΠΉ. Π’Π°ΠΊ ΠΊΠ°ΠΊ ΠΌΡ ΡΠΎΠ±ΠΈΡΠ°Π΅ΠΌ Π΄Π΅ΡΠ΅Π²ΡΠΉ ΡΠ°ΠΌΠΎΠ΄Π΅Π»ΡΠ½ΡΠΉ Π΄ΡΠΎΠ½, ΡΠΎ Π½Π°Ρ Π²ΡΠ±ΠΎΡ ΠΏΠ°Π» Π½Π° ΠΊΠΎΠ»Π»Π΅ΠΊΡΠΎΡΠ½ΡΠ΅ Π΄Π²ΠΈΠΆΠΊΠΈ Ρ ΠΏΠΎΠ»ΡΠΌ ΡΠΎΡΠΎΡΠΎΠΌ (ΡΠ°ΠΊ Π½Π°Π·ΡΠ²Π°Π΅ΠΌΡΠ΅ coreless motors). ΠΠ½ΠΈ Π΄Π°Π»Π΅ΠΊΠΎ Π½Π΅ ΡΠ°ΠΊ Π½Π°Π΄Π΅ΠΆΠ½Ρ, ΠΊΠ°ΠΊ Π±Π΅ΡΠΊΠΎΠ»Π»Π΅ΠΊΡΠΎΡΠ½ΡΠ΅ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»ΠΈ, Π½ΠΎ Π·Π°ΡΠΎ Π³ΠΎΡΠ°Π·Π΄ΠΎ Π΄Π΅ΡΠ΅Π²Π»Π΅ ΡΡΠΎΡΡ. ΠΡΠΎΠΌΠ΅ ΡΠΎΠ³ΠΎ, ΠΌΠΎΠΆΠ½ΠΎ ΠΎΠ±ΠΎΠΉΡΠΈΡΡ Π±Π΅Π· Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡΠ΅Π»ΡΠ½ΡΡ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΠΎΠ² ΡΠΊΠΎΡΠΎΡΡΠΈ.
ΠΠ°ΡΠΎ Π½Π΅Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎ ΠΎΠ±ΠΎΠΉΡΠΈΡΡ Π±Π΅Π· Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. ΠΠΈΡΠΎΡΠΊΠΎΠΏ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌ Π΄Π»Ρ ΡΠΎΠ³ΠΎ, ΡΡΠΎΠ±Ρ ΠΊΠ²Π°Π΄ΡΠΎΠΊΠΎΠΏΡΠ΅Ρ ΠΌΠΎΠ³ ΡΠ΄Π΅ΡΠΆΠΈΠ²Π°ΡΡ Π·Π°Π΄Π°Π½Π½ΠΎΠ΅ Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠ΅ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΡ, ΡΠΎΠ³Π΄Π° ΠΊΠ°ΠΊ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅ΡΡΡ Π΄Π»Ρ ΠΈΠ·ΠΌΠ΅ΡΠ΅Π½ΠΈΡ ΡΡΠΊΠΎΡΠ΅Π½ΠΈΡ. ΠΠ΅Π· ΡΡΠΈΡ ΡΡΡΡΠΎΠΉΡΡΠ² ΡΠΏΡΠ°Π²Π»ΡΡΡ ΠΊΠΎΠΏΡΠ΅ΡΠΎΠΌ Π±ΡΠ»ΠΎ Π±Ρ Π³ΠΎΡΠ°Π·Π΄ΠΎ ΡΠ»ΠΎΠΆΠ½Π΅Π΅ (Π΅ΡΠ»ΠΈ Π²ΠΎΠΎΠ±ΡΠ΅ Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎ), ΡΠ°ΠΊ ΠΊΠ°ΠΊ ΠΈΠΌΠ΅Π½Π½ΠΎ ΠΎΠ½ΠΈ ΠΏΡΠ΅Π΄ΠΎΡΡΠ°Π²Π»ΡΡΡ Π΄Π°Π½Π½ΡΠ΅ Π΄Π»Ρ ΡΠΈΠ³Π½Π°Π»Π°, ΡΠ΅Π³ΡΠ»ΠΈΡΡΡΡΠ΅Π³ΠΎ ΡΠΊΠΎΡΠΎΡΡΡ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ Π²ΠΈΠ½ΡΠΎΠ².
ΠΡ Π½Π΅ ΡΠΊΠ°Π·Π°Π»ΠΈ Π² ΡΠΏΠΈΡΠΊΠ΅ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΡΡ Π΄Π΅ΡΠ°Π»Π΅ΠΉ ΡΠ°ΠΌΡ. ΠΠ΅ ΠΌΠΎΠΆΠ½ΠΎ ΠΏΡΠΈΠΎΠ±ΡΠ΅ΡΡΠΈ, Π° ΠΌΠΎΠΆΠ½ΠΎ ΡΠ°ΡΠΏΠ΅ΡΠ°ΡΠ°ΡΡ Π½Π° 3D ΠΏΡΠΈΠ½ΡΠ΅ΡΠ΅ ΠΊΠ°ΡΠΊΠ°Ρ, Π»ΡΡΠΈ ΠΈ ΠΊΡΠ΅ΠΏΠ»Π΅Π½ΠΈΡ Π΄Π»Ρ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»Π΅ΠΉ. ΠΡΠΎΡΠΎΠΉ Π²Π°ΡΠΈΠ°Π½Ρ Π½Π°ΠΌ ΠΊΠ°ΠΆΠ΅ΡΡΡ Π±ΠΎΠ»Π΅Π΅ ΠΏΡΠ΅Π΄ΠΏΠΎΡΡΠΈΡΠ΅Π»ΡΠ½ΡΠΌ, ΡΠ΅ΠΌ Π±ΠΎΠ»Π΅Π΅, ΡΡΠΎ Π² ΠΈΠ½ΡΠ΅ΡΠ½Π΅ΡΠ΅ ΠΌΠΎΠΆΠ½ΠΎ Π±Π΅Π· ΡΡΡΠ΄Π° Π½Π°ΠΉΡΠΈ ΠΏΡΠΎΠ΅ΠΊΡΡ ΠΊΠ²Π°Π΄ΡΠΎΠΊΠΎΠΏΡΠ΅ΡΠ°.
Π Π°ΡΠΏΠ΅ΡΠ°ΡΠ°Π½Π½Π°Ρ Π½Π° ΠΏΡΠΈΠ½ΡΠ΅ΡΠ΅ ΡΠ°ΠΌΠ° ΠΎΠΊΠ°ΠΆΠ΅ΡΡΡ Π½Π΅ ΡΠΎΠ»ΡΠΊΠΎ Π»Π΅Π³ΠΊΠΎΠΉ, Π½ΠΎ ΠΈ ΠΏΡΠΎΡΠ½ΠΎΠΉ. ΠΠΎ Π΅ΡΠ»ΠΈ Π΄ΠΎΡΡΡΠΏΠ° ΠΊ 3D ΠΏΡΠΈΠ½ΡΠ΅ΡΡ Π½Π΅Ρ, ΡΠ°ΠΌΡ ΠΌΠΎΠΆΠ½ΠΎ Π·Π°ΠΊΠ°Π·Π°ΡΡ.
ΠΠΎΡΠ°Π³ΠΎΠ²Π°Ρ ΠΈΠ½ΡΡΡΡΠΊΡΠΈΡ ΠΏΠΎ ΡΠ±ΠΎΡΠΊΠ΅
ΠΠ°ΠΊ Π½Π°ΠΏΠ΅ΡΠ°ΡΠ°ΡΡ ΡΠ°ΠΌΡ ΠΈ ΠΊΡΠ΅ΠΏΠ΅ΠΆ
3D ΠΏΡΠΈΠ½ΡΠ΅ΡΡ ΠΌΠΎΠΆΠ½ΠΎ Π½Π°ΠΉΡΠΈ Π²ΠΎ ΠΌΠ½ΠΎΠ³ΠΈΡ ΡΠ½ΠΈΠ²Π΅ΡΡΠΈΡΠ΅ΡΠ°Ρ , Π»Π°Π±ΠΎΡΠ°ΡΠΎΡΠΈΡΡ , ΠΊΠΎΠ²ΠΎΡΠΊΠΈΠ½Π³Π°Ρ . ΠΠ°ΡΠ°ΡΡΡΡ Π΄ΠΎΡΡΡΠΏ ΠΊ Π½ΠΈΠΌ Π±Π΅ΡΠΏΠ»Π°ΡΠ½ΡΠΉ. ΠΠΎΠ΄Π΅Π»ΠΈ Π΄Π»Ρ ΠΏΠ΅ΡΠ°ΡΠΈ ΠΌΠΎΠΆΠ½ΠΎ ΡΠΎΠ·Π΄Π°ΡΡ ΡΠ°ΠΌΠΎΡΡΠΎΡΡΠ΅Π»ΡΠ½ΠΎ, ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΡ Π΄Π»Ρ ΡΡΠΎΠ³ΠΎ, Π½Π°ΠΏΡΠΈΠΌΠ΅Ρ, Solidworks. Π ΠΌΠΎΠΆΠ½ΠΎ Π²ΠΎΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡΡΡ ΡΠΆΠ΅ Π³ΠΎΡΠΎΠ²ΡΠΌΠΈ ΡΠ΅ΡΠ΅Π½ΠΈΡΠΌΠΈ, ΠΏΡΠΈ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎΡΡΠΈ ΠΈΠ·ΠΌΠ΅Π½ΠΈΠ² ΠΏΠ°ΡΠ°ΠΌΠ΅ΡΡΡ.
ΠΠ°ΠΊ Π½Π°ΡΡΡΠΎΠΈΡΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°
ΠΠ»Ρ Π½Π°ΡΡΡΠΎΠΉΠΊΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°-Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° (I2C)ΠΌΡ ΡΠ΅ΠΊΠΎΠΌΠ΅Π½Π΄ΡΠ΅ΠΌ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡ ΡΠ»Π΅Π΄ΡΡΡΡΡ Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΡ. ΠΠΈ Π² ΠΊΠΎΠ΅ΠΌ ΡΠ»ΡΡΠ°Π΅ Π½Π΅ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ°ΠΉΡΠ΅ ΠΏΠ»Π°ΡΡ ΠΊ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΡ 5Π, ΠΈΠ½Π°ΡΠ΅ Π²Ρ ΠΌΠΎΠΌΠ΅Π½ΡΠ°Π»ΡΠ½ΠΎ Π΅Π΅ ΠΈΡΠΏΠΎΡΡΠΈΡΠ΅.
ΠΠΊΡΠ°ΡΡΠ΅ ΡΠ°ΡΡΠΊΠ°ΠΆΠ΅ΠΌ, ΡΠ΅ΠΌ ΠΈΠ½ΡΠ΅ΡΠ΅ΡΠ½Π° ΠΏΠ»Π°ΡΠ° I2C Ρ Π΄Π°ΡΡΠΈΠΊΠ°ΠΌΠΈ. ΠΠ½Π° Π·Π°ΠΌΠ΅ΡΠ½ΠΎ ΠΎΡΠ»ΠΈΡΠ°Π΅ΡΡΡ ΠΎΡ ΠΎΠ±ΡΡΠ½ΠΎΠΉ ΠΏΠ»Π°ΡΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ° Ρ ΡΡΠ΅ΠΌΡ Π°Π½Π°Π»ΠΎΠ³ΠΎΠ²ΡΠΌΠΈ Π²ΡΡ ΠΎΠ΄Π°ΠΌΠΈ Π΄Π»Ρ ΠΎΡΠ΅ΠΉ X, Y, Z. I2C ΠΏΡΠ΅Π΄ΡΡΠ°Π²Π»ΡΠ΅Ρ ΡΠΎΠ±ΠΎΠΉ ΠΈΠ½ΡΠ΅ΡΡΠ΅ΠΉΡΠ½ΡΡ ΡΠΈΠ½Ρ, ΠΎΠ±Π΅ΡΠΏΠ΅ΡΠΈΠ²Π°ΡΡΡΡ ΠΏΠ΅ΡΠ΅Π΄Π°ΡΡ Π·Π½Π°ΡΠΈΡΠ΅Π»ΡΠ½ΡΡ ΠΎΠ±ΡΠ΅ΠΌΠΎΠ² Π΄Π°Π½Π½ΡΡ ΡΠ΅ΡΠ΅Π· Π»ΠΎΠ³ΠΈΡΠ΅ΡΠΊΠΈΠ΅ ΡΠΈΡΡΠΎΠ²ΡΠ΅ ΠΈΠΌΠΏΡΠ»ΡΡΡ.
ΠΠ½Π°Π»ΠΎΠ³ΠΎΠ²ΡΡ Π²ΡΡ ΠΎΠ΄ΠΎΠ² Π½Π° ΠΏΠ»Π°ΡΠ΅ Π½Π΅ ΠΌΠ½ΠΎΠ³ΠΎ, ΠΈ Π² ΡΡΠΎΠΌ Π±ΠΎΠ»ΡΡΠΎΠΉ ΠΏΠ»ΡΡ I2C, Π²Π΅Π΄Ρ Π² ΠΏΡΠΎΡΠΈΠ²Π½ΠΎΠΌ ΡΠ»ΡΡΠ°Π΅ Π½Π°ΠΌ Π±Ρ ΠΏΡΠΈΡΠ»ΠΎΡΡ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡ Π²ΡΠ΅ ΠΏΠΎΡΡΡ Π½Π° Arduino, ΡΡΠΎΠ±Ρ ΠΏΠΎΠ»ΡΡΠΈΡΡ Π΄Π°Π½Π½ΡΠ΅ ΠΎΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°.
Π‘Ρ Π΅ΠΌΠ° ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΡ ΠΊ Arduino
ΠΡΠ΅ΠΆΠ΄Π΅ ΡΠ΅ΠΌ ΠΏΠ»Π°ΡΠ° I2C ΡΠΌΠΎΠΆΠ΅Ρ ΠΎΠ±ΠΌΠ΅Π½ΠΈΠ²Π°ΡΡΡΡ Π΄Π°Π½Π½ΡΠΌΠΈ Ρ Arduino, Π΅Π΅ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠΈΡΡ ΠΊ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΡ.
Π‘Ρ
Π΅ΠΌΠ° ΡΠ»Π΅Π΄ΡΡΡΠ°Ρ:
- VDD -3.3v
- GNDΒ β GND
- INT- digital 2
- SCLΒ β A5
- SDAΒ β A4
- VIO β GND
ΠΡΠ΅ ΡΠ°Π· ΠΎΠ±ΡΠ°ΡΠ°Π΅ΠΌ Π²Π½ΠΈΠΌΠ°Π½ΠΈΠ΅ Π½Π° ΡΠΎ, ΡΡΠΎ Π΄Π»Ρ ΠΏΠΈΡΠ°Π½ΠΈΡ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΠΈΠΌΠ΅Π½Π½ΠΎ 3.3Π. ΠΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ ΠΏΠ»Π°ΡΡ ΠΊ 5Π ΡΠΊΠΎΡΠ΅Π΅ Π²ΡΠ΅Π³ΠΎ ΠΏΡΠΈΠ²Π΅Π΄Π΅Ρ ΠΊ Π΅Π΅ ΠΏΠΎΠ»ΠΎΠΌΠΊΠ΅ (ΡΠΏΠ°ΡΡΠΈ ΠΌΠΎΠΆΠ΅Ρ ΡΠΎΠ»ΡΠΊΠΎ ΡΠ΅Π³ΡΠ»ΡΡΠΎΡ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΡ, Π½ΠΎ ΠΎΠ½ Π΄Π°Π»Π΅ΠΊΠΎ Π½Π΅ Π²ΡΠ΅Π³Π΄Π° ΠΏΡΠΈΡΡΡΡΡΠ²ΡΠ΅Ρ Π½Π° ΠΏΠ»Π°ΡΠ΅).
ΠΡΠ»ΠΈ Π½Π° ΠΏΠ»Π°ΡΠ΅ ΠΏΡΠΈΡΡΡΡΡΠ²ΡΠ΅Ρ ΠΊΠΎΠ½ΡΠ°ΠΊΡ AD0, ΠΎΠ½ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ°Π΅ΡΡΡ ΠΊ Π·Π΅ΠΌΠ»Π΅ (GND).
Π Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΠ΅, Π½Π° ΠΊΠΎΡΠΎΡΡΡ ΠΌΡ Π΄Π°Π»ΠΈ ΡΡΡΠ»ΠΊΡ Π²ΡΡΠ΅, ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΡΡΡΡ ΠΏΠ΅ΡΠ΅ΡΠΈΡΠ»Π΅Π½Π½ΡΠ΅ ΠΊΠ°Π½Π°Π»Ρ.
Π‘ΠΊΠ΅ΡΡ Π΄Π»Ρ Arduino
ΠΡΠ΅ΠΈΠΌΡΡΠ΅ΡΡΠ²ΠΎΠΌ Π²ΡΠ±ΡΠ°Π½Π½ΠΎΠ³ΠΎ Π΄Π»Ρ ΡΠ±ΠΎΡΠΊΠΈ Π΄ΡΠΎΠ½Π° ΠΌΠΈΠΊΡΠΎΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΠ° ΡΠ²Π»ΡΠ΅ΡΡΡ ΠΎΡΠ½ΠΎΡΠΈΡΠ΅Π»ΡΠ½Π°Ρ ΠΏΡΠΎΡΡΠΎΡΠ° ΡΠ°Π±ΠΎΡΡ Ρ Π½ΠΈΠΌ. ΠΠ°ΠΌ Π½Π΅ ΠΏΡΠΈΠ΄Π΅ΡΡΡ ΡΠΈΡΠ°ΡΡ ΡΠΏΠ΅ΡΠΈΠ°Π»ΡΠ½ΡΠ΅ ΠΊΠ½ΠΈΠ³ΠΈ, Π΄ΠΎΠΊΡΠΌΠ΅Π½ΡΡ ΠΈ ΡΠ΅Ρ Π½ΠΈΡΠ΅ΡΠΊΡΡ Π΄ΠΎΠΊΡΠΌΠ΅Π½ΡΠ°ΡΠΈΡ. ΠΠΎΡΡΠ°ΡΠΎΡΠ½ΠΎ Π·Π½Π°ΡΡ ΠΎΡΠ½ΠΎΠ²Ρ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΠΈΡΠΎΠ²Π°Π½ΠΈΡ Arduino, ΠΊΠΎΡΠΎΡΡΠ΅, ΠΊΠ°ΠΊ Π²Ρ ΡΠ΅ΠΉΡΠ°Ρ ΡΠ±Π΅Π΄ΠΈΡΠ΅ΡΡ, Π½Π΅ ΡΠ°ΠΊ ΡΠ»ΠΎΠΆΠ½Ρ.
ΠΠΎΠ΄ΡΠΎΠ΅Π΄ΠΈΠ½ΠΈΠ² ΠΏΠ»Π°ΡΡ MPU-6050 ΠΊ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΡ, Π²ΠΊΠ»ΡΡΠΈΡΠ΅ Π΅Π³ΠΎ ΠΈ ΠΏΠ΅ΡΠ΅ΠΉΠ΄ΠΈΡΠ΅ ΠΏΠΎ ΡΡΡΠ»ΠΊΠ΅.
ΠΠ°Ρ ΠΈΠ½ΡΠ΅ΡΠ΅ΡΡΠ΅Ρ ΡΠΊΠ΅ΡΡ I2C scanner code, Π²Π΅ΡΠ½Π΅Π΅, Π΅Π³ΠΎ ΠΊΠΎΠ΄.
Π‘ΠΊΠΎΠΏΠΈΡΡΠΉΡΠ΅ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΠ½ΡΠΉ ΠΊΠΎΠ΄, Π²ΡΡΠ°Π²ΡΡΠ΅ Π² ΠΏΡΡΡΠΎΠΉ ΡΠΊΠ΅ΡΡ, ΠΏΠΎΡΠ»Π΅ ΡΠ΅Π³ΠΎ Π·Π°ΠΏΡΡΡΠΈΡΠ΅ Π΅Π³ΠΎ. Π£Π±Π΅Π΄ΠΈΡΠ΅ΡΡ, ΡΡΠΎ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ ΡΡΡΠ°Π½ΠΎΠ²Π»Π΅Π½ΠΎ ΠΊ 9600 (Π΄Π»Ρ ΡΡΠΎΠ³ΠΎ Π·Π°ΠΏΡΡΡΠΈΡΠ΅ Arduino IDE ΡΠ΅ΡΠ΅Π· Tools-Serial Monitor). ΠΠΎΠ»ΠΆΠ½ΠΎ ΠΏΠΎΡΠ²ΠΈΡΡΡΡ ΡΡΡΡΠΎΠΉΡΡΠ²ΠΎ I2C Ρ Π°Π΄ΡΠ΅ΡΠΎΠΌ 0Γ68 Π»ΠΈΠ±ΠΎ 0Γ69. ΠΠ°ΠΏΠΈΡΠΈΡΠ΅ ΠΈΠ»ΠΈ Π·Π°ΠΏΠΎΠΌΠ½ΠΈΡΠ΅ Π°Π΄ΡΠ΅Ρ. ΠΡΠ»ΠΈ ΠΆΠ΅ Π°Π΄ΡΠ΅Ρ Π½Π΅ ΠΏΡΠΈΡΠ²ΠΎΠΈΠ»ΡΡ, ΡΠΊΠΎΡΠ΅Π΅ Π²ΡΠ΅Π³ΠΎ ΠΏΡΠΎΠ±Π»Π΅ΠΌΠ° Π² ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠΈ ΠΊ ΡΠ»Π΅ΠΊΡΡΠΎΠ½ΠΈΠΊΠ΅ Arduino.
ΠΠ°ΡΠ΅ΠΌ Π½Π°ΠΌ ΠΏΠΎΠ½Π°Π΄ΠΎΠ±ΠΈΡΡΡ ΡΠΊΠ΅ΡΡ, ΡΠΌΠ΅ΡΡΠΈΠΉ ΠΎΠ±ΡΠ°Π±Π°ΡΡΠ²Π°ΡΡ Π΄Π°Π½Π½ΡΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ° ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. Π ΠΈΠ½ΡΠ΅ΡΠ½Π΅ΡΠ΅ Π΅ΡΡΡ ΠΌΠ½ΠΎΠΆΠ΅ΡΡΠ²ΠΎ Π²Π°ΡΠΈΠ°Π½ΡΠΎΠ², ΠΈ Π½Π°ΠΉΡΠΈ ΠΏΠΎΠ΄Ρ ΠΎΠ΄ΡΡΠΈΠΉ Π½Π΅ ΠΏΡΠΎΠ±Π»Π΅ΠΌΠ°. Π‘ΠΊΠΎΡΠ΅Π΅ Π²ΡΠ΅Π³ΠΎ, ΠΎΠ½ Π±ΡΠ΄Π΅Ρ Π² Π·Π°Π°ΡΡ ΠΈΠ²ΠΈΡΠΎΠ²Π°Π½Π½ΠΎΠΌ Π²ΠΈΠ΄Π΅. Π Π°Π·Π°ΡΡ ΠΈΠ²ΠΈΡΡΠΉΡΠ΅ ΡΠΊΠ°ΡΠ°Π½Π½ΡΠΉ Π°ΡΡ ΠΈΠ², ΠΎΡΡΠΎΠΉΡΠ΅ Arduino IDE ΠΈ Π΄ΠΎΠ±Π°Π²ΡΡΠ΅ Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΡ (sketch-import library-add library). ΠΠ°ΠΌ ΠΏΠΎΠ½Π°Π΄ΠΎΠ±ΡΡΡΡ ΠΏΠ°ΠΏΠΊΠΈ MPU6050 ΠΈ I2Cdev.
ΠΡΠΊΡΡΠ²Π°Π΅ΠΌ MPU6050_DMP6 ΠΈ Π²Π½ΠΈΠΌΠ°ΡΠ΅Π»ΡΠ½ΠΎ ΠΏΡΠΎΡΠΌΠ°ΡΡΠΈΠ²Π°Π΅ΠΌ ΠΊΠΎΠ΄. ΠΠΈΠΊΠ°ΠΊΠΈΡ ΡΠ»ΠΎΠΆΠ½ΡΡ Π΄Π΅ΠΉΡΡΠ²ΠΈΠΉ ΠΏΡΠΎΠΈΠ·Π²ΠΎΠ΄ΠΈΡΡ Π½Π΅ ΠΏΡΠΈΠ΄Π΅ΡΡΡ, Π½ΠΎ Π΅ΡΠ»ΠΈ Π±ΡΠ» ΠΏΡΠΈΡΠ²ΠΎΠ΅Π½ Π°Π΄ΡΠ΅Ρ 0Γ60, ΡΠΎ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΡΠ°ΡΡΠΊΠΎΠΌΠ΅Π½ΡΠΈΡΠΎΠ²Π°ΡΡ ΡΡΡΠΎΠΊΡ Π² Π²Π΅ΡΡ Π½Π΅ΠΉ ΡΠ°ΡΡΠΈ (Π΅Π΅ ΠΌΠΎΠΆΠ½ΠΎ Π½Π°ΠΉΡΠΈ Π·Π° #includes) ΠΈ Π½Π°ΠΏΠΈΡΠ°ΡΡ Π²Π΅ΡΠ½ΡΠΉ Π°Π΄ΡΠ΅Ρ. ΠΠ·Π½Π°ΡΠ°Π»ΡΠ½ΠΎ ΡΠ°v ΡΠΊΠ°Π·Π°Π½ 0Γ68.
ΠΠ°Π³ΡΡΠΆΠ°Π΅ΠΌ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ, ΠΎΡΠΊΡΡΠ²Π°Π΅ΠΌ ΠΎΠΊΠ½ΠΎ ΠΌΠΎΠ½ΠΈΡΠΎΡΠ° ΡΠ΅ΡΠ΅Π· 115200 ΠΈ ΠΏΡΠΎΡΡΠΎ ΡΠ»Π΅Π΄ΡΠ΅ΠΌ ΠΈΠ½ΡΡΡΡΠΊΡΠΈΠΈ. Π§Π΅ΡΠ΅Π· Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΎ ΠΌΠ³Π½ΠΎΠ²Π΅Π½ΠΈΠΉ Π²Ρ ΠΏΠΎΠ»ΡΡΠΈΡΠ΅ Π΄Π°Π½Π½ΡΠ΅ Ρ Π³ΠΈΡΠΎΡΠΊΠΎΠΏΠ°/Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡΠ°. ΠΠ°ΡΠ΅ΠΌ ΡΠ»Π΅Π΄ΡΠ΅Ρ ΠΏΡΠΎΠ²Π΅ΡΡΠΈ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΡ Π΄Π°ΡΡΠΈΠΊΠΎΠ².
Π£ΡΡΠ°Π½ΠΎΠ²ΠΈΡΠ΅ ΠΏΠ»Π°ΡΡ Π½Π° ΡΠΎΠ²Π½ΡΡ ΠΏΠΎΠ²Π΅ΡΡ Π½ΠΎΡΡΡ ΠΈ Π·Π°ΠΏΡΡΡΠΈΡΠ΅ ΡΠΊΠ΅ΡΡ MPU6050_calibration.ino (Π»Π΅Π³ΠΊΠΎ ΠΈΡΠ΅ΡΡΡ Π² ΠΈΠ½ΡΠ΅ΡΠ½Π΅ΡΠ΅). ΠΡΠΎΡΠΌΠΎΡΡΠΈΡΠ΅ ΠΊΠΎΠ΄, ΠΏΠΎ ΡΠΌΠΎΠ»ΡΠ°Π½ΠΈΡ Π² Π½Π΅ΠΌ ΡΠΊΠ°Π·Π°Π½ Π°Π΄ΡΠ΅Ρ 0Γ68. ΠΠΎΡΠ»Π΅ Π·Π°ΠΏΡΡΠΊΠ° ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ Ρ Π²Π°Ρ ΠΏΠΎΡΠ²ΠΈΡΡΡ ΠΈΠ½ΡΠΎΡΠΌΠ°ΡΠΈΡ ΠΏΠΎ ΠΎΡΠΊΠ»ΠΎΠ½Π΅Π½ΠΈΡΠΌ (offset). ΠΠ°ΠΏΠΈΡΠΈΡΠ΅ Π΅Π΅, ΠΎΠ½Π° Π½Π°ΠΌ ΠΏΠΎΠ½Π°Π΄ΠΎΠ±ΠΈΡΡΡ Π² ΡΠΊΠ΅ΡΡΠ΅ MPU6050_DMP6.
ΠΡΠ΅, Π²Ρ ΠΏΠΎΠ»ΡΡΠΈΠ»ΠΈ ΡΡΠ½ΠΊΡΠΈΠΎΠ½ΠΈΡΡΡΡΠΈΠ΅ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ ΠΈ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ.
ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠ° Π΄Π»Ρ Arduino
ΠΠΎ ΡΡΡΠ»ΠΊΠ΅ Π²Ρ ΡΠΌΠΎΠΆΠ΅ΡΠ΅ ΡΠΊΠ°ΡΠ°ΡΡ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ Π΄Π»Ρ Arduino, Ρ ΠΏΠΎΠΌΠΎΡΡΡ ΠΊΠΎΡΠΎΡΠΎΠΉ ΠΊΠΎΠΏΡΠ΅Ρ Π±ΡΠ΄Π΅Ρ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·ΠΈΡΠΎΠ²Π°Π½ Π² ΠΏΠΎΠ»Π΅ΡΠ΅ ΠΈ ΡΠΌΠΎΠΆΠ΅Ρ Π·Π°Π²ΠΈΡΠ½ΡΡΡ Π½Π°Π΄ Π·Π΅ΠΌΠ»Π΅ΠΉ. Π Π΄ΠΎΠΏΠΎΠ»Π½Π΅Π½ΠΈΠ΅ ΠΊ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΠ΅ ΠΎΠ±ΡΠ·Π°ΡΠ΅Π»ΡΠ½ΠΎ ΡΠΊΠ°ΡΠ°ΠΉΡΠ΅ Π±ΠΈΠ±Π»ΠΈΠΎΡΠ΅ΠΊΡ Ρ Arduino PID ΠΏΠΎ ΡΡΡΠ»ΠΊΠ΅.
ΠΡΠΎΠ³ΡΠ°ΠΌΠΌΠ° ΠΏΠΎΠΌΠΎΠΆΠ΅Ρ Π²Π°ΠΌ ΡΠΏΡΠ°Π²Π»ΡΡΡ Π΄ΡΠΎΠ½ΠΎΠΌ. ΠΠ»Π³ΠΎΡΠΈΡΠΌ, ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅ΠΌΡΠΉ Π΄Π»Ρ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·Π°ΡΠΈΠΈ, ΠΎΡΠ½ΠΎΠ²Π°Π½ Π½Π° Π΄Π²ΡΡ PID-ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΠ°Ρ . ΠΠ΄ΠΈΠ½ ΠΏΡΠ΅Π΄Π½Π°Π·Π½Π°ΡΠ΅Π½ Π΄Π»Ρ ΠΊΡΠ΅Π½Π°, Π΄ΡΡΠ³ΠΎΠΉ β Π΄Π»Ρ ΡΠ°Π½Π³Π°ΠΆΠ°.
Π Π°Π·Π½ΠΈΡΠ° Π² ΡΠΊΠΎΡΠΎΡΡΡΡ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ ΠΏΠ°ΡΡ Π²ΠΈΠ½ΡΠΎΠ² 1 ΠΈ 2 ΡΠ°Π²Π½Π° ΡΠ°Π·Π½ΠΈΡΠ΅ Π² ΡΠΊΠΎΡΠΎΡΡΡΡ ΠΏΠ°ΡΡ Π²ΠΈΠ½ΡΠΎΠ² 3 ΠΈ 4. Π’ΠΎΠΆΠ΅ ΡΠ°ΠΌΠΎΠ΅ ΡΠΏΡΠ°Π²Π΅Π΄Π»ΠΈΠ²ΠΎ ΠΈ Π΄Π»Ρ ΠΏΠ°Ρ 1, 3 ΠΈ 2, 4. PID-ΡΠ΅Π³ΡΠ»ΡΡΠΎΡ ΠΏΡΠΎΠΈΠ·Π²ΠΎΠ΄ΠΈΡ ΠΈΠ·ΠΌΠ΅Π½Π΅Π½ΠΈΠ΅ ΡΠ°Π·Π½ΠΈΡΡ Π² ΡΠΊΠΎΡΠΎΡΡΠΈ, ΠΏΠΎΡΠ»Π΅ ΡΠ΅Π³ΠΎ ΠΊΡΠ΅Π½ ΠΈ ΡΠ°Π½Π³Π°ΠΆ ΡΡΠ°Π½ΠΎΠ²ΡΡΡΡ ΡΠ°Π²Π½ΡΠΌΠΈ Π½ΡΠ»Ρ.
ΠΠ±ΡΠ°ΡΠΈΡΠ΅ Π²Π½ΠΈΠΌΠ°Π½ΠΈΠ΅ Π½Π° ΡΠΈΡΡΠΎΠ²ΡΠ΅ ΠΏΠΈΠ½Ρ Arduino Π΄Π»Ρ ΠΌΠΎΡΠΎΡΠΎΠ² ΠΈ Π½Π΅ Π·Π°Π±ΡΠ΄ΡΡΠ΅ ΠΈΠ·ΠΌΠ΅Π½ΠΈΡΡ ΡΠΊΠ΅ΡΡ.
ΠΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ ΠΊ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΡ
ΠΠ»Ρ ΡΠΎΠ³ΠΎ, ΡΡΠΎΠ±Ρ ΡΠΏΡΠ°Π²Π»ΡΡΡ ΠΊΠΎΠΏΡΠ΅ΡΠΎΠΌ, Π½Π°ΠΌ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ ΠΏΠΎΠ»ΡΡΠΈΡΡ ΠΊΠΎΠ½ΡΡΠΎΠ»Ρ Π½Π°Π΄ ΠΌΠΎΡΠΎΡΠ°ΠΌΠΈ, ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠΈΠ² ΠΈΡ ΠΊ Arduino. ΠΠΎΠ½ΡΡΠΎΠ»Π»Π΅Ρ Π΄Π°Π΅Ρ Π½Π° Π²ΡΡ ΠΎΠ΄Π΅ Π»ΠΈΡΡ Π½Π΅Π±ΠΎΠ»ΡΡΠΎΠ΅ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅ ΠΈ ΡΠΈΠ»Ρ ΡΠΎΠΊΠ°, ΠΏΠΎΡΡΠΎΠΌΡ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½ΠΈΠ΅ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»Π΅ΠΉ Π½Π°ΠΏΡΡΠΌΡΡ Π»ΠΈΡΠ΅Π½ΠΎ ΡΠΌΡΡΠ»Π°. ΠΠΌΠ΅ΡΡΠΎ ΡΡΠΎΠ³ΠΎ ΠΌΠΎΠΆΠ½ΠΎ ΠΏΠΎΡΡΠ°Π²ΠΈΡΡ Π½Π΅ΡΠΊΠΎΠ»ΡΠΊΠΎ ΡΡΠ°Π½Π·ΠΈΡΡΠΎΡΠΎΠ², ΠΏΠΎΠ·Π²ΠΎΠ»ΡΡΡΠΈΡ ΡΠ²Π΅Π»ΠΈΡΠΈΡΡ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΠ΅.
ΠΠ»Ρ ΡΠΎΡΡΠ°Π²Π»Π΅Π½ΠΈΡ ΡΡ Π΅ΠΌΡ Π½Π°ΠΌ Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΡ:
- Arduino
- ΠΠ²ΠΈΠ³Π°ΡΠ΅Π»ΠΈ
- Π’ΡΠ°Π½Π·ΠΈΡΡΠΎΡΡ
ΠΡΠ΅ ΡΡΠΎ ΡΠΎΠ±ΠΈΡΠ°Π΅ΡΡΡ Π½Π° ΠΌΠΎΠ½ΡΠ°ΠΆΠ½ΠΎΠΉ ΠΏΠ»Π°ΡΠ΅ ΠΈ ΡΠΎΠ΅Π΄ΠΈΠ½ΡΠ΅ΡΡΡ ΠΊΠΎΠ½Π½Π΅ΠΊΡΠΎΡΠ°ΠΌΠΈ.
ΠΠ° ΠΏΠ΅ΡΠ²ΠΎΠΌ ΡΡΠ°ΠΏΠ΅ ΡΠ»Π΅Π΄ΡΠ΅Ρ ΠΏΠΎΠ΄ΡΠΎΠ΅Π΄ΠΈΠ½ΠΈΡΡ 4 Π¨ΠΠ Π²ΡΡ ΠΎΠ΄Π° (ΠΎΠ±ΠΎΠ·Π½Π°ΡΠ΅Π½Ρ ~) ΠΊ ΡΡΠ°Π½Π·ΠΈΡΡΠΎΡΡ. ΠΠ°ΡΠ΅ΠΌ ΠΏΠΎΠ΄ΡΠΎΠ΅Π΄ΠΈΠ½ΠΈΡΠ΅ ΠΊΠΎΠ½Π½Π΅ΠΊΡΠΎΡΡ ΠΊ Π΄Π²ΠΈΠΆΠΊΠ°ΠΌ, ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½Π½ΡΠΌ ΠΊ ΠΏΠΈΡΠ°Π½ΠΈΡ. Π Π½Π°ΡΠ΅ΠΌ ΡΠ»ΡΡΠ°Π΅ ΠΌΡ ΠΈΡΠΏΠΎΠ»ΡΠ·ΡΠ΅ΠΌ Π°ΠΊΠΊΡΠΌΡΠ»ΡΡΠΎΡ Π½Π° 5Π, Π½ΠΎ ΠΏΠΎΠ΄ΠΎΠΉΠ΄Π΅Ρ ΠΈ Π°ΠΊΠΊΡΠΌΡΠ»ΡΡΠΎΡ Π½Π° 3-5Π.
Π’ΡΠ°Π½Π·ΠΈΡΡΠΎΡΡ Π΄ΠΎΠ»ΠΆΠ½Ρ Π±ΡΡΡ Π·Π°Π·Π΅ΠΌΠ»Π΅Π½Ρ, Π° Π·Π΅ΠΌΠ»Ρ Π½Π° ΠΏΠ»Π°ΡΠ΅ Arduino Π΄ΠΎΠ»ΠΆΠ½Π° Π±ΡΡΡ ΠΏΠΎΠ΄ΠΊΠ»ΡΡΠ΅Π½Π° ΠΊ Π·Π΅ΠΌΠ»Π΅ Π°ΠΊΠΊΡΠΌΡΠ»ΡΡΠΎΡΠ°. ΠΠ²ΠΈΠ³Π°ΡΠ΅Π»ΠΈ Π΄ΠΎΠ»ΠΆΠ½Ρ Π²ΡΠ°ΡΠ°ΡΡΡΡ Π² ΠΏΡΠ°Π²ΠΈΠ»ΡΠ½ΠΎΠΌ Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠΈ, ΡΠΎ Π΅ΡΡΡ ΡΠ°Π±ΠΎΡΠ°ΡΡ Π½Π° ΠΏΠΎΠ΄ΡΠ΅ΠΌ ΠΊΠΎΠΏΡΠ΅ΡΠ°, Π° Π½Π΅ Π½Π° Π΅Π³ΠΎ ΠΊΡΠ΅Π½.
ΠΠ΅ΡΠ΅ΠΊΠ»ΡΡΠΈΠ² ΠΊΠΎΠ½ΡΠ°ΠΊΡ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»Ρ Ρ Π½Π°ΠΏΡΡΠΆΠ΅Π½ΠΈΡ 5Π Π½Π° ΡΡΠ°Π½Π·ΠΈΡΡΠΎΡ, Π²Ρ ΡΠ²ΠΈΠ΄ΠΈΡΠ΅, ΡΡΠΎ ΡΠΎΡΠΎΡ ΠΈΠ·ΠΌΠ΅Π½ΠΈΡ Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠ΅ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ. ΠΠ΄ΠΈΠ½ΠΎΠΆΠ΄Ρ ΡΠΎΠ²Π΅ΡΡΠΈΠ² Π½Π°ΡΡΡΠΎΠΉΠΊΡ, Π±ΠΎΠ»ΡΡΠ΅ Π²ΠΎΠ·Π²ΡΠ°ΡΠ°ΡΡΡΡ ΠΊ ΠΈΠ·ΠΌΠ΅Π½Π΅Π½ΠΈΡ Π½Π°ΠΏΡΠ°Π²Π»Π΅Π½ΠΈΡ Π²ΡΠ°ΡΠ΅Π½ΠΈΡ ΡΠΎΡΠΎΡΠ° Π½Π΅ ΠΏΡΠΈΠ΄Π΅ΡΡΡ. Π’Π΅ΠΏΠ΅ΡΡ Π½Π°Ρ ΠΈΠ½ΡΠ΅ΡΠ΅ΡΡΠ΅Ρ ΡΠΊΠΎΡΠΎΡΡΡ.
ΠΠ°ΠΏΡΡΡΠΈΠ² ΠΈ ΠΏΡΠΎΠ²Π΅ΡΠΈΠ² Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ, ΠΌΡ ΡΡΡΠ°Π½Π°Π²Π»ΠΈΠ²Π°Π΅ΠΌ Π½Π°ΡΡ ΡΡ Π΅ΠΌΡ Π½Π° ProtoBoard. ΠΠ° Π΅Π΅ Π½Π΅ΠΈΠΌΠ΅Π½ΠΈΠ΅ΠΌ, ΠΌΠΎΠΆΠ½ΠΎ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°ΡΡ ΠΈ ΠΎΠ±ΡΡΠ½ΡΡ ΠΌΠΎΠ½ΡΠ°ΠΆΠ½ΡΡ ΠΏΠ»Π°ΡΡ, ΠΏΡΠ΅Π΄Π²Π°ΡΠΈΡΠ΅Π»ΡΠ½ΠΎ Π½Π°ΠΏΠ°ΡΠ² Π½Π° Π½Π΅ΠΉ ΡΠ΅Π»ΡΡΡ Π΄Π»Ρ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΠ°.
ΠΠ΅ΡΠ΅Π΄ ΡΠ΅ΠΌ, ΠΊΠ°ΠΊ ΠΏΡΠΈΠΏΠ°ΠΈΠ²Π°ΡΡ Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ ΠΊ ΠΏΠ»Π°ΡΠ΅, Π½Π΅ΠΎΠ±Ρ ΠΎΠ΄ΠΈΠΌΠΎ Π²ΡΠΏΠΎΠ»Π½ΠΈΡΡ Π΅Π³ΠΎ ΠΊΠ°Π»ΠΈΠ±ΡΠΎΠ²ΠΊΡ Π½Π° Π³ΠΎΡΠΈΠ·ΠΎΠ½ΡΠ°Π»ΡΠ½ΠΎΠΉ ΠΏΠΎΠ²Π΅ΡΡ Π½ΠΎΡΡΠΈ. ΠΡΠΎ ΠΏΠΎΠΌΠΎΠΆΠ΅Ρ Π΄ΠΎΠ±ΠΈΡΡΡΡ Π±ΠΎΠ»Π΅Π΅ ΡΠΎΡΠ½ΠΎΠΉ ΡΠ°Π±ΠΎΡΡ ΡΠ΅Π½ΡΠΎΡΠ° Π² Π±ΡΠ΄ΡΡΠ΅ΠΌ.
ΠΠ°ΠΊ Π΅ΡΠ΅ ΠΌΠΎΠΆΠ½ΠΎ ΠΌΠΎΠ΄Π΅ΡΠ½ΠΈΠ·ΠΈΡΠΎΠ²Π°ΡΡ ΠΊΠ²Π°Π΄ΡΠΈΠΊ
Π£Π·ΠΊΠΈΠΌ ΠΌΠ΅ΡΡΠΎΠΌ ΠΊΠΎΠΏΡΠ΅ΡΠ° ΡΠ²Π»ΡΡΡΡΡ Π΅Π³ΠΎ ΠΊΠΎΠ»Π»Π΅ΠΊΡΠΎΡΠ½ΡΠ΅ Π΄Π²ΠΈΠΆΠΊΠΈ. ΠΡΠ»ΠΈ ΠΏΠΎΠΈΡΠΊΠ°ΡΡ, ΠΌΠΎΠΆΠ½ΠΎ Π½Π°ΠΉΡΠΈ ΡΡΡΡ Π±ΠΎΠ»Π΅Π΅ ΠΊΡΡΠΏΠ½ΡΠ΅ ΠΈ Π±ΠΎΠ»Π΅Π΅ ΠΌΠΎΡΠ½ΡΠ΅ ΠΌΠΎΡΠΎΡΡ, ΡΠ΅ΠΌ ΠΏΡΠ΅Π΄Π»ΠΎΠΆΠ΅Π½Ρ Π² Π½Π°ΡΠ΅ΠΉ ΡΡΠ°ΡΡΠ΅, Π½ΠΎ Π·Π½Π°ΡΠΈΡΠ΅Π»ΡΠ½ΠΎΠ³ΠΎ Π²ΡΠΈΠ³ΡΡΡΠ° Π² Ρ Π°ΡΠ°ΠΊΡΠ΅ΡΠΈΡΡΠΈΠΊΠ°Ρ Π½Π΅ ΠΏΡΠΎΠΈΠ·ΠΎΠΉΠ΄Π΅Ρ.
ΠΠΏΡΠΎΡΠ΅ΠΌ, Ρ Π½Π°Ρ Π±ΡΠ»Π° ΡΠ΅Π»Ρ ΡΠΎΠ±ΡΠ°ΡΡ Π½Π΅Π΄ΠΎΡΠΎΠ³ΠΎΠΉ ΠΊΠ²Π°Π΄ΡΠΎΠΊΠΎΠΏΡΠ΅Ρ ΡΠ²ΠΎΠΈΠΌΠΈ ΡΡΠΊΠ°ΠΌΠΈ, ΠΈ ΠΈΠΌΠ΅Π½Π½ΠΎ ΠΏΠΎΡΡΠΎΠΌΡ ΠΈΡΠΏΠΎΠ»ΡΠ·ΠΎΠ²Π°Π»ΠΈΡΡ Π΄Π΅ΡΠ΅Π²ΡΠ΅ ΠΌΠΎΡΠΎΡΡ. ΠΠ΅ΡΠΊΠΎΠ»Π»Π΅ΠΊΡΠΎΡΠ½ΡΠ΅ Π΄Π²ΠΈΠ³Π°ΡΠ΅Π»ΠΈ Π·Π°ΠΌΠ΅ΡΠ½ΠΎ Π΄ΠΎΡΠΎΠΆΠ΅, Π½ΠΎ Π·Π°ΡΠΎ ΠΎΠ½ΠΈ Π΄Π°Π΄ΡΡ Π²Π°ΠΌ Π·Π°ΠΌΠ΅ΡΠ½ΠΎ Π±ΠΎΠ»ΡΡΡΡ ΠΌΠΎΡΠ½ΠΎΡΡΡ ΠΈ Π½Π°Π΄Π΅ΠΆΠ½ΠΎΡΡΡ. Π Π½ΠΈΠΌ ΠΏΡΠΈΠ΄Π΅ΡΡΡ Π΄ΠΎΠΊΡΠΏΠΈΡΡ Π΅ΡΠ΅ ΠΈ ΠΊΠΎΠ½ΡΡΠΎΠ»Π»Π΅ΡΡ ΡΠΊΠΎΡΠΎΡΡΠΈ, Π½ΠΎ ΡΡΠΎ Π΄Π΅ΠΉΡΡΠ²ΠΈΡΠ΅Π»ΡΠ½ΠΎ ΡΡΡΠ΅ΠΊΡΠΈΠ²Π½Π°Ρ ΠΌΠΎΠ΄Π΅ΡΠ½ΠΈΠ·Π°ΡΠΈΡ.
ΠΡΠ±ΠΎΡ ΠΏΠ»Π°ΡΡ Arduino Uno ΠΎΠ±ΡΡΠ»ΠΎΠ²Π»Π΅Π½ ΡΠ΅ΠΌ, ΡΡΠΎ Ρ Π½Π΅Π΅ ΠΌΠΎΠΆΠ½ΠΎ Π΄ΠΎΠ²ΠΎΠ»ΡΠ½ΠΎ Π»Π΅Π³ΠΊΠΎ ΡΠ½ΡΡΡ ΡΠΈΠΏ ΠΈ ΠΏΠΎΡΡΠ°Π²ΠΈΡΡ Π΅Π³ΠΎ Π½Π° ProtoBoard. ΠΡΠΎ ΠΏΠΎΠ·Π²ΠΎΠ»ΡΠ΅Ρ ΡΠΌΠ΅Π½ΡΡΠΈΡΡ Π²Π΅Ρ Π΄ΡΠΎΠ½Π° Π½Π° 30 Π³ΡΠ°ΠΌΠΌ, Π½ΠΎ ΠΏΡΠΈΠ΄Π΅ΡΡΡ Π²ΠΊΠ»ΡΡΠΈΡΡ Π² ΡΡ Π΅ΠΌΡ Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡΠ΅Π»ΡΠ½ΡΠ΅ ΠΊΠΎΠ½Π΄Π΅Π½ΡΠ°ΡΠΎΡΡ. ΠΠΎΠ΄ΠΎΠΉΠ΄Π΅Ρ ΠΈ ΠΏΠ»Π°ΡΠ° Arduino Pro Mini.
Π§ΡΠΎ ΠΊΠ°ΡΠ°Π΅ΡΡΡ ΠΏΡΠΎΠ³ΡΠ°ΠΌΠΌΡ Arduino, ΡΠΎ Π΅Π΅ ΠΌΠΎΠΆΠ½ΠΎ ΡΡΠ°Π²Π½ΠΈΡΠ΅Π»ΡΠ½ΠΎ Π»Π΅Π³ΠΊΠΎ ΠΈΠ·ΠΌΠ΅Π½ΠΈΡΡ ΠΈ Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡΡ Π½ΠΎΠ²ΡΠΌΠΈ ΡΡΠ½ΠΊΡΠΈΡΠΌΠΈ. ΠΠ»Π°Π²Π½ΠΎΠ΅, ΡΡΠΎ Ρ Π΅Π΅ ΠΏΠΎΠΌΠΎΡΡΡ Π΄ΡΠΎΠ½ ΡΠΏΠΎΡΠΎΠ±Π΅Π½ Π² Π°Π²ΡΠΎΠΌΠ°ΡΠΈΡΠ΅ΡΠΊΠΎΠΌ ΡΠ΅ΠΆΠΈΠΌΠ΅ ΡΡΠ°Π±ΠΈΠ»ΠΈΠ·ΠΎΠ²Π°ΡΡ ΡΠ²ΠΎΠ΅ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅.
ΠΠ° ΠΊΠ²Π°Π΄ΡΠΎΠΊΠΎΠΏΡΠ΅Ρ ΠΌΠΎΠ³ΡΡ Π±ΡΡΡ ΡΡΡΠ°Π½ΠΎΠ²Π»Π΅Π½Ρ Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡΠ΅Π»ΡΠ½ΡΠ΅ ΠΌΠΎΠ΄ΡΠ»ΠΈ, Π½Π°ΠΏΡΠΈΠΌΠ΅Ρ, ΠΏΠ»Π°ΡΠ° ΠΏΡΠΈΠ΅ΠΌΠ½ΠΈΠΊΠ°, ΡΡΠΎ ΠΏΠΎΠ·Π²ΠΎΠ»ΠΈΡ ΠΎΡΠ³Π°Π½ΠΈΠ·ΠΎΠ²Π°ΡΡ Π΄ΠΈΡΡΠ°Π½ΡΠΈΠΎΠ½Π½ΠΎΠ΅ ΡΠΏΡΠ°Π²Π»Π΅Π½ΠΈΠ΅ Π΄ΡΠΎΠ½ΠΎΠΌ.
ΠΠ° ΡΡΠΎΠΌ ΠΌΡ Π·Π°Π²Π΅ΡΡΠ°Π΅ΠΌ ΡΡΠ°ΡΡΡ ΠΎ ΡΠΎΠ·Π΄Π°Π½ΠΈΠΈ Π±Π΅ΡΠΏΠΈΠ»ΠΎΡΠ½ΠΈΠΊΠ° Π½Π° Arduino. ΠΠΎΠ΄ΠΏΠΈΡΡΠ²Π°ΠΉΡΠ΅ΡΡ Π½Π° Π½Π°ΡΠΈ ΠΎΠ±Π·ΠΎΡΡ ΠΈ Π΄Π΅Π»ΠΈΡΠ΅ΡΡ ΠΏΠΎΠ»Π΅Π·Π½ΡΠΌΠΈ ΠΌΠ°ΡΠ΅ΡΠΈΠ°Π»Π°ΠΌΠΈ Π² ΡΠΎΡΠΈΠ°Π»ΡΠ½ΡΡ ΡΠ΅ΡΡΡ . ΠΠΎ Π½ΠΎΠ²ΡΡ Π²ΡΡΡΠ΅Ρ.
ΠΠ°Π³ΡΡΠ·ΠΊΠ°…drongeek.ru
Arduino + Π³ΠΈΡΠΎΡΠΊΠΎΠΏ/Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ == Π΄ΠΈΡΠΏΠ΅ΡΡΠ΅Ρ ΠΏΠΎΠ»Π΅ΡΠΎΠ² …?
Well,
It sound a little bit limited.
I assume that a flight controller performs dead reckoning by double integrating the measured accelerations. And because this computation is relative and not absolute, errors will sums up and you will have a drift. Thus you have to reduce every sources of errors. One of them is the quantization noise due to the fixed point math. Of course you could use high precision floating point math. But if you think of the amount of required computations and the fact that the ATMega does not have floating point support, it looks difficult. And if you want to add a GPS and implement some Kalman filters for sensor fusion, it will definitely be too demanding for that MCU.
To be more specific:
To maintain the balance of a flying vehicle you have to determine the relative angles of your vehicle. This cannot be achieved by a simple reading of an accelerometer output because the accelerometer will measure the gravity vector AND the accelerations of your vehicle. In real systems, high precision gyroscopes are used. But it’s expensive, bulky and not practical. A cheaper way to do this is to use a rate gyro sensor. It’s small, easy to interface and cheap. The output of a rate gyro is a signal which is proportional to the angular speed measured by the chip. If you integrate this signal ( sum ) you have the angular position of the chip. It sounds nice. But the problem is the drift. You have to continuously add measured values. But in real systems measured value is defined by : $measuredValue = measuredEffects + errors$ After some times, even if the vehicle is no moving at all, the angles returned by your algorithm will be significantly different from the real position of the vehicle due to the fact that errors sum up too. In order to avoid that, you have to sample your sensor at a high rate, reduce sources of noise (especially in the computation by using high precisions ) and use the fact that your vehicle should be flat most of the time and use that to try to cancel the drifts.
And yes, you have to continuously read the rate gyro output and sum the read value. But continuous things do not exist in a discrete world… Thus you have to do it at a high rate. I have values such as 100Hz or 1kHz in mind. This has to be checked.
For the control of the vehicle itself: Once you have a m
electronics.stackovernet.com
arduino — ΠΠ°ΠΊ ΡΠΈΡΠ°ΡΡ Π³ΠΈΡΠΎΡΠΊΠΎΠΏ/Π°ΠΊΡΠ΅Π»Π΅ΡΠΎΠΌΠ΅ΡΡ
I recently purchased this MPU6050 GY-521 breakout board. I tried it with my Arduino Mega using this Arduino sketch provided by official arduino.cc.
(MPU-6050 Datasheet, InvenSence (producer) Page)
Man, it gives this weird output!!!
InvenSense MPU-6050
June 2012
WHO_AM_I : 68, error = 0
PWR_MGMT_2 : 0, error = 0
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1944, 368, 15608
temperature: 30.576 degrees Celsius
gyro x,y,z : -34, -204, -247,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1952, 364, 15304
temperature: 30.435 degrees Celsius
gyro x,y,z : -38, -216, -274,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1864, 388, 15356
temperature: 30.482 degrees Celsius
gyro x,y,z : -34, -233, -278,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1888, 324, 15260
temperature: 30.576 degrees Celsius
gyro x,y,z : -14, -220, -261,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1904, 392, 15316
temperature: 30.624 degrees Celsius
gyro x,y,z : -34, -241, -238,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1856, 308, 15604
temperature: 30.435 degrees Celsius
gyro x,y,z : -33, -252, -235,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1892, 444, 15528
temperature: 30.624 degrees Celsius
gyro x,y,z : 20, -236, -251,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1924, 356, 15520
temperature: 30.576 degrees Celsius
gyro x,y,z : -19, -224, -251,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 1844, 280, 15732
temperature: 30.529 degrees Celsius
gyro x,y,z : -1, -240, -249,
MPU-6050
Read accel, temp and gyro, error = 0
accel x,y,z: 2004, 372, 15396
temperature: 30.671 degrees Celsius
gyro x,y,z : -20, -252, -255,
(This is only a part of it, it gives this king of output continuously). I know for sure, only the temperature reading is meaningful. But what are those values given for acceleration and gyro readings??
OK, It says those are raw values. If it is so, then how can I convert them into meaningful values. Hoping it can be helpful (as many suggested), I also like to know how to use so called Jeff Rowberg
library.
Hope there will be someone experienced with MPU-6050 module. Just give me a point to start. I have no clue on how to use the module… π
Any help is greatly appreciated. Thanks !
electronics.stackovernet.com
ΠΠΌΠΏΠ΅ΡΠΈΡ β ΠΠΎΠΈΡΠΊΠΎΠ²ΡΠΉ ΠΎΠ½Π»Π°ΠΉΠ½ Π²ΠΈΠ΄Π΅ΠΎ ΡΠ΅ΡΠ²ΠΈΡ
Tired of missing premieres at the cinema because of the frenzied rhythm of life? Tired of the fact that on television, the films are being broadcasted at an inconvenient time for you? In your family, often your relatives divide the remote from the TV? The child asks to see cartoons for children, when you are busy, and on the channels there are no good cartoons? And, in the end, Do you just want to relax after a hard day on the sofa in your home clothes for watching an interesting movie or series?
To do this, it is best to always have a favorite site in your bookmarks, which will become your best friend and helper. And how to choose such a site, when there are so many? — you ask. The best choice for you will be imperiya.by
Why our resource? Because it combines many positive features that make it universal, convenient and simple. Here is a list of the main advantages of the resource.
Free access. Many sites ask customers to buy a subscription, than our portal does not deal with, because it believes that people should have free access to the Internet in everything. We do not charge viewers for our viewers!
You do not need any registration and SMS for questionable phone numbers. We do not collect confidential information about our users. Everyone has the right to anonymity on the Internet, which we support.
Excellent video quality. We upload content exclusively in HD format, which certainly can please your favorite users. It is much more pleasant to watch a good movie with a quality picture than with a picture of poor quality.
A huge choice. Here you will find a video for every taste. Even the most inveterate moviegoer will always find what to see from us. For children there are cartoons in good quality, cognitive programs about animals and nature . Men will find interesting channels for themselves about news, sports, cars, as well as about science and technology. And for our beloved women, we picked up a channel about fashion and style, about celebrities, and of course music videos. Having arranged an evening with your family, or with friends, you can pick up a merry family comedy. A loving couple to luxuriate in watching a love melodrama. After a day of work, a thrilling series or a detective helps to relax. Movies in HD format of the new time and past years are presented to absolutely any taste and can satisfy the needs of any viewer.
Ability to download video. Absolutely any material on the site can be downloaded to your computer or USB flash drive. If suddenly you are going to a dacha with a laptop where there is no internet, or you want to watch a movie on a big screen of the TV, you can always download in advance, and then look at the right time. In this case, you do not have to wait for your turn to download the video, as it happens on torrents or other similar sites.
Security. We monitor the cleanliness of the content, every file is checked before uploading. Therefore, there are no viruses and spyware on our site, and we carefully monitor this.
New. We regularly update and add new animations, serials, TV shows, music videos, news, reviews, animated series, etc. to the portal. and all this you can see for free, without registration and SMS. We are trying for you, for our favorite visitors.
Online browsing. On our site, it is not necessary to first download a movie to view it, simply turn it on and enjoy it. Thanks to the professional setup, there will be no braking, and nothing can stop you from watching an interesting movie.
Bookmark. On the site you can click a button with an asterisk to poison the video in the bookmarks and return to it later. Everyone, for certain, happened that he saw on the site an interesting video that you want to see, but right now there is no possibility. This button will help you with this and, having freed yourself, you can easily see what you like.
User-friendly interface. Finding the right video will not take you long, as the site is best adapted to users, and everything is intuitively understandable. Even a child will be able to understand and include for himself a cartoon or some program about animals, nature.
Cinema as art appeared relatively recently, but already managed to closely intertwine with our lives. A lot of people because of the haste of our time for years did not go to the theater, to the gallery or museums. However, it is difficult to imagine a person who did not watch the series or the film for at least a month. Cinema is a synthesis of theater, music, fine arts and literature. Thus, it gives even the most busy person, who does not have time to go to theaters and galleries, to be closer to art and to improve spiritually.
The cinema also occupied the sphere of public entertainment. Watch comedies, fighters, westerns, etc. perfectly fits into any some evening with my family. Horrors perfectly tickle the nerves of even the most fearless person. Cartoons adore children, and some can be viewed by the whole family. Cognitive videos help to expand knowledge, look at the world wider and satisfy your own natural curiosity.
A man in the twenty-first century can no longer imagine his life without the technology of the future, it seems that in the future, machines, robots and technics can replace a person, or rather perform many automatic works, so everyone wants to see what technologies will be in the future. On imperiya.by you do not need to postpone the scan, just add the video to the bookmarks and at any time you can return to it and have a great time watching the quality video.
Do not deny yourself the pleasure, start watching right now! Meet the updates, with new items, choose what you would like to see later. Pleasure yourself and your family with interesting films in good quality!
imperiya.by