Herunterladen Diese Seite drucken

SunFounder PiDog Kit Bedienungsanleitung Seite 91

Werbung

1. Echtzeit-Beschleunigung und Winkelgeschwindigkeit auslesen
from
pidog
import
Pidog
import
time
my_dog
=
Pidog()
my_dog.do_action("Liegestütze", Schrittanzahl=10, Geschwindigkeit=20)
while
True:
ax, ay, az
=
my_dog.accData
gx, gy, gz
=
my_dog.gyroData
print(f"accData:
gyroData:
{gx}
/s,
time.sleep(0.2)
if
my_dog.is_legs_done():
break
my_dog.stop_and_lie()
my_dog.close()
2. Neigungswinkel des PiDog-Körpers berechnen
from
pidog
import
Pidog
import
time
import
math
my_dog
=
Pidog()
while
True:
ax, ay, az
=
my_dog.accData
Körperneigung
=
print(f"Körpergrad:
time.sleep(0.2)
my_dog.close()
3. Während des Neigens hält PiDog seine Augen horizontal
from
pidog
import
Pidog
import
time
import
math
my_dog
=
Pidog()
while
True:
ax, ay, az
=
my_dog.accData
Körperneigung
=
my_dog.head_move([[0, 0, 0]], Pitch-Kompensation=-Körperneigung, Geschwindigkeit=80)
time.sleep(0.2)
my_dog.close()
2.4. 4. Einfaches Codieren
{ax/16384:.2f}
g
,{ay/16384:.2f}
{gy}
/s,
{gz}
/s")
math.atan2(ay, ax)
/
{Körperneigung:.2f}
math.atan2(ay, ax)
/
SunFounder PiDog Kit, Release 1.0
g,
{az/16384:.2f}
math.pi
*
180
%
360
"
)
math.pi
*
180
%
360
g
-
180
-
180
87

Werbung

loading