endlesswatts.com
Vex EasyC Custom Drivetrain Code - Endless Watts
The easiest thing to do is to just use the preinstalled drivetrain function that is already in the EasyC library.