tested the mecanum code, the twist action is wrong in the code somehow or FIRSTs base code