To receive notifications about scheduled maintenance, please subscribe to the mailing-list gitlab-operations@sympa.ethz.ch. You can subscribe to the mailing-list at https://sympa.ethz.ch

Commit e2544b0d authored by beuchatp's avatar beuchatp
Browse files

u=Kxi restored, with old estimate

parent 16c40841
......@@ -615,12 +615,11 @@ void display_control_agent1( Controller::Request &request, Controller::Response
void centralized_control_command( Controller::Request &request, Controller::Response &response)
{
// Estimator update
estimator_state_prev = centralized_controller.Phi * estimator_state_prev + centralized_controller.Gamma * y_to_controller;
// Control output
Eigen::Matrix<float,12,1> u = centralized_controller.K * estimator_state_prev;
// Estimator update
estimator_state_prev = centralized_controller.Phi * estimator_state_prev + centralized_controller.Gamma * y_to_controller;
// extract motor command from u:
float thrustSum = 0.0;
float outRoll = 0.0;
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment