Commit 9969d92e authored by maruggv's avatar maruggv
Browse files

another correction... :)

parent 530dd0ff
......@@ -673,7 +673,7 @@ void calculateControlOutput_viaLQRforRates(float stateErrorBody[12], Controller:
{
for(int i=0; i < 3; i++)
{
integrator_var[i] -= stateErrorBody[i]*(1.0/control_frequency) + integrator_var[i];
integrator_var[i] += stateErrorBody[i]*(1.0/control_frequency);
}
}
......
Supports Markdown
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