NAVEGACIÓN ROBÓTICA CON FISCHERTECHNIK -Teclado de Dirección- (26-Marzo-07)

El siguiente programa hace funcionar el robot utilizando el teclado de dirección para especificar la dirección en la que ha de moverse:

#include "Windows.h"
#include "iostream.h"
#include "conio.h"
#include "stdio.h"
#include "umFish40VC.H"

void main() {

char Ende;
char c;

cout << "Corriendo" << endl;
int iHandle = rbOpenInterfaceUSB(ftROBO_first_USB, 0);

if (iHandle == rbFehler) {
cout << "No se ha podido conectar con la interfaz" << endl;
cin.get(Ende);
return;
}

c=getch();

do{ if(c == 75){ //derecha
rbSetMotor(iHandle,1,0);
rbSetMotor(iHandle,2,1);
Sleep(100);
}

if(c == 77){//izquierda
rbSetMotor(iHandle,2,0);
rbSetMotor(iHandle,1,1);
Sleep(100);
}

if(c == 72){//adelante
rbSetMotor(iHandle,1,1);
rbSetMotor(iHandle,2,1);
Sleep(100);
}

if(c == 80){//atras
rbSetMotor(iHandle,1,2);
rbSetMotor(iHandle,2,2);
Sleep(100);
}

if(c == 15){//parar
rbSetMotor(iHandle,1,0);
rbSetMotor(iHandle,2,0);
}

c=getch();

}while(c!=27);

rbCloseInterface(iHandle);
cout << endl << "Prueba terminada" << endl;
cin.get(Ende);

}