Controlling mecanum wheel drivetrain efficiently with code that can be reused in robotplus and bot-specific code in the opmode.
Tested and it does run on the robot, albeit there were issues connecting to motor controllers so while forward and backware motion works, and side to side motion should work and seemed like it would, we still need to do more testing.
Accomplished: