I’m trying to program quad wheels for 4 vex motors to allow straifing during a match. ill post what i have for the Competition code below, but otherwise i am at a loss. I already attempted to program quad wheels in RobotC, however they just ended up messing up the general control of the wheels.
The Code
task main()
{
bMotorFlippedMode[port2] = true;
while (1 == 1)
{
///quad wheels
motor[port1] = vexRT(Ch3);
motor[port2] = vexRT(Ch3);
motor[port9] = vexRT(Ch2);
motor[port10] = vexRT(Ch2);
///straifing
///motor[port1] = vexRT(Ch4);
///motor[port2] = vexRT(Ch4);
///motor[port9] = vexRT(Ch1);
///motor[port10] = vexRT(Ch1);
///arm control
if (vexRT[Btn5U] == 1)
{
motor[port5] = -127;
motor[port6] = 127;
motor[port7] = 127;
motor[port8] = 127;
}
else if (vexRT[Btn5D] == 1)
{
motor[port5] = 127;
motor[port6] = -127;
motor[port7] = -127;
motor[port8] = -127;
}
///claw control
else if (vexRT[Btn6D] == 1)
{
motor[port3] = -127;
}
else if (vexRT[Btn6U] == 1)
{
motor[port3] = 127;
}
else
{
motor[port3] = 0;
motor[port5] = 0;
motor[port6] = 0;
motor[port7] = 0;
motor[port8] = 0;
}
}
}