Code:
double strafe = mainStick.getRawAxis(3);
double forward = mainStick.getRawAxis(1);
double rotation = mainStick.getRawAxis(2);
//mecanum algotrithms
double mFL = strafe + forward + rotation;
double mFR = strafe + forward - rotation;
double mRL = strafe - forward + rotation;
double mRR = strafe - forward - rotation;
FL.set(mFL);
FR.set(mFR);
RL.set(mRL);
RR.set(mRR);
This is my code for regular driving for mecanum but I feel that if I inverted the motot not everything else would be the same.