1.
Die Skalierung des Eingangs ist zum einen eine ganz andere wie der Ausgang zum Servo.
2.
Am Eingang kommt lediglich eine Komponente der Gravitation an und kein Winkel und da der Servo einen Winkel benötigt, komme ich um einen Arcsin nicht herum.
Zur Lageregelung eines Tricopters ist das zwar nicht nötig, aber für den servo schon, da ich dort ja nicht 0 erreichen will.
Das eigentlich Themas ist auch erledigt, lediglich die Skalierung ist noch das Problem.
Naja im prinzip kommt schon ein winkel an. der wird ausgerechnet mit hilfe des acc und des gyros zusammen. damit kann man ja die genaue position in einem raum bestimmen.
die scallierung ist denke ich vernachlässigbar. den bei den P, I und D werten kommt nur eine fehlersumme raus. diese sollte nicht sehr hoch sein.
die werte der Sensoren liegen laut deiner aussage (ich habs nicht geprüft) bei +/- 25400, für die motoren wird aber nur ein wert von 0 bis 255 übergeben. da würde die skallierung auch nicht passen.
Moin,
ich habs!
Arduino Eingang: 10BIT 1024 = 111111111 @5V : 5V/1024 = 0,00488... -> 1Bit=4,88mV
Ausgang ADXL322@Vs = 5 V, the output sensitivity is typically 750mV/g -->
90°= 3,25V
0°= Vs/2 = 2,5V
-90° = 1,75
V-Ausgang Arduino Eingang
3,25V/0,00488= 666
2,50V/0,00488= 512
1,75V/0,00488= 358
Das sind die Endwerte mit denen kann ich das Signal skalieren und habe das Verhältnis vom Signal zum Endwert, davon berechne ich den Arcsin und habe dann den Winkel in dem der Sensor steht.
Voila, diesen Winkel bekommt der Servo und die Kamera steht immer Horizontal.
Willa hat die Erfassung im Code noch zusätzlich mit 99% Vom Gyro ergänzt für ein genaueres Signal.
Es ging hier aber hauptsächlich um die Skalierung des Signals, damit ich einen Winkel errechnen kann. Das funktioniert jetzt, bin gespannt auf heut Abend wie es geht.
Evtl geht die ganze Geschichte heute Abend schon!
Aber ich befürchte ja, dass ich das ganze noch mit einer Regelung versehen muss.
*schluck*
gruß
Nils
Berechtigungen
Zitieren
Lesezeichen