Index: firmware/App/Services/PIControllers.c =================================================================== diff -u -r9d4666bf3064df18a6d935125d7a69e4e8234e84 -rf9b8b75c3686be892799b5446b955fd36ab49fa3 --- firmware/App/Services/PIControllers.c (.../PIControllers.c) (revision 9d4666bf3064df18a6d935125d7a69e4e8234e84) +++ firmware/App/Services/PIControllers.c (.../PIControllers.c) (revision f9b8b75c3686be892799b5446b955fd36ab49fa3) @@ -78,10 +78,10 @@ void initializePIController( PI_CONTROLLER_ID_T controllerID, F32 initialControlSignal, F32 kP, F32 kI, F32 controlMin, F32 controlMax ) { - PI_CONTROLLER_T *controller; - if ( controllerID < NUM_OF_PI_CONTROLLERS_IDS ) { + PI_CONTROLLER_T *controller; + SET_CONTROLLER( controller, controllerID ); controller->Kp = kP;