Browse Source

AP_Frsky_Telem: only use downward facing rangefinder

master
Randy Mackay 8 years ago
parent
commit
65c8f87b17
  1. 2
      libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp

2
libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp

@ -757,7 +757,7 @@ uint32_t AP_Frsky_Telem::calc_attiandrng(void) @@ -757,7 +757,7 @@ uint32_t AP_Frsky_Telem::calc_attiandrng(void)
// pitch from [-9000;9000] centidegrees to unsigned .2 degree increments [0;900] (just in case, limit to 1023 (0x3FF) since the value is stored on 10 bits)
attiandrng |= ((uint16_t)roundf((_ahrs.pitch_sensor + 9000) * 0.05f) & ATTIANDRNG_PITCH_LIMIT)<<ATTIANDRNG_PITCH_OFFSET;
// rangefinder measurement in cm
attiandrng |= prep_number(_rng.distance_cm(), 3, 1)<<ATTIANDRNG_RNGFND_OFFSET;
attiandrng |= prep_number(_rng.distance_cm_orient(ROTATION_PITCH_270), 3, 1)<<ATTIANDRNG_RNGFND_OFFSET;
return attiandrng;
}

Loading…
Cancel
Save