Werte auf einzelne Beine beim Hexapod umrechnen
Ich habe jetzt das Accelerometer so weit im Programm eingebunden.
Bevor ich jetzt wieder selber das Rad erfinde, folgende Frage:
Hat schon jemand einen Algorithmus gesichtet, der die Werte eines Lagesensors auf 6 Beine, bei einem Hexapod - als Offset - berechnet? Oder was ähnliches?
Ich habe die Werte so weit verarbeitet, dass ich in jeder Achse 0 bis +/-15 erhalte.
Also 0 wäre waagerecht, -15 (max). zu der einen Seite, +15 (max.) zu der andern Seite gekippt.
Jetzt muss ich, je nachdem wie der Sensor aus der Waagerechten gekippt wird, verschiedene Werte berechnen, die sich zu den einzelnen Beinen addieren lassen, so dass der Hexapod-Körper die Waagerechte in X und Y wieder einnimmt.
MfG