Working mecanum code

[Robototes2412]

Hey, I have some working mecanum code to offer up to the masses, look under WesleyCrusher.java for the checkingDrive function, which does the mecanum calculations as refrenced in JeanLucPicard.java

If anyone has any ideas on how to improve this, let me know, :D