AC_Sprayer: replace AP_InertialNav with AHRS

libraries/AC_Sprayer/AC_Sprayer.cpp

@@ -48,8 +48,8 @@ const AP_Param::GroupInfo AC_Sprayer::var_info[] = {
     AP_GROUPEND
 };
 
-AC_Sprayer::AC_Sprayer(const AP_InertialNav* inav) :
+AC_Sprayer::AC_Sprayer(const AP_AHRS_NavEKF &ahrs) :
-    _inav(inav),
+    _ahrs(ahrs),
     _speed_over_min_time(0),
     _speed_under_min_time(0)
 {
@@ -107,8 +107,13 @@ AC_Sprayer::update()
     }
 
     // get horizontal velocity
-    const Vector3f &velocity = _inav->get_velocity();
+    Vector3f velocity;
-    float ground_speed = norm(velocity.x,velocity.y);
+    if (!_ahrs.get_velocity_NED(velocity)) {
+        // treat unknown velocity as zero which should lead to pump stopping
+        // velocity will already be zero but this avoids a coverity warning
+        velocity.zero();
+    }
+    float ground_speed = norm(velocity.x * 100.0f, velocity.y * 100.0f);
 
     // get the current time
     const uint32_t now = AP_HAL::millis();

libraries/AC_Sprayer/AC_Sprayer.h

@@ -19,7 +19,7 @@
 #include <AP_Param/AP_Param.h>
 #include <AP_Math/AP_Math.h>
 #include <SRV_Channel/SRV_Channel.h>
-#include <AP_InertialNav/AP_InertialNav.h>     // Inertial Navigation library
+#include <AP_AHRS/AP_AHRS.h>
 
 #define AC_SPRAYER_DEFAULT_PUMP_RATE        10.0f   ///< default quantity of spray per meter travelled
 #define AC_SPRAYER_DEFAULT_PUMP_MIN         0       ///< default minimum pump speed expressed as a percentage from 0 to 100
@@ -32,7 +32,7 @@
 /// @brief  Object managing a crop sprayer comprised of a spinner and a pump both controlled by pwm
 class AC_Sprayer {
 public:
-    AC_Sprayer(const AP_InertialNav *inav);
+    AC_Sprayer(const AP_AHRS_NavEKF &ahrs);
 
     /* Do not allow copies */
     AC_Sprayer(const AC_Sprayer &other) = delete;
@@ -61,7 +61,7 @@ public:
     static const struct AP_Param::GroupInfo var_info[];
 
 private:
-    const AP_InertialNav* const _inav;      ///< pointers to other objects we depend upon
+    const AP_AHRS_NavEKF &_ahrs;            ///< pointers to other objects we depend upon
 
     // parameters
     AP_Int8         _enabled;               ///< top level enable/disable control