mirror of https://github.com/ArduPilot/ardupilot
123 lines
3.2 KiB
C++
123 lines
3.2 KiB
C++
/// @file AP_LandingGear.h
|
|
/// @brief Landing gear control library
|
|
#pragma once
|
|
|
|
#include <AP_Param/AP_Param.h>
|
|
#include <AP_Common/AP_Common.h>
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL
|
|
#define DEFAULT_PIN_WOW 8
|
|
#define DEFAULT_PIN_WOW_POL 1
|
|
#else
|
|
#define DEFAULT_PIN_WOW -1
|
|
#define DEFAULT_PIN_WOW_POL 0
|
|
#endif
|
|
|
|
/// @class AP_LandingGear
|
|
/// @brief Class managing the control of landing gear
|
|
class AP_LandingGear {
|
|
public:
|
|
AP_LandingGear() {
|
|
// setup parameter defaults
|
|
AP_Param::setup_object_defaults(this, var_info);
|
|
|
|
if (_singleton != nullptr) {
|
|
AP_HAL::panic("AP_LandingGear must be singleton");
|
|
}
|
|
_singleton = this;
|
|
}
|
|
|
|
/* Do not allow copies */
|
|
AP_LandingGear(const AP_LandingGear &other) = delete;
|
|
AP_LandingGear &operator=(const AP_LandingGear&) = delete;
|
|
|
|
// get singleton instance
|
|
static AP_LandingGear *instance(void) {
|
|
return _singleton;
|
|
}
|
|
|
|
// Gear command modes
|
|
enum LandingGearCommand {
|
|
LandingGear_Retract,
|
|
LandingGear_Deploy,
|
|
};
|
|
|
|
// Gear command modes
|
|
enum LandingGearStartupBehaviour {
|
|
LandingGear_Startup_WaitForPilotInput = 0,
|
|
LandingGear_Startup_Retract = 1,
|
|
LandingGear_Startup_Deploy = 2,
|
|
};
|
|
|
|
/// initialise state of landing gear
|
|
void init();
|
|
|
|
/// returns true if the landing gear is deployed
|
|
bool deployed();
|
|
|
|
enum LG_LandingGear_State {
|
|
LG_UNKNOWN = -1,
|
|
LG_RETRACTED = 0,
|
|
LG_DEPLOYED = 1,
|
|
LG_RETRACTING = 2,
|
|
LG_DEPLOYING = 3,
|
|
};
|
|
/// returns detailed state of gear
|
|
LG_LandingGear_State get_state();
|
|
|
|
enum LG_WOW_State {
|
|
LG_WOW_UNKNOWN = -1,
|
|
LG_NO_WOW = 0,
|
|
LG_WOW = 1,
|
|
};
|
|
|
|
LG_WOW_State get_wow_state();
|
|
|
|
/// set landing gear position to retract, deploy or deploy-and-keep-deployed
|
|
void set_position(LandingGearCommand cmd);
|
|
|
|
uint32_t get_gear_state_duration_ms();
|
|
uint32_t get_wow_state_duration_ms();
|
|
|
|
static const struct AP_Param::GroupInfo var_info[];
|
|
|
|
void update(float height_above_ground_m);
|
|
|
|
bool check_before_land(void);
|
|
|
|
private:
|
|
// Parameters
|
|
AP_Int8 _startup_behaviour; // start-up behaviour (see LandingGearStartupBehaviour)
|
|
|
|
AP_Int8 _pin_deployed;
|
|
AP_Int8 _pin_deployed_polarity;
|
|
AP_Int8 _pin_weight_on_wheels;
|
|
AP_Int8 _pin_weight_on_wheels_polarity;
|
|
AP_Int16 _deploy_alt;
|
|
AP_Int16 _retract_alt;
|
|
|
|
// internal variables
|
|
bool _deployed; // true if the landing gear has been deployed, initialized false
|
|
bool _have_changed; // have we changed the servo state?
|
|
|
|
int16_t _last_height_above_ground;
|
|
|
|
// debounce
|
|
LG_WOW_State wow_state_current = LG_WOW_UNKNOWN;
|
|
uint32_t last_wow_event_ms;
|
|
|
|
LG_LandingGear_State gear_state_current = LG_UNKNOWN;
|
|
uint32_t last_gear_event_ms;
|
|
|
|
/// retract - retract landing gear
|
|
void retract();
|
|
|
|
/// deploy - deploy the landing gear
|
|
void deploy();
|
|
|
|
// log weight on wheels state
|
|
void log_wow_state(LG_WOW_State state);
|
|
|
|
static AP_LandingGear *_singleton;
|
|
};
|