
Re: First Robot, First Problems
Here is the code I used
#pragma config(Hubs, S1, HTMotor, HTServo, none, none)
#pragma config(Motor, mtr_S1_C1_1, motorD, tmotorNormal, openLoop, reversed)
#pragma config(Motor, mtr_S1_C1_2, motorE, tmotorNormal, openLoop)
#pragma config(Servo, srvo_S1_C2_1, servo1, tServoNone)
#pragma config(Servo, srvo_S1_C2_2, servo2, tServoNone)
#pragma config(Servo, srvo_S1_C2_3, servo3, tServoNone)
#pragma config(Servo, srvo_S1_C2_4, servo4, tServoNone)
#pragma config(Servo, srvo_S1_C2_5, servo5, tServoNone)
#pragma config(Servo, srvo_S1_C2_6, servo6, tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
task main()
{
//go forward for 2 seconds
motor[motorD]=15;
motor[motorE]=15;
wait1Msec(2000);
//stop for 1 second
motor[motorD]=0;
motor[motorE]=0;
wait1Msec(1000);
//turn around
motor[motorD]=90;
motor[motorE]=-90;
wait1Msec(1000);
//stop for 1 second
motor[motorD] = 0;
motor[motorE] = 0;
wait1Msec(1000);
//go forward for 2 seconds
motor[motorD]=15;
motor[motorE]=15;
wait1Msec(2000);
//stop
motor[motorD] = 0;
motor[motorE] = 0;
}
and I attaced a pic of the entire thing