#include <ardrone_driver.h>
Public Member Functions | |
ARDroneDriver () | |
double | getRosParam (char *param, double defaultVal) |
bool | imuReCalibCallback (std_srvs::Empty::Request &request, std_srvs::Empty::Response &response) |
void | publish_navdata (navdata_unpacked_t &navdata_raw, const ros::Time &navdata_receive_time) |
void | publish_video () |
void | PublishNavdataTypes (const navdata_unpacked_t &n, const ros::Time &received) |
void | run () |
~ARDroneDriver () | |
Public Attributes | |
bool | enabled_legacy_navdata |
bool | enabled_navdata_adc_data_frame |
bool | enabled_navdata_altitude |
bool | enabled_navdata_demo |
bool | enabled_navdata_euler_angles |
bool | enabled_navdata_games |
bool | enabled_navdata_gyros_offsets |
bool | enabled_navdata_hdvideo_stream |
bool | enabled_navdata_kalman_pressure |
bool | enabled_navdata_magneto |
bool | enabled_navdata_phys_measures |
bool | enabled_navdata_pressure_raw |
bool | enabled_navdata_pwm |
bool | enabled_navdata_raw_measures |
bool | enabled_navdata_rc_references |
bool | enabled_navdata_references |
bool | enabled_navdata_time |
bool | enabled_navdata_trackers_send |
bool | enabled_navdata_trims |
bool | enabled_navdata_video_stream |
bool | enabled_navdata_vision |
bool | enabled_navdata_vision_detect |
bool | enabled_navdata_vision_of |
bool | enabled_navdata_vision_perf |
bool | enabled_navdata_vision_raw |
bool | enabled_navdata_watchdog |
bool | enabled_navdata_wifi |
bool | enabled_navdata_wind_speed |
bool | enabled_navdata_zimmu_3000 |
bool | initialized_navdata_publishers |
ardrone_autonomy::navdata_adc_data_frame | navdata_adc_data_frame_msg |
ardrone_autonomy::navdata_altitude | navdata_altitude_msg |
ardrone_autonomy::navdata_demo | navdata_demo_msg |
ardrone_autonomy::navdata_euler_angles | navdata_euler_angles_msg |
ardrone_autonomy::navdata_games | navdata_games_msg |
ardrone_autonomy::navdata_gyros_offsets | navdata_gyros_offsets_msg |
ardrone_autonomy::navdata_hdvideo_stream | navdata_hdvideo_stream_msg |
ardrone_autonomy::navdata_kalman_pressure | navdata_kalman_pressure_msg |
ardrone_autonomy::navdata_magneto | navdata_magneto_msg |
ardrone_autonomy::navdata_phys_measures | navdata_phys_measures_msg |
ardrone_autonomy::navdata_pressure_raw | navdata_pressure_raw_msg |
ardrone_autonomy::navdata_pwm | navdata_pwm_msg |
ardrone_autonomy::navdata_raw_measures | navdata_raw_measures_msg |
ardrone_autonomy::navdata_rc_references | navdata_rc_references_msg |
ardrone_autonomy::navdata_references | navdata_references_msg |
ardrone_autonomy::navdata_time | navdata_time_msg |
ardrone_autonomy::navdata_trackers_send | navdata_trackers_send_msg |
ardrone_autonomy::navdata_trims | navdata_trims_msg |
ardrone_autonomy::navdata_video_stream | navdata_video_stream_msg |
ardrone_autonomy::navdata_vision_detect | navdata_vision_detect_msg |
ardrone_autonomy::navdata_vision | navdata_vision_msg |
ardrone_autonomy::navdata_vision_of | navdata_vision_of_msg |
ardrone_autonomy::navdata_vision_perf | navdata_vision_perf_msg |
ardrone_autonomy::navdata_vision_raw | navdata_vision_raw_msg |
ardrone_autonomy::navdata_watchdog | navdata_watchdog_msg |
ardrone_autonomy::navdata_wifi | navdata_wifi_msg |
ardrone_autonomy::navdata_wind_speed | navdata_wind_speed_msg |
ardrone_autonomy::navdata_zimmu_3000 | navdata_zimmu_3000_msg |
ros::Publisher | pub_navdata_adc_data_frame |
ros::Publisher | pub_navdata_altitude |
ros::Publisher | pub_navdata_demo |
ros::Publisher | pub_navdata_euler_angles |
ros::Publisher | pub_navdata_games |
ros::Publisher | pub_navdata_gyros_offsets |
ros::Publisher | pub_navdata_hdvideo_stream |
ros::Publisher | pub_navdata_kalman_pressure |
ros::Publisher | pub_navdata_magneto |
ros::Publisher | pub_navdata_phys_measures |
ros::Publisher | pub_navdata_pressure_raw |
ros::Publisher | pub_navdata_pwm |
ros::Publisher | pub_navdata_raw_measures |
ros::Publisher | pub_navdata_rc_references |
ros::Publisher | pub_navdata_references |
ros::Publisher | pub_navdata_time |
ros::Publisher | pub_navdata_trackers_send |
ros::Publisher | pub_navdata_trims |
ros::Publisher | pub_navdata_video_stream |
ros::Publisher | pub_navdata_vision |
ros::Publisher | pub_navdata_vision_detect |
ros::Publisher | pub_navdata_vision_of |
ros::Publisher | pub_navdata_vision_perf |
ros::Publisher | pub_navdata_vision_raw |
ros::Publisher | pub_navdata_watchdog |
ros::Publisher | pub_navdata_wifi |
ros::Publisher | pub_navdata_wind_speed |
ros::Publisher | pub_navdata_zimmu_3000 |
Private Member Functions | |
double | calcAverage (std::vector< double > &vec) |
void | configureDrone () |
void | publish_tf () |
void | PublishNavdataTypes (const navdata_unpacked_t &n, const ros::Time &received) |
bool | readCovParams (std::string param_name, boost::array< double, 9 > &cov_array) |
void | resetCaliberation () |
Private Attributes | |
double | acc_bias [3] |
std::vector< std::vector < double > > | acc_samples |
bool | caliberated |
camera_info_manager::CameraInfoManager * | cinfo_hori_ |
camera_info_manager::CameraInfoManager * | cinfo_vert_ |
ros::Subscriber | cmd_vel_sub |
long int | copy_current_frame_id |
long int | copy_current_navdata_id |
bool | do_caliberation |
int | drone_root_frame |
std::string | droneFrameBase |
std::string | droneFrameBottomCam |
std::string | droneFrameFrontCam |
std::string | droneFrameId |
std::string | droneFrameIMU |
ros::ServiceServer | flatTrim_service |
int | flying_state |
double | gyro_bias [3] |
std::vector< std::vector < double > > | gyro_samples |
image_transport::CameraPublisher | hori_pub |
image_transport::CameraPublisher | image_pub |
image_transport::ImageTransport | image_transport |
sensor_msgs::Imu | imu_msg |
ros::Publisher | imu_pub |
ros::ServiceServer | imuReCalib_service |
bool | inited |
ros::Subscriber | land_sub |
long int | last_frame_id |
long int | last_navdata_id |
ardrone_autonomy::Navdata | legacynavdata_msg |
geometry_msgs::Vector3Stamped | mag_msg |
ros::Publisher | mag_pub |
int | max_num_samples |
ros::Publisher | navdata_pub |
ros::NodeHandle | node_handle |
ros::Subscriber | reset_sub |
ros::ServiceServer | setCamChannel_service |
ros::ServiceServer | setFlightAnimation_service |
ros::ServiceServer | setLedAnimation_service |
ros::ServiceServer | setRecord_service |
ros::Subscriber | takeoff_sub |
tf::StampedTransform | tf_base_bottom |
tf::StampedTransform | tf_base_front |
tf::TransformBroadcaster | tf_broad |
ros::ServiceServer | toggleCam_service |
double | vel_bias [3] |
std::vector< std::vector < double > > | vel_samples |
image_transport::CameraPublisher | vert_pub |
Definition at line 43 of file ardrone_driver.h.
Definition at line 10 of file ardrone_driver.cpp.
Definition at line 113 of file ardrone_driver.cpp.
double ARDroneDriver::calcAverage | ( | std::vector< double > & | vec | ) | [private] |
Definition at line 272 of file ardrone_driver.cpp.
void ARDroneDriver::configureDrone | ( | ) | [private] |
Definition at line 198 of file ardrone_driver.cpp.
double ARDroneDriver::getRosParam | ( | char * | param, |
double | defaultVal | ||
) |
Definition at line 319 of file ardrone_driver.cpp.
bool ARDroneDriver::imuReCalibCallback | ( | std_srvs::Empty::Request & | request, |
std_srvs::Empty::Response & | response | ||
) |
Definition at line 778 of file ardrone_driver.cpp.
void ARDroneDriver::publish_navdata | ( | navdata_unpacked_t & | navdata_raw, |
const ros::Time & | navdata_receive_time | ||
) |
Definition at line 596 of file ardrone_driver.cpp.
void ARDroneDriver::publish_tf | ( | ) | [private] |
Definition at line 770 of file ardrone_driver.cpp.
void ARDroneDriver::publish_video | ( | ) |
For Drone 2 w/ SDK2. Both camera streams are 360p. No 720p support for now. SDK 2.0 Does not support PIP.
Definition at line 328 of file ardrone_driver.cpp.
void ARDroneDriver::PublishNavdataTypes | ( | const navdata_unpacked_t & | n, |
const ros::Time & | received | ||
) |
void ARDroneDriver::PublishNavdataTypes | ( | const navdata_unpacked_t & | n, |
const ros::Time & | received | ||
) | [private] |
bool ARDroneDriver::readCovParams | ( | std::string | param_name, |
boost::array< double, 9 > & | cov_array | ||
) | [private] |
Definition at line 282 of file ardrone_driver.cpp.
void ARDroneDriver::resetCaliberation | ( | ) | [private] |
Definition at line 255 of file ardrone_driver.cpp.
void ARDroneDriver::run | ( | ) |
Definition at line 119 of file ardrone_driver.cpp.
double ARDroneDriver::acc_bias[3] [private] |
Definition at line 140 of file ardrone_driver.h.
std::vector< std::vector<double> > ARDroneDriver::acc_samples [private] |
Definition at line 143 of file ardrone_driver.h.
bool ARDroneDriver::caliberated [private] |
Definition at line 139 of file ardrone_driver.h.
camera_info_manager::CameraInfoManager* ARDroneDriver::cinfo_hori_ [private] |
Definition at line 77 of file ardrone_driver.h.
camera_info_manager::CameraInfoManager* ARDroneDriver::cinfo_vert_ [private] |
Definition at line 78 of file ardrone_driver.h.
ros::Subscriber ARDroneDriver::cmd_vel_sub [private] |
Definition at line 68 of file ardrone_driver.h.
long int ARDroneDriver::copy_current_frame_id [private] |
Definition at line 110 of file ardrone_driver.h.
long int ARDroneDriver::copy_current_navdata_id [private] |
Definition at line 111 of file ardrone_driver.h.
bool ARDroneDriver::do_caliberation [private] |
Definition at line 137 of file ardrone_driver.h.
int ARDroneDriver::drone_root_frame [private] |
Definition at line 128 of file ardrone_driver.h.
std::string ARDroneDriver::droneFrameBase [private] |
Definition at line 127 of file ardrone_driver.h.
std::string ARDroneDriver::droneFrameBottomCam [private] |
Definition at line 127 of file ardrone_driver.h.
std::string ARDroneDriver::droneFrameFrontCam [private] |
Definition at line 127 of file ardrone_driver.h.
std::string ARDroneDriver::droneFrameId [private] |
Definition at line 116 of file ardrone_driver.h.
std::string ARDroneDriver::droneFrameIMU [private] |
Definition at line 127 of file ardrone_driver.h.
Definition at line 134 of file ardrone_driver.h.
Definition at line 104 of file ardrone_driver.h.
Definition at line 80 of file ardrone_driver.h.
Definition at line 50 of file ardrone_driver.h.
Definition at line 65 of file ardrone_driver.h.
Definition at line 110 of file ardrone_driver.h.
Definition at line 62 of file ardrone_driver.h.
Definition at line 125 of file ardrone_driver.h.
Definition at line 122 of file ardrone_driver.h.
Definition at line 116 of file ardrone_driver.h.
Definition at line 59 of file ardrone_driver.h.
Definition at line 113 of file ardrone_driver.h.
Definition at line 77 of file ardrone_driver.h.
Definition at line 56 of file ardrone_driver.h.
Definition at line 74 of file ardrone_driver.h.
Definition at line 68 of file ardrone_driver.h.
Definition at line 53 of file ardrone_driver.h.
Definition at line 95 of file ardrone_driver.h.
Definition at line 71 of file ardrone_driver.h.
Definition at line 107 of file ardrone_driver.h.
Definition at line 89 of file ardrone_driver.h.
Definition at line 98 of file ardrone_driver.h.
Definition at line 86 of file ardrone_driver.h.
Definition at line 92 of file ardrone_driver.h.
Definition at line 83 of file ardrone_driver.h.
Definition at line 101 of file ardrone_driver.h.
Definition at line 128 of file ardrone_driver.h.
Definition at line 119 of file ardrone_driver.h.
Definition at line 131 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::flatTrim_service [private] |
Definition at line 91 of file ardrone_driver.h.
int ARDroneDriver::flying_state [private] |
Definition at line 113 of file ardrone_driver.h.
double ARDroneDriver::gyro_bias[3] [private] |
Definition at line 141 of file ardrone_driver.h.
std::vector< std::vector<double> > ARDroneDriver::gyro_samples [private] |
Definition at line 144 of file ardrone_driver.h.
image_transport::CameraPublisher ARDroneDriver::hori_pub [private] |
Definition at line 74 of file ardrone_driver.h.
image_transport::CameraPublisher ARDroneDriver::image_pub [private] |
Definition at line 73 of file ardrone_driver.h.
image_transport::ImageTransport ARDroneDriver::image_transport [private] |
Definition at line 72 of file ardrone_driver.h.
sensor_msgs::Imu ARDroneDriver::imu_msg [private] |
Definition at line 132 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::imu_pub [private] |
Definition at line 81 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::imuReCalib_service [private] |
Definition at line 90 of file ardrone_driver.h.
bool ARDroneDriver::inited [private] |
Definition at line 115 of file ardrone_driver.h.
Definition at line 136 of file ardrone_driver.h.
ros::Subscriber ARDroneDriver::land_sub [private] |
Definition at line 71 of file ardrone_driver.h.
long int ARDroneDriver::last_frame_id [private] |
Definition at line 108 of file ardrone_driver.h.
long int ARDroneDriver::last_navdata_id [private] |
Definition at line 109 of file ardrone_driver.h.
ardrone_autonomy::Navdata ARDroneDriver::legacynavdata_msg [private] |
Definition at line 134 of file ardrone_driver.h.
geometry_msgs::Vector3Stamped ARDroneDriver::mag_msg [private] |
Definition at line 133 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::mag_pub [private] |
Definition at line 82 of file ardrone_driver.h.
int ARDroneDriver::max_num_samples [private] |
Definition at line 138 of file ardrone_driver.h.
ardrone_autonomy::navdata_adc_data_frame ARDroneDriver::navdata_adc_data_frame_msg |
Definition at line 105 of file ardrone_driver.h.
ardrone_autonomy::navdata_altitude ARDroneDriver::navdata_altitude_msg |
Definition at line 81 of file ardrone_driver.h.
ardrone_autonomy::navdata_demo ARDroneDriver::navdata_demo_msg |
Definition at line 51 of file ardrone_driver.h.
ardrone_autonomy::navdata_euler_angles ARDroneDriver::navdata_euler_angles_msg |
Definition at line 66 of file ardrone_driver.h.
ardrone_autonomy::navdata_games ARDroneDriver::navdata_games_msg |
Definition at line 111 of file ardrone_driver.h.
ardrone_autonomy::navdata_gyros_offsets ARDroneDriver::navdata_gyros_offsets_msg |
Definition at line 63 of file ardrone_driver.h.
ardrone_autonomy::navdata_hdvideo_stream ARDroneDriver::navdata_hdvideo_stream_msg |
Definition at line 126 of file ardrone_driver.h.
ardrone_autonomy::navdata_kalman_pressure ARDroneDriver::navdata_kalman_pressure_msg |
Definition at line 123 of file ardrone_driver.h.
ardrone_autonomy::navdata_magneto ARDroneDriver::navdata_magneto_msg |
Definition at line 117 of file ardrone_driver.h.
ardrone_autonomy::navdata_phys_measures ARDroneDriver::navdata_phys_measures_msg |
Definition at line 60 of file ardrone_driver.h.
ardrone_autonomy::navdata_pressure_raw ARDroneDriver::navdata_pressure_raw_msg |
Definition at line 114 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::navdata_pub [private] |
Definition at line 80 of file ardrone_driver.h.
ardrone_autonomy::navdata_pwm ARDroneDriver::navdata_pwm_msg |
Definition at line 78 of file ardrone_driver.h.
ardrone_autonomy::navdata_raw_measures ARDroneDriver::navdata_raw_measures_msg |
Definition at line 57 of file ardrone_driver.h.
ardrone_autonomy::navdata_rc_references ARDroneDriver::navdata_rc_references_msg |
Definition at line 75 of file ardrone_driver.h.
ardrone_autonomy::navdata_references ARDroneDriver::navdata_references_msg |
Definition at line 69 of file ardrone_driver.h.
ardrone_autonomy::navdata_time ARDroneDriver::navdata_time_msg |
Definition at line 54 of file ardrone_driver.h.
ardrone_autonomy::navdata_trackers_send ARDroneDriver::navdata_trackers_send_msg |
Definition at line 96 of file ardrone_driver.h.
ardrone_autonomy::navdata_trims ARDroneDriver::navdata_trims_msg |
Definition at line 72 of file ardrone_driver.h.
ardrone_autonomy::navdata_video_stream ARDroneDriver::navdata_video_stream_msg |
Definition at line 108 of file ardrone_driver.h.
ardrone_autonomy::navdata_vision_detect ARDroneDriver::navdata_vision_detect_msg |
Definition at line 99 of file ardrone_driver.h.
ardrone_autonomy::navdata_vision ARDroneDriver::navdata_vision_msg |
Definition at line 90 of file ardrone_driver.h.
ardrone_autonomy::navdata_vision_of ARDroneDriver::navdata_vision_of_msg |
Definition at line 87 of file ardrone_driver.h.
ardrone_autonomy::navdata_vision_perf ARDroneDriver::navdata_vision_perf_msg |
Definition at line 93 of file ardrone_driver.h.
ardrone_autonomy::navdata_vision_raw ARDroneDriver::navdata_vision_raw_msg |
Definition at line 84 of file ardrone_driver.h.
ardrone_autonomy::navdata_watchdog ARDroneDriver::navdata_watchdog_msg |
Definition at line 102 of file ardrone_driver.h.
ardrone_autonomy::navdata_wifi ARDroneDriver::navdata_wifi_msg |
Definition at line 129 of file ardrone_driver.h.
ardrone_autonomy::navdata_wind_speed ARDroneDriver::navdata_wind_speed_msg |
Definition at line 120 of file ardrone_driver.h.
ardrone_autonomy::navdata_zimmu_3000 ARDroneDriver::navdata_zimmu_3000_msg |
Definition at line 132 of file ardrone_driver.h.
ros::NodeHandle ARDroneDriver::node_handle [private] |
Definition at line 67 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_adc_data_frame |
Definition at line 103 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_altitude |
Definition at line 79 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_demo |
Definition at line 49 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_euler_angles |
Definition at line 64 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_games |
Definition at line 109 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_gyros_offsets |
Definition at line 61 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_hdvideo_stream |
Definition at line 124 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_kalman_pressure |
Definition at line 121 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_magneto |
Definition at line 115 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_phys_measures |
Definition at line 58 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_pressure_raw |
Definition at line 112 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_pwm |
Definition at line 76 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_raw_measures |
Definition at line 55 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_rc_references |
Definition at line 73 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_references |
Definition at line 67 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_time |
Definition at line 52 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_trackers_send |
Definition at line 94 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_trims |
Definition at line 70 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_video_stream |
Definition at line 106 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_vision |
Definition at line 88 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_vision_detect |
Definition at line 97 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_vision_of |
Definition at line 85 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_vision_perf |
Definition at line 91 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_vision_raw |
Definition at line 82 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_watchdog |
Definition at line 100 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_wifi |
Definition at line 127 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_wind_speed |
Definition at line 118 of file ardrone_driver.h.
ros::Publisher ARDroneDriver::pub_navdata_zimmu_3000 |
Definition at line 130 of file ardrone_driver.h.
ros::Subscriber ARDroneDriver::reset_sub [private] |
Definition at line 70 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::setCamChannel_service [private] |
Definition at line 88 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::setFlightAnimation_service [private] |
Definition at line 92 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::setLedAnimation_service [private] |
Definition at line 89 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::setRecord_service [private] |
Definition at line 93 of file ardrone_driver.h.
ros::Subscriber ARDroneDriver::takeoff_sub [private] |
Definition at line 69 of file ardrone_driver.h.
tf::StampedTransform ARDroneDriver::tf_base_bottom [private] |
Definition at line 129 of file ardrone_driver.h.
tf::StampedTransform ARDroneDriver::tf_base_front [private] |
Definition at line 129 of file ardrone_driver.h.
tf::TransformBroadcaster ARDroneDriver::tf_broad [private] |
Definition at line 84 of file ardrone_driver.h.
ros::ServiceServer ARDroneDriver::toggleCam_service [private] |
Definition at line 87 of file ardrone_driver.h.
double ARDroneDriver::vel_bias[3] [private] |
Definition at line 142 of file ardrone_driver.h.
std::vector< std::vector<double> > ARDroneDriver::vel_samples [private] |
Definition at line 145 of file ardrone_driver.h.
image_transport::CameraPublisher ARDroneDriver::vert_pub [private] |
Definition at line 75 of file ardrone_driver.h.