Hi,
es hat zwar einige Zeit gedauert, bis ich mich mit dem Gedanken angefreundet hatte, aber ich berechne jetzt die Winkel durch eine Drehmatrix:
Code:
Y = Gyro_xangle
X = Gyro_yangle
A = Gyroz
A = A / 8192 '10000
If A < -90 Then A = -90
If A >= 90 Then A = 90
A = Deg2rad(a)
Sina = Sin(a)
Cosa = Cos(a)
Xtemp = Cosa * X
Xtemp2 = Sina * Y
Xtemp = Xtemp - Xtemp2
Ytemp = Sina * X
Ytemp2 = Cosa * Y
Ytemp = Ytemp + Ytemp2
Gyro_xangle = Ytemp
Gyro_yangle = Xtemp
Leider wollte ich diese Lösung nicht haben, weil die Sin & Cos Funktion eben sehr zeitintensiv sind... Deswegen werde ich mir wohl eine LookUp-Tabelle erstellen, damits etwas schneller geht
Gruß
Chris
Lesezeichen