One issue we forgot was to enable the PIDControllers, so you should enable the PIDControllers if they aren't enabled already.