Hmmm... Ich lasse mir nun das fertige Array zusenden und versuche es auch gleich zu verarbeiten.
Das Zurücksenden klappt super, aber der Befehl wird nicht ausgeführt... ???
Hier die Ausgabe, wenn ich die zwei momentan möglichen Befehle 1 (fahren) und 7 (stoppen) sende:
("1" erwartet dann natürlich noch die Geschwindigkeiten der rechten und linken Kette und die Fahrtrichtung)
Code:
WIFI COMMAND MODE ACTIVE
#7:2*
Params:7|2|-1|-1|-1|-1
#1:20:20:0:4*
Params:1|20|20|0|4|-1
Der Code, den ich zu der Funktion aus dem letzten Beitrag hinzugefügt habe:
Code:
#define CMD_SET_SPEED 1
#define CMD_SET_STOP 7
...
else if(!behaviour_command_interpreter()) // Call behaviour control interpreter code
{
cmdsplit();
switch(params[0])
{
case CMD_SET_SPEED:
moveAtSpeed(params[1],params[2]);
changeDirection(params[3]);
break;
case CMD_SET_STOP:
stop();
break;
}
//Hier wird mal getestet, ob auch alles richtig im params-Array drinnen steht:
writeString_P_WIFI("\nParams:");writeInteger_WIFI(params[0],DEC);
writeString_P_WIFI("|");writeInteger_WIFI(params[1],DEC);
writeString_P_WIFI("|");writeInteger_WIFI(params[2],DEC);
writeString_P_WIFI("|");writeInteger_WIFI(params[3],DEC);
writeString_P_WIFI("|");writeInteger_WIFI(params[4],DEC);
writeString_P_WIFI("|");writeInteger_WIFI(params[5],DEC);
writeString_P_WIFI("\n");
}
Lesezeichen