Added a main method for mecanum drive only, and fixed problems i had made in mecanumDriveMappingThread, also worked a bit more on 2014 main code