mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-25 03:13:34 +08:00
FlightTaskManual: switch to camel case
This commit is contained in:
committed by
Beat Küng
parent
3b8c718971
commit
10a50dd97e
@@ -61,7 +61,7 @@ bool FlightTaskManualAltitude::activate()
|
|||||||
return FlightTaskManual::activate();
|
return FlightTaskManual::activate();
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualAltitude::scale_sticks()
|
void FlightTaskManualAltitude::scaleSticks()
|
||||||
{
|
{
|
||||||
|
|
||||||
/* map stick to velocity */
|
/* map stick to velocity */
|
||||||
@@ -71,7 +71,7 @@ void FlightTaskManualAltitude::scale_sticks()
|
|||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualAltitude::update_heading_setpoints()
|
void FlightTaskManualAltitude::updateHeadingSetpoints()
|
||||||
{
|
{
|
||||||
if (fabsf(_sticks(3)) < FLT_EPSILON) {
|
if (fabsf(_sticks(3)) < FLT_EPSILON) {
|
||||||
/* want to hold yaw */
|
/* want to hold yaw */
|
||||||
@@ -85,7 +85,7 @@ void FlightTaskManualAltitude::update_heading_setpoints()
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualAltitude::update_z_setpoints()
|
void FlightTaskManualAltitude::updateZsetpoints()
|
||||||
{
|
{
|
||||||
if (fabsf(_sticks(2)) < FLT_EPSILON) {
|
if (fabsf(_sticks(2)) < FLT_EPSILON) {
|
||||||
/* want to hold altitude */
|
/* want to hold altitude */
|
||||||
@@ -99,16 +99,16 @@ void FlightTaskManualAltitude::update_z_setpoints()
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualAltitude::update_setpoints()
|
void FlightTaskManualAltitude::updateSetpoints()
|
||||||
{
|
{
|
||||||
update_heading_setpoints();
|
updateHeadingSetpoints();
|
||||||
update_z_setpoints();
|
updateZsetpoints();
|
||||||
}
|
}
|
||||||
|
|
||||||
bool FlightTaskManualAltitude::update()
|
bool FlightTaskManualAltitude::update()
|
||||||
{
|
{
|
||||||
scale_sticks();
|
scaleSticks();
|
||||||
update_setpoints();
|
updateSetpoints();
|
||||||
|
|
||||||
|
|
||||||
_setPositionSetpoint(Vector3f(NAN, NAN, _pos_sp_z));
|
_setPositionSetpoint(Vector3f(NAN, NAN, _pos_sp_z));
|
||||||
|
|||||||
@@ -64,12 +64,12 @@ protected:
|
|||||||
control::BlockParamFloat _vel_max_up; /**< maximum speed allowed to go down */
|
control::BlockParamFloat _vel_max_up; /**< maximum speed allowed to go down */
|
||||||
control::BlockParamFloat _yaw_rate_scaling; /**< scaling factor from stick to yaw rate */
|
control::BlockParamFloat _yaw_rate_scaling; /**< scaling factor from stick to yaw rate */
|
||||||
|
|
||||||
virtual void update_setpoints(); /**< updates all setpoints */
|
virtual void updateSetpoints(); /**< updates all setpoints */
|
||||||
virtual void scale_sticks(); /**< scales sticks to velocity */
|
virtual void scaleSticks(); /**< scales sticks to velocity */
|
||||||
|
|
||||||
private:
|
private:
|
||||||
void update_heading_setpoints(); /**< sets yaw or yaw speed */
|
void updateHeadingSetpoints(); /**< sets yaw or yaw speed */
|
||||||
void update_z_setpoints(); /**< sets position or velocity setpoint */
|
void updateZsetpoints(); /**< sets position or velocity setpoint */
|
||||||
|
|
||||||
float _pos_sp_predicted{0.0f}; /**< position setpoint computed in set_z_setpoints */
|
float _pos_sp_predicted{0.0f}; /**< position setpoint computed in set_z_setpoints */
|
||||||
float _yaw_sp_predicted{0.0f}; /**< yaw setpoint computed in set_heading_setpoints */
|
float _yaw_sp_predicted{0.0f}; /**< yaw setpoint computed in set_heading_setpoints */
|
||||||
|
|||||||
@@ -57,10 +57,10 @@ bool FlightTaskManualPosition::activate()
|
|||||||
return FlightTaskManualAltitude::activate();
|
return FlightTaskManualAltitude::activate();
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualPosition::scale_sticks()
|
void FlightTaskManualPosition::scaleSticks()
|
||||||
{
|
{
|
||||||
/* scale all sticks including altitude and yaw */
|
/* scale all sticks including altitude and yaw */
|
||||||
FlightTaskManualAltitude::scale_sticks();
|
FlightTaskManualAltitude::scaleSticks();
|
||||||
|
|
||||||
matrix::Vector2f stick_xy(_sticks_expo(0), _sticks_expo(1));
|
matrix::Vector2f stick_xy(_sticks_expo(0), _sticks_expo(1));
|
||||||
|
|
||||||
@@ -76,7 +76,7 @@ void FlightTaskManualPosition::scale_sticks()
|
|||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualPosition::update_xy_setpoints()
|
void FlightTaskManualPosition::updateXYsetpoints()
|
||||||
{
|
{
|
||||||
matrix::Vector2f stick_xy(_sticks_expo(0), _sticks_expo(1));
|
matrix::Vector2f stick_xy(_sticks_expo(0), _sticks_expo(1));
|
||||||
|
|
||||||
@@ -92,21 +92,21 @@ void FlightTaskManualPosition::update_xy_setpoints()
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void FlightTaskManualPosition::update_setpoints()
|
void FlightTaskManualPosition::updateSetpoints()
|
||||||
{
|
{
|
||||||
/* scale all sticks */
|
/* scale all sticks */
|
||||||
scale_sticks();
|
scaleSticks();
|
||||||
|
|
||||||
/* update all setpoints */
|
/* update all setpoints */
|
||||||
FlightTaskManualAltitude::update_setpoints();
|
FlightTaskManualAltitude::updateSetpoints();
|
||||||
update_xy_setpoints();
|
updateXYsetpoints();
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
bool FlightTaskManualPosition::update()
|
bool FlightTaskManualPosition::update()
|
||||||
{
|
{
|
||||||
scale_sticks();
|
scaleSticks();
|
||||||
update_setpoints();
|
updateSetpoints();
|
||||||
|
|
||||||
_setPositionSetpoint(Vector3f(_pos_sp_xy(0), _pos_sp_xy(1), _pos_sp_z));
|
_setPositionSetpoint(Vector3f(_pos_sp_xy(0), _pos_sp_xy(1), _pos_sp_z));
|
||||||
_setVelocitySetpoint(Vector3f(_vel_sp_xy(0), _vel_sp_xy(1), _vel_sp_z));
|
_setVelocitySetpoint(Vector3f(_vel_sp_xy(0), _vel_sp_xy(1), _vel_sp_z));
|
||||||
|
|||||||
@@ -59,11 +59,11 @@ protected:
|
|||||||
|
|
||||||
control::BlockParamFloat _vel_xy_manual_max; /**< maximum speed allowed horizontally */
|
control::BlockParamFloat _vel_xy_manual_max; /**< maximum speed allowed horizontally */
|
||||||
|
|
||||||
void update_setpoints() override;
|
void updateSetpoints() override;
|
||||||
void scale_sticks() override;
|
void scaleSticks() override;
|
||||||
|
|
||||||
private:
|
private:
|
||||||
void update_xy_setpoints();
|
void updateXYsetpoints();
|
||||||
|
|
||||||
matrix::Vector2f _pos_sp_predicted{}; /**< position setpoint computed in set_xy_setpoints */
|
matrix::Vector2f _pos_sp_predicted{}; /**< position setpoint computed in set_xy_setpoints */
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user