Code: #pragma config(Motor, motorA, , tmotorNormal, openLoop) #pragma config(Motor, motorC, , tmotorNormal, openLoop) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
//#include "PID.h" #include "Odo.h"
task main() { nMotorEncoder[motorA] = 0; nMotorEncoder[motorC] = 0;
motor[motorA] = (int)(1.0*0.047); motor[motorC] = (int)(1.0 * 0.047); wait1Msec(10); writeDebugStreamLine("%d;%d;", motor[motorC],motor[motorA]);//,(int)(1.0 * 0.047));
motor[motorA] = floor(1.0*0.047); motor[motorC] = floor(1.0 * 0.047); wait1Msec(10); writeDebugStreamLine("%d;%d;%d", motor[motorC],motor[motorA],floor(1.0 * 0.047));
motor[motorA] = 0; motor[motorC] = 0; wait1Msec(10); writeDebugStreamLine("%d;%d", motor[motorC],motor[motorA]); wait10Msec(100); writeDebugStreamLine("%d;%d", motor[motorC],motor[motorA]);
}
|