Hi,

einen Code kann ich dir nicht geben(hab das ganze in Assembler gemacht), aber vlt. eine Anregung, wie du es selbst realisieren könntest.

Die Servos steuerst du in Bascom mit dem Servo() befehl an.
Um auf die Winkel der Servos zu kommen, gibt es verschiedene Möglichkeiten.

1. Abspeichern aller Bewegungsabläufe:
Hierbei rechnest du dir per hand oder Komputer die winkel der Servos zu unterschiedlichen Zeiten aus (mittels normaler Geometrie) und Speicherst sie in einer Tabelle auf deinem µC.
Eine sehr einfache Methode, jedoch verbraucht sie sehr viel Speicher und ist nicht Flexibel. Da du nur vorgefertigte Bewegungen hast und ein Richtungswechsel nur am ende eines Bewegungszykluses möglich sind.

2. Berechnen Jedes einselnen Schrittes:
Hierbei handelt es sich um eine Elegante lösung, die aber viel Rechenaufwand benötig, hierbei solltest du einen µC nur für die Berechnugnen nehmen, dem dann die Richtungsänderungen, die Vorgenommen werden sollen übermittelt werden.
Im 2. Fall rechnet der µC die selben Rechnungen, die du im 1. Fall mit der Hand ausgerechnet hättest. Nur dass du den Vorteil hast, dass du hierbei auf die Sensordaten (z.B. Unebenheiten des Untergrundes) eingehen und so auch mitten in einem Schritt einen Richtungswechsel vornehmen kannst oder die höhe des Fußes dem Untergrund anpassen kannst.


Hoffe ich konnte die helfen.

mfg robin