6 motor mechanum drive

Using VexCodePro with a basic Robot Configuration

Then referencing @Codec’s example here but transformed to use motor groups in the rear:

void usercontrol(void) {
  // User control code here, inside the loop
  while (1) {
    int forward = Controller1.Axis3.position(vex::percent);
    int sideways = Controller1.Axis4.position(vex::percent);
    int turn = Controller1.Axis1.position(vex::percent);

    RF.spin(vex::forward, forward - sideways + turn, vex::percent);
    LF.spin(vex::forward,  forward + sideways - turn, vex::percent);
    RRGroup.spin(vex::forward,  forward + sideways + turn, vex::percent);
    LRGroup.spin(vex::forward,   forward - sideways - turn, vex::percent);

    wait(20, msec); 
  }
}
3 Likes