2013-09-19 03:27:31 -03:00
|
|
|
/*
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
2016-01-29 00:38:21 -04:00
|
|
|
#pragma once
|
2013-09-19 03:27:31 -03:00
|
|
|
|
2015-08-11 03:28:44 -03:00
|
|
|
#include <AP_Common/AP_Common.h>
|
2015-12-01 16:22:26 -04:00
|
|
|
#include <AP_Param/AP_Param.h>
|
2016-01-29 00:38:21 -04:00
|
|
|
#include <GCS_MAVLink/GCS_MAVLink.h>
|
|
|
|
|
|
|
|
#include "NotifyDevice.h"
|
2013-09-19 03:27:31 -03:00
|
|
|
|
2015-12-01 16:22:26 -04:00
|
|
|
// Device parameters values
|
|
|
|
#define RGB_LED_OFF 0
|
|
|
|
#define RGB_LED_LOW 1
|
|
|
|
#define RGB_LED_MEDIUM 2
|
|
|
|
#define RGB_LED_HIGH 3
|
2016-03-31 15:18:52 -03:00
|
|
|
#define BUZZER_ON 1
|
|
|
|
#define BUZZER_OFF 0
|
2015-12-01 16:22:26 -04:00
|
|
|
|
2016-09-30 04:21:28 -03:00
|
|
|
#define NOTIFY_TEXT_BUFFER_SIZE 51
|
|
|
|
|
|
|
|
//Type of on-board display
|
|
|
|
#define DISPLAY_OFF 0
|
|
|
|
#define DISPLAY_SSD1306 1
|
|
|
|
#define DISPLAY_SH1106 2
|
2019-07-05 04:26:55 -03:00
|
|
|
#define DISPLAY_SITL 10
|
2016-09-30 04:21:28 -03:00
|
|
|
|
2013-09-19 03:27:31 -03:00
|
|
|
class AP_Notify
|
|
|
|
{
|
2016-09-30 04:21:28 -03:00
|
|
|
friend class RGBLed; // RGBLed needs access to notify parameters
|
2017-01-19 03:15:24 -04:00
|
|
|
friend class Display; // Display needs access to notify parameters
|
2013-09-19 03:27:31 -03:00
|
|
|
public:
|
2017-12-12 21:06:13 -04:00
|
|
|
AP_Notify();
|
2017-08-23 11:54:39 -03:00
|
|
|
|
|
|
|
/* Do not allow copies */
|
|
|
|
AP_Notify(const AP_Notify &other) = delete;
|
|
|
|
AP_Notify &operator=(const AP_Notify&) = delete;
|
|
|
|
|
2017-12-12 21:06:13 -04:00
|
|
|
// get singleton instance
|
2019-02-10 14:04:10 -04:00
|
|
|
static AP_Notify *get_singleton(void) {
|
|
|
|
return _singleton;
|
2017-12-12 21:06:13 -04:00
|
|
|
}
|
2020-01-19 13:15:15 -04:00
|
|
|
|
2017-06-01 19:08:07 -03:00
|
|
|
// Oreo LED Themes
|
|
|
|
enum Oreo_LED_Theme {
|
|
|
|
OreoLED_Disabled = 0, // Disabled the OLED driver entirely
|
|
|
|
OreoLED_Aircraft = 1, // Standard aviation themed lighting
|
|
|
|
OreoLED_Automobile = 2, // Automobile themed lighting (white front, red back)
|
|
|
|
};
|
2015-12-01 16:22:26 -04:00
|
|
|
|
2018-07-18 21:49:35 -03:00
|
|
|
enum Notify_LED_Type {
|
|
|
|
Notify_LED_None = 0, // not enabled
|
|
|
|
Notify_LED_Board = (1 << 0), // Built in board LED's
|
|
|
|
Notify_LED_ToshibaLED_I2C_Internal = (1 << 1), // Internal ToshibaLED_I2C
|
|
|
|
Notify_LED_ToshibaLED_I2C_External = (1 << 2), // External ToshibaLED_I2C
|
|
|
|
Notify_LED_PCA9685LED_I2C_External = (1 << 3), // External PCA9685_I2C
|
|
|
|
Notify_LED_OreoLED = (1 << 4), // Oreo
|
|
|
|
Notify_LED_UAVCAN = (1 << 5), // UAVCAN RGB LED
|
2018-07-25 09:07:49 -03:00
|
|
|
Notify_LED_NCP5623_I2C_External = (1 << 6), // External NCP5623
|
|
|
|
Notify_LED_NCP5623_I2C_Internal = (1 << 7), // Internal NCP5623
|
2019-04-02 14:56:00 -03:00
|
|
|
Notify_LED_NeoPixel = (1 << 8), // NeoPixel 5050 AdaFruit 1655 SK6812 Worldsemi WS2812B
|
2020-02-22 19:54:57 -04:00
|
|
|
Notify_LED_ProfiLED = (1 << 9), // ProfiLED
|
2020-09-03 10:30:24 -03:00
|
|
|
Notify_LED_Scripting = (1 << 10),// Colour accessor for scripting
|
2021-04-03 19:01:55 -03:00
|
|
|
Notify_LED_DShot = (1 << 11),// Use dshot commands to set ESC LEDs
|
2018-07-18 21:49:35 -03:00
|
|
|
Notify_LED_MAX
|
|
|
|
};
|
|
|
|
|
2014-12-14 23:20:59 -04:00
|
|
|
/// notify_flags_type - bitmask of notification flags
|
2016-09-30 04:21:28 -03:00
|
|
|
struct notify_flags_and_values_type {
|
2018-07-25 22:09:34 -03:00
|
|
|
bool initialising; // true if initialising and the vehicle should not be moved
|
|
|
|
uint8_t gps_status; // see the GPS_0 = no gps, 1 = no lock, 2 = 2d lock, 3 = 3d lock, 4 = dgps lock, 5 = rtk lock
|
|
|
|
uint8_t gps_num_sats; // number of sats
|
|
|
|
uint8_t flight_mode; // flight mode
|
|
|
|
bool armed; // 0 = disarmed, 1 = armed
|
2019-03-01 02:28:05 -04:00
|
|
|
bool flying; // 0 = not flying, 1 = flying/driving/diving/tracking
|
2018-07-25 22:09:34 -03:00
|
|
|
bool pre_arm_check; // true if passing pre arm checks
|
|
|
|
bool pre_arm_gps_check; // true if passing pre arm gps checks
|
|
|
|
bool save_trim; // true if gathering trim data
|
|
|
|
bool esc_calibration; // true if calibrating escs
|
|
|
|
bool failsafe_radio; // true if radio failsafe
|
|
|
|
bool failsafe_battery; // true if battery failsafe
|
2019-10-31 19:10:36 -03:00
|
|
|
bool failsafe_gcs; // true if GCS failsafe
|
2020-09-18 04:38:54 -03:00
|
|
|
bool failsafe_ekf; // true if ekf failsafe
|
2018-07-25 22:09:34 -03:00
|
|
|
bool parachute_release; // true if parachute is being released
|
|
|
|
bool ekf_bad; // true if ekf is reporting problems
|
|
|
|
bool autopilot_mode; // true if vehicle is in an autopilot flight mode (only used by OreoLEDs)
|
|
|
|
bool firmware_update; // true just before vehicle firmware is updated
|
|
|
|
bool compass_cal_running; // true if a compass calibration is running
|
|
|
|
bool leak_detected; // true if leak detected
|
|
|
|
bool gps_fusion; // true if the GPS is in use by EKF, usable for flight
|
|
|
|
bool gps_glitching; // true f the GPS is believed to be glitching is affecting navigation accuracy
|
|
|
|
bool have_pos_abs; // true if absolute position is available
|
|
|
|
bool vehicle_lost; // true when lost copter tone is requested (normally only used for copter)
|
|
|
|
bool waiting_for_throw; // true when copter is in THROW mode and waiting to detect the user hand launch
|
|
|
|
bool powering_off; // true when the vehicle is powering off
|
|
|
|
bool video_recording; // true when the vehicle is recording video
|
2021-01-10 16:09:44 -04:00
|
|
|
bool temp_cal_running; // true if a temperature calibration is running
|
2013-09-19 03:27:31 -03:00
|
|
|
};
|
|
|
|
|
2014-12-14 23:20:04 -04:00
|
|
|
/// notify_events_type - bitmask of active events.
|
|
|
|
// Notify library is responsible for setting back to zero after notification has been completed
|
2014-10-23 09:04:34 -03:00
|
|
|
struct notify_events_type {
|
2016-05-09 04:24:38 -03:00
|
|
|
uint32_t arming_failed : 1; // 1 if copter failed to arm after user input
|
|
|
|
uint32_t user_mode_change : 1; // 1 if user has initiated a flight mode change
|
|
|
|
uint32_t user_mode_change_failed: 1; // 1 when user initiated flight mode change fails
|
|
|
|
uint32_t failsafe_mode_change : 1; // 1 when failsafe has triggered a flight mode change
|
|
|
|
uint32_t autotune_complete : 1; // 1 when autotune has successfully completed
|
|
|
|
uint32_t autotune_failed : 1; // 1 when autotune has failed
|
|
|
|
uint32_t autotune_next_axis : 1; // 1 when autotune has completed one axis and is moving onto the next
|
|
|
|
uint32_t mission_complete : 1; // 1 when the mission has completed successfully
|
|
|
|
uint32_t waypoint_complete : 1; // 1 as vehicle completes a waypoint
|
|
|
|
uint32_t initiated_compass_cal : 1; // 1 when user input to begin compass cal was accepted
|
|
|
|
uint32_t compass_cal_saved : 1; // 1 when compass calibration was just saved
|
|
|
|
uint32_t compass_cal_failed : 1; // 1 when compass calibration has just failed
|
|
|
|
uint32_t compass_cal_canceled : 1; // 1 when compass calibration was just canceled
|
|
|
|
uint32_t tune_started : 1; // tuning a parameter has started
|
|
|
|
uint32_t tune_next : 3; // tuning switched to next parameter
|
|
|
|
uint32_t tune_save : 1; // tuning saved parameters
|
2016-05-27 01:16:25 -03:00
|
|
|
uint32_t tune_error : 1; // tuning controller error
|
2021-01-10 16:09:44 -04:00
|
|
|
uint32_t initiated_temp_cal : 1; // 1 when temperature calibration starts
|
|
|
|
uint32_t temp_cal_saved : 1; // 1 when temperature calibration was just saved
|
|
|
|
uint32_t temp_cal_failed : 1; // 1 when temperature calibration has just failed
|
2014-10-23 09:04:34 -03:00
|
|
|
};
|
|
|
|
|
2016-09-30 04:21:28 -03:00
|
|
|
// The notify flags and values are static to allow direct class access
|
|
|
|
// without declaring the object.
|
|
|
|
static struct notify_flags_and_values_type flags;
|
2014-10-23 09:04:34 -03:00
|
|
|
static struct notify_events_type events;
|
2013-09-19 03:27:31 -03:00
|
|
|
|
|
|
|
// initialisation
|
2018-07-25 22:09:34 -03:00
|
|
|
void init(void);
|
2017-09-06 07:12:36 -03:00
|
|
|
|
2013-09-19 03:27:31 -03:00
|
|
|
/// update - allow updates of leds that cannot be updated during a timed interrupt
|
|
|
|
void update(void);
|
|
|
|
|
2015-02-26 03:07:33 -04:00
|
|
|
// handle a LED_CONTROL message
|
2019-04-30 07:22:48 -03:00
|
|
|
static void handle_led_control(const mavlink_message_t &msg);
|
2015-02-26 03:07:33 -04:00
|
|
|
|
2020-12-22 03:33:00 -04:00
|
|
|
// handle RGB from Scripting or AP_Periph
|
2019-12-09 17:06:35 -04:00
|
|
|
static void handle_rgb(uint8_t r, uint8_t g, uint8_t b, uint8_t rate_hz = 0);
|
|
|
|
|
2016-07-22 00:37:25 -03:00
|
|
|
// handle a PLAY_TUNE message
|
2019-04-30 07:22:48 -03:00
|
|
|
static void handle_play_tune(const mavlink_message_t &msg);
|
2015-12-01 16:22:26 -04:00
|
|
|
|
2019-03-18 23:35:15 -03:00
|
|
|
// play a tune string
|
|
|
|
static void play_tune(const char *tune);
|
|
|
|
|
2021-04-03 19:01:55 -03:00
|
|
|
bool buzzer_enabled() const { return _buzzer_type != 0; }
|
|
|
|
|
|
|
|
uint8_t get_buzzer_types() const { return _buzzer_type; }
|
2016-09-30 04:21:28 -03:00
|
|
|
|
2017-01-20 06:13:37 -04:00
|
|
|
// set flight mode string
|
|
|
|
void set_flight_mode_str(const char *str);
|
|
|
|
const char* get_flight_mode_str() const { return _flight_mode_str; }
|
|
|
|
|
2017-01-20 01:50:07 -04:00
|
|
|
// send text to display
|
|
|
|
void send_text(const char *str);
|
|
|
|
const char* get_text() const { return _send_text; }
|
2018-06-23 04:11:05 -03:00
|
|
|
uint32_t get_text_updated_millis() const {return _send_text_updated_millis; }
|
2016-09-30 04:21:28 -03:00
|
|
|
|
2017-01-20 01:51:04 -04:00
|
|
|
static const struct AP_Param::GroupInfo var_info[];
|
2018-01-22 05:11:14 -04:00
|
|
|
uint8_t get_buzz_pin() const { return _buzzer_pin; }
|
2018-10-16 01:27:02 -03:00
|
|
|
uint8_t get_buzz_level() const { return _buzzer_level; }
|
2019-09-02 22:25:18 -03:00
|
|
|
uint8_t get_buzz_volume() const { return _buzzer_volume; }
|
2020-12-22 03:33:00 -04:00
|
|
|
uint8_t get_led_len() const { return _led_len; }
|
|
|
|
int8_t get_rgb_led_brightness_percent() const;
|
2017-01-20 01:51:04 -04:00
|
|
|
|
2019-05-16 01:14:04 -03:00
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL
|
|
|
|
HAL_Semaphore sf_window_mutex;
|
|
|
|
#endif
|
|
|
|
|
2013-09-19 03:27:31 -03:00
|
|
|
private:
|
2018-01-22 05:11:14 -04:00
|
|
|
|
2019-02-10 14:04:10 -04:00
|
|
|
static AP_Notify *_singleton;
|
2017-07-08 20:40:45 -03:00
|
|
|
|
2018-06-26 14:50:11 -03:00
|
|
|
void add_backend_helper(NotifyDevice *backend);
|
|
|
|
|
2018-07-25 22:09:34 -03:00
|
|
|
// add all backends
|
|
|
|
void add_backends(void);
|
|
|
|
|
2017-01-20 01:51:04 -04:00
|
|
|
// parameters
|
2015-12-01 16:22:26 -04:00
|
|
|
AP_Int8 _rgb_led_brightness;
|
2016-07-16 03:02:27 -03:00
|
|
|
AP_Int8 _rgb_led_override;
|
2021-04-03 19:01:55 -03:00
|
|
|
AP_Int8 _buzzer_type;
|
2016-09-30 04:21:28 -03:00
|
|
|
AP_Int8 _display_type;
|
2017-06-01 19:08:07 -03:00
|
|
|
AP_Int8 _oreo_theme;
|
2018-01-22 05:11:14 -04:00
|
|
|
AP_Int8 _buzzer_pin;
|
2018-07-18 21:49:35 -03:00
|
|
|
AP_Int32 _led_type;
|
2018-10-16 01:27:02 -03:00
|
|
|
AP_Int8 _buzzer_level;
|
2019-09-02 22:25:18 -03:00
|
|
|
AP_Int8 _buzzer_volume;
|
2020-02-22 19:54:57 -04:00
|
|
|
AP_Int8 _led_len;
|
2016-09-30 04:21:28 -03:00
|
|
|
|
2017-01-20 01:50:07 -04:00
|
|
|
char _send_text[NOTIFY_TEXT_BUFFER_SIZE];
|
2017-02-17 03:19:16 -04:00
|
|
|
uint32_t _send_text_updated_millis; // last time text changed
|
2017-01-20 06:13:37 -04:00
|
|
|
char _flight_mode_str[5];
|
2017-01-20 01:51:04 -04:00
|
|
|
|
|
|
|
static NotifyDevice* _devices[];
|
2017-09-06 07:12:36 -03:00
|
|
|
static uint8_t _num_devices;
|
2013-09-19 03:27:31 -03:00
|
|
|
};
|
2019-03-18 23:35:15 -03:00
|
|
|
|
|
|
|
namespace AP {
|
|
|
|
AP_Notify ¬ify();
|
|
|
|
};
|