ardupilot/libraries/AP_LandingGear/AP_LandingGear.h

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;
};