StickAccelerationXY: add reseting position to specified coordinates

This commit is contained in:
Matthias Grob 2021-10-05 11:43:53 +02:00 committed by Daniel Agar
parent 578d57a060
commit bb9f167d79
2 changed files with 6 additions and 0 deletions

View File

@ -54,6 +54,11 @@ void StickAccelerationXY::resetPosition()
_position_setpoint.setNaN();
}
void StickAccelerationXY::resetPosition(const matrix::Vector2f &position)
{
_position_setpoint = position;
}
void StickAccelerationXY::resetVelocity(const matrix::Vector2f &velocity)
{
_velocity_setpoint = velocity;

View File

@ -54,6 +54,7 @@ public:
~StickAccelerationXY() = default;
void resetPosition();
void resetPosition(const matrix::Vector2f &position);
void resetVelocity(const matrix::Vector2f &velocity);
void resetAcceleration(const matrix::Vector2f &acceleration);
void generateSetpoints(matrix::Vector2f stick_xy, const float yaw, const float yaw_sp, const matrix::Vector3f &pos,