Proxim RangeLAN2 7920 Manual de usuario descargar pdf (Pagina 59)

// Recieve data and feedback.

// printf("1");

sock_tick(&Motorsock,&status);

if (sock_bytesready(&Motorsock)>=0){

x = sock_gets(&Motorsock,MotorBuffer,512);

// printf("%d\n", x);

if(x>3){

sock_tick(&Motorsock,&status);

sprintf(DMotor, "\"%s\"\n",MotorBuffer);

sprintf(MotorBuffer, "\"%s\"\n\n",NULL);

// printf("%s\n", DMotor);

sock_tick(&Motorsock,&status);

// waitfor(DelayMs(50));

sock_puts(&Motorsock,MotorBuffer);

// waitfor(DelayMs(50));

sock_tick(&Motorsock,&status);

// Control motors

DMotor0 = strtok(DMotor, p);

DMotor1 = strtok(NULL, p);

Motor_Desig = atoi(DMotor1);

// printf("Motor_Desig = %d\nn", Motor_Desig);

sock_tick(&Motorsock,&status);

DMotor2 = strtok(NULL, p);

Motor_Speed = atof(DMotor2);

// printf("Speed... Volts out = %f\n\n", Motor_Speed);

sock_tick(&Motorsock,&status);

DMotor3 = strtok(NULL, p);

if (Motor_Desig == 0) /*LEFT*/

LMotor_Speed = Motor_Speed/100;

if (Motor_Desig == 1) /*RIGHT*/

RMotor_Speed = Motor_Speed/100;

if (Motor_Desig == 2){ /*BOTH*/

1 2 ... 54 55 56 57 58 59 60 61 62 63 64 ... 102 103

Sin comentarios

Proxim RangeLAN2 7920 Manual de usuario Pagina 59