mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
Rename parameter MPC_OBS_AVOID to COM_OBS_AVOID and change the location to commander.
This commit is contained in:
@@ -55,8 +55,8 @@ px4_add_board(
|
|||||||
logger
|
logger
|
||||||
mavlink
|
mavlink
|
||||||
#mc_att_control
|
#mc_att_control
|
||||||
mc_pos_control
|
#mc_pos_control
|
||||||
navigator
|
#navigator
|
||||||
position_estimator_inav
|
position_estimator_inav
|
||||||
#sensors
|
#sensors
|
||||||
#vmount
|
#vmount
|
||||||
|
|||||||
@@ -227,7 +227,7 @@ bool FlightTaskAuto::_evaluateTriplets()
|
|||||||
_mission_gear = _sub_triplet_setpoint->get().current.landing_gear;
|
_mission_gear = _sub_triplet_setpoint->get().current.landing_gear;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (MPC_OBS_AVOID.get() && _sub_vehicle_status->get().is_rotary_wing) {
|
if (COM_OBS_AVOID.get() && _sub_vehicle_status->get().is_rotary_wing) {
|
||||||
_checkAvoidanceProgress();
|
_checkAvoidanceProgress();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -109,7 +109,7 @@ protected:
|
|||||||
(ParamFloat<px4::params::MPC_CRUISE_90>) MPC_CRUISE_90, // speed at corner when angle is 90 degrees move to line
|
(ParamFloat<px4::params::MPC_CRUISE_90>) MPC_CRUISE_90, // speed at corner when angle is 90 degrees move to line
|
||||||
(ParamFloat<px4::params::NAV_MC_ALT_RAD>) NAV_MC_ALT_RAD, //vertical acceptance radius at which waypoints are updated
|
(ParamFloat<px4::params::NAV_MC_ALT_RAD>) NAV_MC_ALT_RAD, //vertical acceptance radius at which waypoints are updated
|
||||||
(ParamInt<px4::params::MPC_YAW_MODE>) MPC_YAW_MODE, // defines how heading is executed,
|
(ParamInt<px4::params::MPC_YAW_MODE>) MPC_YAW_MODE, // defines how heading is executed,
|
||||||
(ParamInt<px4::params::MPC_OBS_AVOID>) MPC_OBS_AVOID // obstacle avoidance active
|
(ParamInt<px4::params::COM_OBS_AVOID>) COM_OBS_AVOID // obstacle avoidance active
|
||||||
);
|
);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
|||||||
@@ -118,7 +118,7 @@ private:
|
|||||||
(ParamInt<px4::params::COM_LOW_BAT_ACT>) _low_bat_action,
|
(ParamInt<px4::params::COM_LOW_BAT_ACT>) _low_bat_action,
|
||||||
(ParamFloat<px4::params::COM_DISARM_LAND>) _disarm_when_landed_timeout,
|
(ParamFloat<px4::params::COM_DISARM_LAND>) _disarm_when_landed_timeout,
|
||||||
|
|
||||||
(ParamInt<px4::params::MPC_OBS_AVOID>) _obs_avoid
|
(ParamInt<px4::params::COM_OBS_AVOID>) _obs_avoid
|
||||||
)
|
)
|
||||||
|
|
||||||
const int64_t POSVEL_PROBATION_MIN = 1_s; /**< minimum probation duration (usec) */
|
const int64_t POSVEL_PROBATION_MIN = 1_s; /**< minimum probation duration (usec) */
|
||||||
|
|||||||
@@ -811,3 +811,12 @@ PARAM_DEFINE_INT32(NAV_DLL_ACT, 0);
|
|||||||
* @group Mission
|
* @group Mission
|
||||||
*/
|
*/
|
||||||
PARAM_DEFINE_INT32(NAV_RCL_ACT, 2);
|
PARAM_DEFINE_INT32(NAV_RCL_ACT, 2);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Flag to enable obstacle avoidance
|
||||||
|
* Temporary Parameter to enable interface testing
|
||||||
|
*
|
||||||
|
* @boolean
|
||||||
|
* @group Mission
|
||||||
|
*/
|
||||||
|
PARAM_DEFINE_INT32(COM_OBS_AVOID, 0);
|
||||||
|
|||||||
@@ -160,7 +160,7 @@ private:
|
|||||||
(ParamInt<px4::params::MPC_AUTO_MODE>) MPC_AUTO_MODE,
|
(ParamInt<px4::params::MPC_AUTO_MODE>) MPC_AUTO_MODE,
|
||||||
(ParamInt<px4::params::MPC_ALT_MODE>) MPC_ALT_MODE,
|
(ParamInt<px4::params::MPC_ALT_MODE>) MPC_ALT_MODE,
|
||||||
(ParamFloat<px4::params::MPC_SPOOLUP_TIME>) MPC_SPOOLUP_TIME, /**< time to let motors spool up after arming */
|
(ParamFloat<px4::params::MPC_SPOOLUP_TIME>) MPC_SPOOLUP_TIME, /**< time to let motors spool up after arming */
|
||||||
(ParamInt<px4::params::MPC_OBS_AVOID>) MPC_OBS_AVOID, /**< enable obstacle avoidance */
|
(ParamInt<px4::params::COM_OBS_AVOID>) COM_OBS_AVOID, /**< enable obstacle avoidance */
|
||||||
(ParamFloat<px4::params::MPC_TILTMAX_LND>) MPC_TILTMAX_LND /**< maximum tilt for landing and smooth takeoff */
|
(ParamFloat<px4::params::MPC_TILTMAX_LND>) MPC_TILTMAX_LND /**< maximum tilt for landing and smooth takeoff */
|
||||||
);
|
);
|
||||||
|
|
||||||
@@ -1141,7 +1141,7 @@ void
|
|||||||
MulticopterPositionControl::update_avoidance_waypoint_desired(PositionControlStates &states,
|
MulticopterPositionControl::update_avoidance_waypoint_desired(PositionControlStates &states,
|
||||||
vehicle_local_position_setpoint_s &setpoint)
|
vehicle_local_position_setpoint_s &setpoint)
|
||||||
{
|
{
|
||||||
if (MPC_OBS_AVOID.get()) {
|
if (COM_OBS_AVOID.get()) {
|
||||||
_traj_wp_avoidance_desired = _flight_tasks.getAvoidanceWaypoint();
|
_traj_wp_avoidance_desired = _flight_tasks.getAvoidanceWaypoint();
|
||||||
_traj_wp_avoidance_desired.timestamp = hrt_absolute_time();
|
_traj_wp_avoidance_desired.timestamp = hrt_absolute_time();
|
||||||
_traj_wp_avoidance_desired.type = vehicle_trajectory_waypoint_s::MAV_TRAJECTORY_REPRESENTATION_WAYPOINTS;
|
_traj_wp_avoidance_desired.type = vehicle_trajectory_waypoint_s::MAV_TRAJECTORY_REPRESENTATION_WAYPOINTS;
|
||||||
@@ -1193,7 +1193,7 @@ MulticopterPositionControl::reset_setpoint_to_nan(vehicle_local_position_setpoin
|
|||||||
bool
|
bool
|
||||||
MulticopterPositionControl::use_obstacle_avoidance()
|
MulticopterPositionControl::use_obstacle_avoidance()
|
||||||
{
|
{
|
||||||
if (MPC_OBS_AVOID.get()) {
|
if (COM_OBS_AVOID.get()) {
|
||||||
const bool avoidance_data_timeout = hrt_elapsed_time((hrt_abstime *)&_traj_wp_avoidance.timestamp) > TRAJECTORY_STREAM_TIMEOUT_US;
|
const bool avoidance_data_timeout = hrt_elapsed_time((hrt_abstime *)&_traj_wp_avoidance.timestamp) > TRAJECTORY_STREAM_TIMEOUT_US;
|
||||||
const bool avoidance_point_valid = _traj_wp_avoidance.waypoints[vehicle_trajectory_waypoint_s::POINT_0].point_valid == true;
|
const bool avoidance_point_valid = _traj_wp_avoidance.waypoints[vehicle_trajectory_waypoint_s::POINT_0].point_valid == true;
|
||||||
const bool in_mission = _vehicle_status.nav_state == vehicle_status_s::NAVIGATION_STATE_AUTO_MISSION;
|
const bool in_mission = _vehicle_status.nav_state == vehicle_status_s::NAVIGATION_STATE_AUTO_MISSION;
|
||||||
|
|||||||
@@ -705,16 +705,7 @@ PARAM_DEFINE_INT32(MPC_AUTO_MODE, 1);
|
|||||||
PARAM_DEFINE_FLOAT(MPC_SPOOLUP_TIME, 0.0f);
|
PARAM_DEFINE_FLOAT(MPC_SPOOLUP_TIME, 0.0f);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Flag to enable obstacle avoidance
|
* Yaw mode.
|
||||||
* Temporary Parameter to enable interface testing
|
|
||||||
*
|
|
||||||
* @boolean
|
|
||||||
* @group Multicopter Position Control
|
|
||||||
*/
|
|
||||||
PARAM_DEFINE_INT32(MPC_OBS_AVOID, 0);
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Yaw mode
|
|
||||||
*
|
*
|
||||||
* Specifies the heading in Auto.
|
* Specifies the heading in Auto.
|
||||||
*
|
*
|
||||||
@@ -727,4 +718,3 @@ PARAM_DEFINE_INT32(MPC_OBS_AVOID, 0);
|
|||||||
* @group Mission
|
* @group Mission
|
||||||
*/
|
*/
|
||||||
PARAM_DEFINE_INT32(MPC_YAW_MODE, 0);
|
PARAM_DEFINE_INT32(MPC_YAW_MODE, 0);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user