Browse Source

px4flow : rotate gyro readings as well

sbg
Kabir Mohammed 9 years ago committed by Lorenz Meier
parent
commit
309212b52b
  1. 2
      src/drivers/px4flow/px4flow.cpp
  2. 1
      src/modules/mavlink/mavlink_receiver.cpp

2
src/drivers/px4flow/px4flow.cpp

@ -531,6 +531,8 @@ PX4FLOW::collect() @@ -531,6 +531,8 @@ PX4FLOW::collect()
rotate_3f(_sensor_rotation, report.pixel_flow_x_integral, report.pixel_flow_y_integral, zeroval);
rotate_3f(_sensor_rotation, report.gyro_x_rate_integral, report.gyro_y_rate_integral, report.gyro_z_rate_integral);
if (_px4flow_topic == nullptr) {
_px4flow_topic = orb_advertise(ORB_ID(optical_flow), &report);

1
src/modules/mavlink/mavlink_receiver.cpp

@ -456,6 +456,7 @@ MavlinkReceiver::handle_message_optical_flow_rad(mavlink_message_t *msg) @@ -456,6 +456,7 @@ MavlinkReceiver::handle_message_optical_flow_rad(mavlink_message_t *msg)
/* rotate measurements according to parameter */
float zeroval = 0.0f;
rotate_3f(flow_rot, f.pixel_flow_x_integral, f.pixel_flow_y_integral, zeroval);
rotate_3f(flow_rot, f.gyro_x_rate_integral, f.gyro_y_rate_integral, f.gyro_z_rate_integral);
if (_flow_pub == nullptr) {
_flow_pub = orb_advertise(ORB_ID(optical_flow), &f);

Loading…
Cancel
Save