Switch to custom mecanum calculation