dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Boats: stop motors when commanding zero speed

This commit is contained in:
Matthias Grob 2023-05-03 15:16:42 +02:00
parent d0d113405a
commit e0e5b38c0e
2 changed files with 14 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/modules/control_allocator/ActuatorEffectiveness/ActuatorEffectivenessCustom.cpp
View File

@ -48,9 +48,10 @@ ActuatorEffectivenessCustom::getEffectivenessMatrix(Configuration &configuration
return false;
}
// motors
// Motors
_motors.enablePropellerTorque(false);
const bool motors_added_successfully = _motors.addActuators(configuration);
_motors_mask = _motors.getMotors();
// Torque
const bool torque_added_successfully = _torque.addActuators(configuration);
@ -58,3 +59,9 @@ ActuatorEffectivenessCustom::getEffectivenessMatrix(Configuration &configuration
return (motors_added_successfully && torque_added_successfully);
}
void ActuatorEffectivenessCustom::updateSetpoint(const matrix::Vector<float, NUM_AXES> &control_sp,
int matrix_index, ActuatorVector &actuator_sp, const matrix::Vector<float, NUM_ACTUATORS> &actuator_min,
const matrix::Vector<float, NUM_ACTUATORS> &actuator_max)
{
stopMaskedMotorsWithZeroThrust(_motors_mask, actuator_sp);
}

6
src/modules/control_allocator/ActuatorEffectiveness/ActuatorEffectivenessCustom.hpp
View File

@ -45,9 +45,15 @@ public:
bool getEffectivenessMatrix(Configuration &configuration, EffectivenessUpdateReason external_update) override;
void updateSetpoint(const matrix::Vector<float, NUM_AXES> &control_sp, int matrix_index,
ActuatorVector &actuator_sp, const matrix::Vector<float, NUM_ACTUATORS> &actuator_min,
const matrix::Vector<float, NUM_ACTUATORS> &actuator_max) override;
const char *name() const override { return "Custom"; }
protected:
ActuatorEffectivenessRotors _motors;
ActuatorEffectivenessControlSurfaces _torque;
uint32_t _motors_mask{};
};