Mecanum wheel twist issues.

[zackd97]

Right now the only portion of code that has anything to do with the driving looks like this:

myRobot.MecanumDrive_Cartesian(stick.GetX(), stick.GetY(), stick.GetZ());

stick being the joystick and myRobot being the robot drive.

The ports are initialized as so:

myRobot(1,2,3,4),
stick(1)

The wiring is as follows:
Front left motor- Port 1
Front right motor- Port 2
Back left motor- Port 3
Back right motor- Port 4

EDIT:
I forgot as a side note, the MecanumDrive_Cartesian calls for input from a gyro at the end. That has not been included yet as we are working on getting our gyro mounted and working now.