Hi,
es hat zwar einige Zeit gedauert, bis ich mich mit dem Gedanken angefreundet hatte, aber ich berechne jetzt die Winkel durch eine Drehmatrix:
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 gehtCode: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
Gruß
Chris







Zitieren

Lesezeichen