9 Servos, Auflösung 1µs --> Wie löse ich das?

[PuraVida]

Hi lokirobotics!

Ja, ich meine die Refreshrate.

Mein Servosignal soll von 750µs bis 2250 µs in 1µs Schritten einstellbar sein. Bei Analogservos alle 20ms (50Hz) und bei DigitalServos alle 3ms (330Hz) wiederholt sich das Signal - der Refresh sozusagen.

Was ich vorhabe soll in etwa so funktionieren: Es bilden immer drei Servos eine Gruppe. Der Benutzer stellt für jeden Servo eine Start und eine Stoppposition ein. Dann stellt er ein mit welcher Geschwindigkeit der Servo von der Start zur Stoppposition fährt. Und außerdem noch, wie lange der 2. Servo wartet nachdem der erste seine Position angefahren ist. All diese Infos sollen in den EEProm.


Wie wirfst Du das Signal auf die Ports? Und wieso ist dann der µC blockiert?

LG

Dann kommt ein Startsignal und der 1. (u. ev. 3.) Servo fährt langsam in seine Endposition, es vergeht eine Pause, und der 2. Servo fährt in seine Endposition.

[lokirobotics]

*kopfklatsch* Klar, alle 20ms sind 50Hz. Ok.

Bei jedem Refresh wird eine Routine angestoßen, die den Inhalt der Servotabelle einfach auf die Ports schmeißt. In der Tabelle sind die Übergangszeiten (sprich von der aktuellen Zeile zur nächsten), sowie die Pin Signale kodiert. Wie du selber sagst, ist die kürzeste Zeit 0,75ms, die Längste 2,25ms. Das ist eine Differenz von 1,5ms. Bei den von dir vorgegebenen Zeitintervallen wäre die maximale Abarbeitungszeit der Tabelle 1,5ms. (Eintrag eins ausgeben, 1,5ms warten, Eintrag zwei Ausgeben, return).

Das ganze andere Zeug (wie schnell bewegen, von wo bis wo) übernehmen dann andere Routinen. Das könnte man jetzt wieder mit einer Tabelle oder Liste lösen (Servoposition zur Zeit t).
Jetzt kann man entweder die ganze Servotabelle vorberechnen, oder man macht es Schrittweise (Animationstabelle mit n Schritten und Servotabelle jeweils neu berechnen).

Ich fahre meine Servos mit 100Hz, die Positionsvorgaben für Animationen kommen von extern über UART, läuft alles super. 330Hz sollten auch drin sein.

[PuraVida]

Bei jedem Refresh wird eine Routine angestoßen, die den Inhalt der Servotabelle einfach auf die Ports schmeißt. In der Tabelle sind die Übergangszeiten (sprich von der aktuellen Zeile zur nächsten), sowie die Pin Signale kodiert. Wie du selber sagst, ist die kürzeste Zeit 0,75ms, die Längste 2,25ms. Das ist eine Differenz von 1,5ms. Bei den von dir vorgegebenen Zeitintervallen wäre die maximale Abarbeitungszeit der Tabelle 1,5ms. (Eintrag eins ausgeben, 1,5ms warten, Eintrag zwei Ausgeben, return).

Die Idee klingt gut. Der µC hätte ja nicht viel zu tun sonst, da stört es nicht weiter wenn mal 1,5ms nix passiert denke ich mir.

Was mir noch gar nicht klar ist, wie Du die Zeit mißt wenn Du jetzt, sagen wir Servo 1 ein Positionssignal von 1500µs schicken willst? Zählst Du da einen Timer mit?

Kann ich mir das so Vorstellen: Die Routine wird aufgerufen und alle Pins wo Servos drauf hängen gehen auf High. Dann läuft ein Zähler im Hintergrund mit. Sagen wir erster Servo 1000µs zweiter Servo 1500 µs. Sobald der Timer auf dem Wert ist der 1000µs entspricht wird der erste Pin auf Low geschaltet. Und wenn der Zählerwert den 1500µs entspricht wird der nächste Pin auf Low gesetzt. So ungefähr?

Wie frägst Du das ab? Mit if? Case? Bekommst Du da keine Zeitprobleme beim Zählerstandvergleich? Wie gesagt dauert 1µs ja gerade mal 16 Takte bei 16Mhz Taktung.

Du hast ja nicht zufällig ein C-Codeschnippsel für mich von der Routine?

LG

[lokirobotics]

Vergleichen muss ich nichts mehr. Die Werte werden, wie gesagt vorberechnet. Das ist dann eine Byte Liste. Die Bytes muss ich dann nur noch Maskieren (welche Servos sollen aktiv sein) und in die Portregister kopieren. Das schafft man in 16 Takten.
Wie ich das Warten umgesetzt habe, kann ich dir aus'm Kopf nicht sagen. Kann sein, dass es eine einfache NOP Schleife ist. Das schau ich zu Hause noch mal nach.

[PuraVida]

Ich glaube, wir reden ein bisl aneinander vorbei. Oder ich kann Dir nicht folgen. *gg*

Bei mir starten drei bis sechs Servos gleichzeitig. Die fahren aber nicht alle den gleichen Endpunkt an sondern jeder einen individuell eingestellten. Das sind die Werte die Du in der Tabelle hast, oder? Ich muß also 6 Ports mal auf High setzen und dann zu unterschiedlichen Zeitpunkten wieder auf Low. Wenn ich Pech habe dann ist das (Hausnummer) 1500, 1501, 1502, 1503,1504, 1506 µs, etc. Ins Portregister schreiben ist klar, sollte sowas wie einen Takt dauern. Aber wie stelle ich fest wann 1500µs vergangen sind um wieder das Portregister zu beschreiben? Und wie, wann 1501µs vergangen sind? Hmm.. mit einer NOP schleife die vorher schon die differenzen kennt und die Servos nach Werten sortiert...

Wäre cool wenn DU nachschauen könntest wie Du das genau gelöst hast. Mir fehlt noch irgendwie der Plan... Naja, Newbie halt.

Aber ich war schon extrem stolz auf meine blinkende LED, ist ja immerhin alles neu für mich.

[lokirobotics]

Ja, du hast es. Die Werte sind vorberechnet, ebenso die Übergangszeiten. Im Idealfall sind die Übergangszeiten schon in Schleifendurchläufe umgerechnet.