mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-19 07:23:34 +08:00
delete PWM_SERVO_SET_FORCE_FAILSAFE
This commit is contained in:
@@ -194,9 +194,6 @@ typedef uint16_t servo_position_t;
|
||||
/** force safety switch off (to disable use of safety switch) */
|
||||
#define PWM_SERVO_SET_FORCE_SAFETY_OFF _PX4_IOC(_PWM_SERVO_BASE, 25)
|
||||
|
||||
/** force failsafe mode (failsafe values are set immediately even if failsafe condition not met) */
|
||||
#define PWM_SERVO_SET_FORCE_FAILSAFE _PX4_IOC(_PWM_SERVO_BASE, 26)
|
||||
|
||||
/** make failsafe non-recoverable (termination) if it occurs */
|
||||
#define PWM_SERVO_SET_TERMINATION_FAILSAFE _PX4_IOC(_PWM_SERVO_BASE, 27)
|
||||
|
||||
|
||||
@@ -1768,21 +1768,6 @@ int PX4IO::ioctl(file *filep, int cmd, unsigned long arg)
|
||||
ret = io_reg_set(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_FORCE_SAFETY_ON, PX4IO_FORCE_SAFETY_MAGIC);
|
||||
break;
|
||||
|
||||
case PWM_SERVO_SET_FORCE_FAILSAFE:
|
||||
PX4_DEBUG("PWM_SERVO_SET_FORCE_FAILSAFE");
|
||||
|
||||
/* force failsafe mode instantly */
|
||||
if (arg == 0) {
|
||||
/* clear force failsafe flag */
|
||||
ret = io_reg_modify(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_ARMING, PX4IO_P_SETUP_ARMING_FORCE_FAILSAFE, 0);
|
||||
|
||||
} else {
|
||||
/* set force failsafe flag */
|
||||
ret = io_reg_modify(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_ARMING, 0, PX4IO_P_SETUP_ARMING_FORCE_FAILSAFE);
|
||||
}
|
||||
|
||||
break;
|
||||
|
||||
case PWM_SERVO_SET_TERMINATION_FAILSAFE:
|
||||
PX4_DEBUG("PWM_SERVO_SET_TERMINATION_FAILSAFE");
|
||||
|
||||
|
||||
@@ -115,9 +115,6 @@ $ pwm test -c 13 -p 1200
|
||||
PRINT_MODULE_USAGE_COMMAND_DESCR("disarm", "Disarm output");
|
||||
|
||||
PRINT_MODULE_USAGE_COMMAND_DESCR("status", "Print current configuration of all channels");
|
||||
PRINT_MODULE_USAGE_COMMAND_DESCR("forcefail", "Force Failsafe mode. "
|
||||
"PWM outputs are set to failsafe values.");
|
||||
PRINT_MODULE_USAGE_ARG("on|off", "Turn on or off", false);
|
||||
PRINT_MODULE_USAGE_COMMAND_DESCR("terminatefail", "Enable Termination Failsafe mode. "
|
||||
"While this is true, "
|
||||
"any failsafe that occurs will be unrecoverable (even if recovery conditions are met).");
|
||||
@@ -861,30 +858,6 @@ err_out_no_test:
|
||||
|
||||
return 0;
|
||||
|
||||
} else if (!strcmp(command, "forcefail")) {
|
||||
|
||||
if (argc < 3) {
|
||||
PX4_ERR("arg missing [on|off]");
|
||||
return 1;
|
||||
|
||||
} else {
|
||||
|
||||
if (!strcmp(argv[2], "on")) {
|
||||
/* force failsafe */
|
||||
ret = px4_ioctl(fd, PWM_SERVO_SET_FORCE_FAILSAFE, 1);
|
||||
|
||||
} else {
|
||||
/* disable failsafe */
|
||||
ret = px4_ioctl(fd, PWM_SERVO_SET_FORCE_FAILSAFE, 0);
|
||||
}
|
||||
|
||||
if (ret != OK) {
|
||||
PX4_ERR("FAILED setting forcefail %s", argv[2]);
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
} else if (!strcmp(command, "terminatefail")) {
|
||||
|
||||
if (argc < 3) {
|
||||
|
||||
Reference in New Issue
Block a user