mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2025-02-12 02:54:15 +01:00
LP-89 - changes to adhere to LP code style and requirements.
This commit is contained in:
parent
d20d1ab295
commit
627185c0ce
@ -41,7 +41,6 @@ extern "C" {
|
|||||||
#include <paths.h>
|
#include <paths.h>
|
||||||
#include "plans.h"
|
#include "plans.h"
|
||||||
#include <stabilizationdesired.h>
|
#include <stabilizationdesired.h>
|
||||||
// #include <pidstatus.h>
|
|
||||||
#include <vtolselftuningstats.h>
|
#include <vtolselftuningstats.h>
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -348,7 +347,6 @@ float PIDControlDown::GetVelocityDesired(void)
|
|||||||
|
|
||||||
float PIDControlDown::GetDownCommand(void)
|
float PIDControlDown::GetDownCommand(void)
|
||||||
{
|
{
|
||||||
// PIDStatusData pidStatus;
|
|
||||||
float ulow = mMinThrust;
|
float ulow = mMinThrust;
|
||||||
float uhigh = mMaxThrust;
|
float uhigh = mMaxThrust;
|
||||||
|
|
||||||
@ -356,17 +354,6 @@ float PIDControlDown::GetDownCommand(void)
|
|||||||
mCallback->BoundThrust(ulow, uhigh);
|
mCallback->BoundThrust(ulow, uhigh);
|
||||||
}
|
}
|
||||||
float downCommand = pid2_apply(&PID, mVelocitySetpointCurrent, mVelocityState, ulow, uhigh);
|
float downCommand = pid2_apply(&PID, mVelocitySetpointCurrent, mVelocityState, ulow, uhigh);
|
||||||
// pidStatus.setpoint = mVelocitySetpointCurrent;
|
|
||||||
// pidStatus.actual = mVelocityState;
|
|
||||||
// pidStatus.error = mVelocitySetpointCurrent - mVelocityState;
|
|
||||||
// pidStatus.setpoint = mVelocitySetpointCurrent;
|
|
||||||
// pidStatus.ulow = ulow;
|
|
||||||
// pidStatus.uhigh = uhigh;
|
|
||||||
// pidStatus.command = downCommand;
|
|
||||||
// pidStatus.P = PID.P;
|
|
||||||
// pidStatus.I = PID.I;
|
|
||||||
// pidStatus.D = PID.D;
|
|
||||||
// PIDStatusSet(&pidStatus);
|
|
||||||
mDownCommand = downCommand;
|
mDownCommand = downCommand;
|
||||||
return mDownCommand;
|
return mDownCommand;
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user