ardupilot/libraries/AP_Camera/AP_Camera.h

149 lines
5.4 KiB
C
Raw Normal View History

2012-06-13 16:00:20 -03:00
/// @file AP_Camera.h
/// @brief Photo or video camera manager, with EEPROM-backed storage of constants.
#pragma once
2012-06-13 16:00:20 -03:00
#include <AP_Param/AP_Param.h>
#include <AP_Common/AP_Common.h>
#include <AP_Relay/AP_Relay.h>
#include <AP_GPS/AP_GPS.h>
#include <AP_AHRS/AP_AHRS.h>
#include <AP_Mission/AP_Mission.h>
2012-06-13 16:00:20 -03:00
#define AP_CAMERA_TRIGGER_TYPE_SERVO 0
#define AP_CAMERA_TRIGGER_TYPE_RELAY 1
#define AP_CAMERA_TRIGGER_DEFAULT_TRIGGER_TYPE AP_CAMERA_TRIGGER_TYPE_SERVO // default is to use servo to trigger camera
#define AP_CAMERA_TRIGGER_DEFAULT_DURATION 10 // default duration servo or relay is held open in 10ths of a second (i.e. 10 = 1 second)
#define AP_CAMERA_SERVO_ON_PWM 1300 // default PWM value to move servo to when shutter is activated
#define AP_CAMERA_SERVO_OFF_PWM 1100 // default PWM value to move servo to when shutter is deactivated
#define AP_CAMERA_FEEDBACK_DEFAULT_FEEDBACK_PIN -1 // default is to not use camera feedback pin
2012-06-13 16:00:20 -03:00
/// @class Camera
/// @brief Object managing a Photo or video camera
class AP_Camera {
2012-06-13 16:00:20 -03:00
public:
AP_Camera(AP_Relay *obj_relay, uint32_t _log_camera_bit, const struct Location &_loc, const AP_AHRS &_ahrs)
: log_camera_bit(_log_camera_bit)
, current_loc(_loc)
, ahrs(_ahrs)
{
AP_Param::setup_object_defaults(this, var_info);
_apm_relay = obj_relay;
2018-08-03 07:50:34 -03:00
_singleton = this;
}
2012-06-13 16:00:20 -03:00
2017-08-29 15:48:37 -03:00
/* Do not allow copies */
AP_Camera(const AP_Camera &other) = delete;
AP_Camera &operator=(const AP_Camera&) = delete;
2018-04-14 01:03:29 -03:00
// get singleton instance
static AP_Camera *get_singleton()
{
2018-04-14 01:03:29 -03:00
return _singleton;
}
2017-08-29 15:48:37 -03:00
// MAVLink methods
void control_msg(const mavlink_message_t* msg);
void send_feedback(mavlink_channel_t chan);
2012-06-13 16:00:20 -03:00
// Command processing
void configure(float shooting_mode, float shutter_speed, float aperture, float ISO, float exposure_type, float cmd_id, float engine_cutoff_time);
// handle camera control
void control(float session, float zoom_pos, float zoom_step, float focus_lock, float shooting_cmd, float cmd_id);
// set camera trigger distance in a mission
void set_trigger_distance(uint32_t distance_m)
{
_trigg_dist.set(distance_m);
}
void take_picture();
// Update - to be called periodically @at least 10Hz
void update();
// update camera trigger - 50Hz
void update_trigger();
static const struct AP_Param::GroupInfo var_info[];
2012-06-13 16:00:20 -03:00
// set if vehicle is in AUTO mode
void set_is_auto_mode(bool enable)
{
_is_in_auto_mode = enable;
}
enum camera_types {
CAMERA_TYPE_STD,
CAMERA_TYPE_BMMCC
};
2012-06-13 16:00:20 -03:00
private:
2018-04-14 01:03:29 -03:00
static AP_Camera *_singleton;
2013-12-05 21:27:58 -04:00
AP_Int8 _trigger_type; // 0:Servo,1:Relay
AP_Int8 _trigger_duration; // duration in 10ths of a second that the camera shutter is held open
AP_Int8 _relay_on; // relay value to trigger camera
AP_Int16 _servo_on_pwm; // PWM value to move servo to when shutter is activated
AP_Int16 _servo_off_pwm; // PWM value to move servo to when shutter is deactivated
uint8_t _trigger_counter; // count of number of cycles shutter has been held open
uint8_t _trigger_counter_cam_function; // count of number of cycles alternative camera function has been held open
AP_Relay *_apm_relay; // pointer to relay object from the base class Relay.
AP_Int8 _auto_mode_only; // if 1: trigger by distance only if in AUTO mode.
AP_Int8 _type; // Set the type of camera in use, will open additional parameters if set
bool _is_in_auto_mode; // true if in AUTO mode
2012-06-13 16:00:20 -03:00
void servo_pic(); // Servo operated camera
void relay_pic(); // basic relay activation
void feedback_pin_timer();
void feedback_pin_isr(uint8_t, bool, uint32_t);
void setup_feedback_callback(void);
AP_Float _trigg_dist; // distance between trigger points (meters)
AP_Int16 _min_interval; // Minimum time between shots required by camera
AP_Int16 _max_roll; // Maximum acceptable roll angle when trigging camera
uint32_t _last_photo_time; // last time a photo was taken
struct Location _last_location;
uint16_t _image_index; // number of pictures taken since boot
2012-06-13 16:00:20 -03:00
// pin number for accurate camera feedback messages
AP_Int8 _feedback_pin;
AP_Int8 _feedback_polarity;
uint32_t _camera_trigger_count;
uint32_t _camera_trigger_logged;
uint32_t _feedback_timestamp_us;
bool _timer_installed;
bool _isr_installed;
uint8_t _last_pin_state;
void log_picture();
uint32_t log_camera_bit;
const struct Location &current_loc;
const AP_AHRS &ahrs;
// entry point to trip local shutter (e.g. by relay or servo)
void trigger_pic();
// de-activate the trigger after some delay, but without using a delay() function
// should be called at 50hz from main program
void trigger_pic_cleanup();
// return true if we are using a feedback pin
bool using_feedback_pin(void) const
{
return _feedback_pin > 0;
}
2012-06-13 16:00:20 -03:00
};
2018-04-14 01:03:29 -03:00
namespace AP {
AP_Camera *camera();
2018-04-14 01:03:29 -03:00
};