2020-04-24 17:28:00 -03:00
/// @file AC_Sprayer.h
/// @brief Crop sprayer library
2013-08-04 09:25:41 -03:00
2013-09-11 05:04:58 -03:00
/**
The crop spraying functionality can be enabled in ArduCopter by doing the following :
2018-03-25 20:22:53 -03:00
- set RC7_OPTION or RC8_OPTION parameter to 15 to allow turning the sprayer on / off from one of these channels
- set SERVO10_FUNCTION to 22 to enable the servo output controlling the pump speed on servo - out 10
- set SERVO11_FUNCTION to 23 to enable the servo output controlling the spinner on servo - out 11
2016-10-27 22:50:37 -03:00
- ensure the RC10_MIN , RC10_MAX , RC11_MIN , RC11_MAX accurately hold the min and maximum servo values you could possibly output to the pump and spinner
- set the SPRAY_SPINNER to the pwm value the spinner should spin at when on
2022-11-13 11:48:46 -04:00
- set the SPRAY_PUMP_RATE to the value the pump servo should move to when the vehicle is travelling at 1 m / s . This is expressed as a percentage ( i . e . 0 ~ 100 ) of the full servo range . I . e . 0 = the pump will not operate , 100 = maximum speed at 1 m / s . 50 = 1 / 2 speed at 1 m / s , full speed at 2 m / s
2016-10-27 22:50:37 -03:00
- set the SPRAY_PUMP_MIN to the minimum value that the pump servo should move to while engaged expressed as a percentage ( i . e . 0 ~ 100 ) of the full servo range
- set the SPRAY_SPEED_MIN to the minimum speed ( in cm / s ) the vehicle should be moving at before the pump and sprayer are turned on . 0 will mean the pump and spinner will always be on when the system is enabled with ch7 / ch8 switch
2013-09-11 05:04:58 -03:00
* */
2016-02-17 21:25:10 -04:00
# pragma once
2013-08-04 09:25:41 -03:00
# include <inttypes.h>
2015-08-11 03:28:41 -03:00
# include <AP_Common/AP_Common.h>
# include <AP_Param/AP_Param.h>
2013-08-04 09:25:41 -03:00
2016-09-03 07:42:30 -03:00
# 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
# define AC_SPRAYER_DEFAULT_SPINNER_PWM 1300 ///< default speed of spinner (higher means spray is throw further horizontally
# define AC_SPRAYER_DEFAULT_SPEED_MIN 100 ///< we must be travelling at least 1m/s to begin spraying
# define AC_SPRAYER_DEFAULT_TURN_ON_DELAY 100 ///< delay between when we reach the minimum speed and we begin spraying. This reduces the likelihood of constantly turning on/off the pump
# define AC_SPRAYER_DEFAULT_SHUT_OFF_DELAY 1000 ///< shut-off delay in milli seconds. This reduces the likelihood of constantly turning on/off the pump
2013-08-04 09:25:41 -03:00
2020-01-17 18:57:23 -04:00
# ifndef HAL_SPRAYER_ENABLED
2022-10-31 23:39:21 -03:00
# define HAL_SPRAYER_ENABLED 1
2020-01-17 18:57:23 -04:00
# endif
# if HAL_SPRAYER_ENABLED
2013-10-24 05:45:20 -03:00
/// @class AC_Sprayer
/// @brief Object managing a crop sprayer comprised of a spinner and a pump both controlled by pwm
2013-08-04 09:25:41 -03:00
class AC_Sprayer {
public :
2018-04-11 08:06:20 -03:00
AC_Sprayer ( ) ;
2013-09-11 05:04:58 -03:00
2017-08-29 20:49:47 -03:00
/* Do not allow copies */
2022-09-30 06:50:43 -03:00
CLASS_NO_COPY ( AC_Sprayer ) ;
2013-08-04 09:25:41 -03:00
2019-02-10 14:34:16 -04:00
static AC_Sprayer * get_singleton ( ) ;
static AC_Sprayer * _singleton ;
2018-06-08 00:36:19 -03:00
2016-10-27 22:52:24 -03:00
/// run - allow or disallow spraying to occur
void run ( bool true_false ) ;
2013-08-04 09:25:41 -03:00
2016-10-27 22:52:24 -03:00
/// running - returns true if spraying is currently permitted
bool running ( ) const { return _flags . running ; }
/// spraying - returns true if spraying is actually happening
bool spraying ( ) const { return _flags . spraying ; }
2013-08-04 09:25:41 -03:00
2013-09-11 05:04:58 -03:00
/// test_pump - set to true to turn on pump as if travelling at 1m/s as a test
void test_pump ( bool true_false ) { _flags . testing = true_false ; }
2013-08-04 09:25:41 -03:00
/// To-Do: add function to decode pilot input from channel 6 tuning knob
/// set_pump_rate - sets desired quantity of spray when travelling at 1m/s as a percentage of the pumps maximum rate
void set_pump_rate ( float pct_at_1ms ) { _pump_pct_1ms . set ( pct_at_1ms ) ; }
/// update - adjusts servo positions based on speed and requested quantity
void update ( ) ;
static const struct AP_Param : : GroupInfo var_info [ ] ;
private :
// parameters
2016-09-03 07:42:30 -03:00
AP_Int8 _enabled ; ///< top level enable/disable control
AP_Float _pump_pct_1ms ; ///< desired pump rate (expressed as a percentage of top rate) when travelling at 1m/s
AP_Int8 _pump_min_pct ; ///< minimum pump rate (expressed as a percentage from 0 to 100)
AP_Int16 _spinner_pwm ; ///< pwm rate of spinner
AP_Float _speed_min ; ///< minimum speed in cm/s above which the sprayer will be started
2013-08-04 09:25:41 -03:00
2016-09-03 07:42:30 -03:00
/// flag bitmask
2013-09-12 10:24:14 -03:00
struct sprayer_flags_type {
2016-09-03 07:42:30 -03:00
uint8_t spraying : 1 ; ///< 1 if we are currently spraying
uint8_t testing : 1 ; ///< 1 if we are testing the sprayer and should output a minimum value
2016-10-27 22:52:24 -03:00
uint8_t running : 1 ; ///< 1 if we are permitted to run sprayer
2013-09-11 05:04:58 -03:00
} _flags ;
2013-08-04 09:25:41 -03:00
// internal variables
2016-09-03 07:42:30 -03:00
uint32_t _speed_over_min_time ; ///< time at which we reached speed minimum
uint32_t _speed_under_min_time ; ///< time at which we fell below speed minimum
2016-10-27 22:52:24 -03:00
void stop_spraying ( ) ;
2013-08-04 09:25:41 -03:00
} ;
2018-06-08 00:36:19 -03:00
namespace AP {
AC_Sprayer * sprayer ( ) ;
} ;
2020-01-17 18:57:23 -04:00
# endif // HAL_SPRAYER_ENABLED