Die Funktion "getDesSpeedLeft()" liest die Umdrehungen pro Minute deines Linken Rades aus, aus der du dann mit dem Radius deins Rades (ca. 2,7 cm?) deine Wegstrecke berechnen kannst. Ich hab mal versucht mit "getDesSpeedLeft()" die Umdrehungen auszulesen und es scheint zu funktionieren.
Code:
#include "RP6RobotBaseLib.h"
int main(void)
{
initRobotBase(); // Mikrocontroller initialisieren
powerON(); // Encoder und Motorstromsensoren anschalten (WICHTIG!!!)
moveAtSpeed(70,70); // Geschwindigkeit einstellen
startStopwatch1();
while(true)
{
// Aus der Hauptschleife ständig die motionControl Funktion
// aufrufen – sie regelt die Motorgeschwindigkeiten:
task_motionControl();
task_ADC(); // Wird wegen den Motorstromsensoren aufgerufen!
if (getStopwatch1() > 1000)
{
writeString_P("Umdrehungen: ");
writeInteger(getDesSpeedLeft(), DEC);
writeString_P(" U/min \n");
setStopwatch1(0);
}
}
return 0;
}
Wenn du etwas mehr von deinem Programmcode gezeigt hättest, hätte man auch nach dem Fehler suchen können.
Grüße
Lesezeichen