|
1 | 1 | #!/bin/sh
|
2 |
| -# @name Gazebo lawnmower |
| 2 | +# @name Gazebo - Zero Turn Lawnmower |
3 | 3 | # @type Rover
|
4 | 4 | # @class Rover
|
5 | 5 |
|
6 | 6 | . ${R}etc/init.d/rc.rover_differential_defaults
|
7 | 7 |
|
8 | 8 | PX4_SIMULATOR=${PX4_SIMULATOR:=gz}
|
9 |
| -PX4_GZ_WORLD=${PX4_GZ_WORLD:=default} |
| 9 | +PX4_GZ_WORLD=${PX4_GZ_WORLD:=lawn} |
10 | 10 | PX4_SIM_MODEL=${PX4_SIM_MODEL:=lawnmower}
|
11 | 11 |
|
12 | 12 | param set-default SIM_GZ_EN 1 # Gazebo bridge
|
13 | 13 |
|
| 14 | +param set-default NAV_ACC_RAD 0.5 |
| 15 | + |
14 | 16 | # We can arm and drive in manual mode when it slides and GPS check fails:
|
15 | 17 | param set-default COM_ARM_WO_GPS 1
|
16 | 18 |
|
17 |
| -# Rover parameters |
| 19 | +# Differential Parameters |
18 | 20 | param set-default RD_WHEEL_TRACK 0.9
|
19 |
| -param set-default RD_YAW_RATE_I 0.1 |
20 |
| -param set-default RD_YAW_RATE_P 5 |
21 |
| -param set-default RD_MAX_ACCEL 1 |
22 |
| -param set-default RD_MAX_JERK 3 |
23 |
| -param set-default RD_MAX_SPEED 8 |
24 |
| -param set-default RD_YAW_P 5 |
25 |
| -param set-default RD_YAW_I 0.1 |
26 |
| -param set-default RD_MAX_YAW_RATE 30 |
27 | 21 | param set-default RD_TRANS_DRV_TRN 0.349066
|
28 | 22 | param set-default RD_TRANS_TRN_DRV 0.174533
|
29 | 23 |
|
| 24 | +# Rover Control Parameters |
| 25 | +param set-default RO_ACCEL_LIM 1.5 |
| 26 | +param set-default RO_DECEL_LIM 5 |
| 27 | +param set-default RO_JERK_LIM 15 |
| 28 | +param set-default RO_MAX_THR_SPEED 2.7 |
| 29 | + |
| 30 | +# Rover Rate Control Parameters |
| 31 | +param set-default RO_YAW_RATE_I 0.2 |
| 32 | +param set-default RO_YAW_RATE_P 1.0 |
| 33 | +param set-default RO_YAW_RATE_LIM 60 |
| 34 | +param set-default RO_YAW_ACCEL_LIM 50 |
| 35 | +param set-default RO_YAW_DECEL_LIM 1000 |
| 36 | +param set-default RO_YAW_RATE_CORR 1.0 |
| 37 | + |
| 38 | +# Rover Attitude Control Parameters |
| 39 | +param set-default RO_YAW_P 5 |
| 40 | + |
| 41 | +# Rover Velocity Control Parameters |
| 42 | +param set-default RO_SPEED_LIM 2.1 |
| 43 | +param set-default RO_SPEED_I 0.01 |
| 44 | +param set-default RO_SPEED_P 0.1 |
| 45 | +param set-defatul RO_SPEED_RED 1.0 |
| 46 | + |
30 | 47 | # Pure pursuit parameters
|
31 |
| -param set-default PP_LOOKAHD_MAX 30 |
32 |
| -param set-default PP_LOOKAHD_MIN 2 |
33 | 48 | param set-default PP_LOOKAHD_GAIN 1
|
| 49 | +param set-default PP_LOOKAHD_MAX 10 |
| 50 | +param set-default PP_LOOKAHD_MIN 1 |
34 | 51 |
|
35 | 52 | # Actuator mapping - set SITL motors/servos output parameters:
|
36 | 53 |
|
37 | 54 | # "Motors" - motor channels 0 (Right) and 1 (Left) - via Wheels GZ bridge:
|
38 | 55 | param set-default SIM_GZ_WH_FUNC1 101 # right wheel
|
39 |
| -#param set-default SIM_GZ_WH_MIN1 0 |
40 |
| -#param set-default SIM_GZ_WH_MAX1 200 |
41 |
| -#param set-default SIM_GZ_WH_DIS1 100 |
42 |
| -#param set-default SIM_GZ_WH_FAIL1 100 |
| 56 | +param set-default SIM_GZ_WH_MIN1 87 |
| 57 | +param set-default SIM_GZ_WH_MAX1 113 |
| 58 | +param set-default SIM_GZ_WH_DIS1 100 |
| 59 | +param set-default SIM_GZ_WH_FAIL1 100 |
43 | 60 |
|
44 | 61 | param set-default SIM_GZ_WH_FUNC2 102 # left wheel
|
45 |
| -#param set-default SIM_GZ_WH_MIN2 0 |
46 |
| -#param set-default SIM_GZ_WH_MAX2 200 |
47 |
| -#param set-default SIM_GZ_WH_DIS2 100 |
48 |
| -#param set-default SIM_GZ_WH_FAIL2 100 |
| 62 | +param set-default SIM_GZ_WH_MIN2 87 |
| 63 | +param set-default SIM_GZ_WH_MAX2 113 |
| 64 | +param set-default SIM_GZ_WH_DIS2 100 |
| 65 | +param set-default SIM_GZ_WH_FAIL2 100 |
49 | 66 |
|
50 | 67 | param set-default SIM_GZ_WH_REV 0 # no need to reverse any wheels
|
51 | 68 |
|
|
0 commit comments