diff --git a/pps_ws/src/d_fall_pps/src/CustomControllerService.cpp b/pps_ws/src/d_fall_pps/src/CustomControllerService.cpp index 66fdafef910e2a97c01db9e2b380aece8e320b75..10329a2a7778169bdbc6ae93f9b219dc86d5df87 100644 --- a/pps_ws/src/d_fall_pps/src/CustomControllerService.cpp +++ b/pps_ws/src/d_fall_pps/src/CustomControllerService.cpp @@ -256,8 +256,8 @@ ros::Subscriber xyz_yaw_to_follow_subscriber; // CONTROLLER COMPUTATIONS bool calculateControlOutput(Controller::Request &request, Controller::Response &response); -void calculateControlOutput_viaLQRforRates(stateErrorBody, Controller::Request &request, Controller::Response &response); -void calculateControlOutput_viaLQRforAngles(stateErrorBody, Controller::Request &request, Controller::Response &response); +void calculateControlOutput_viaLQRforRates(float stateErrorBody[9], Controller::Request &request, Controller::Response &response); +void calculateControlOutput_viaLQRforAngles(float stateErrorBody[9], Controller::Request &request, Controller::Response &response); // TRANSFORMATION OF THE (x,y) INERTIAL FRAME ERROR INTO AN (x,y) BODY FRAME ERROR void convertIntoBodyFrame(float stateInertial[9], float (&stateBody)[9], float yaw_measured); @@ -613,7 +613,7 @@ bool calculateControlOutput(Controller::Request &request, Controller::Response & -void calculateControlOutput_viaLQRforRates(stateErrorBody, Controller::Request &request, Controller::Response &response) +void calculateControlOutput_viaLQRforRates(float stateErrorBody[9], Controller::Request &request, Controller::Response &response) { // ********************** // Y Y A W W @@ -737,7 +737,7 @@ void calculateControlOutput_viaLQRforRates(stateErrorBody, Controller::Request & -void calculateControlOutput_viaLQRforAngles(stateErrorBody, Controller::Request &request, Controller::Response &response) +void calculateControlOutput_viaLQRforAngles(float stateErrorBody[9], Controller::Request &request, Controller::Response &response) { // ********************** // Y Y A W W