Controller Update 4
This commit is contained in:
@@ -1,73 +1,46 @@
|
||||
# ArduPilot Parameters for Simulation
|
||||
# Uses GPS from Gazebo for position estimation
|
||||
# ArduPilot Parameters for GPS-Denied Navigation Simulation
|
||||
# =========================================================
|
||||
# GPS is ENABLED for: Geofence safety, LOCAL_POSITION_NED telemetry
|
||||
# GPS is SIMULATED DENIED for: Control (using GUIDED_NOGPS mode)
|
||||
|
||||
# ====================
|
||||
# GPS Configuration
|
||||
# ====================
|
||||
# Enable GPS (Gazebo provides simulated GPS)
|
||||
# Enable GPS (needed for geofence and position telemetry)
|
||||
GPS_TYPE 1 # Auto-detect
|
||||
GPS_TYPE2 0
|
||||
|
||||
# ====================
|
||||
# Geofence Settings
|
||||
# ====================
|
||||
# Disable geofence for simulation (avoids position requirement issues)
|
||||
FENCE_ENABLE 0
|
||||
# Safety cage - uses GPS for boundaries
|
||||
FENCE_ENABLE 1
|
||||
FENCE_TYPE 3 # Alt + Circle
|
||||
FENCE_ACTION 2 # Land on breach
|
||||
FENCE_ALT_MAX 50 # Maximum altitude (meters)
|
||||
FENCE_RADIUS 100 # Circular fence radius (meters)
|
||||
FENCE_ALT_MAX 10 # Maximum altitude (meters)
|
||||
FENCE_RADIUS 20 # Circular fence radius (meters)
|
||||
FENCE_MARGIN 2 # Margin inside fence for warning
|
||||
|
||||
# ====================
|
||||
# EKF Configuration
|
||||
# ====================
|
||||
# Use EKF3 with GPS
|
||||
# Use EKF3 with GPS (for telemetry)
|
||||
AHRS_EKF_TYPE 3
|
||||
EK3_ENABLE 1
|
||||
EK2_ENABLE 0
|
||||
|
||||
# EKF3 Source Configuration - Use GPS
|
||||
# EKF3 Source - GPS for position (enables LOCAL_POSITION_NED)
|
||||
EK3_SRC1_POSXY 3 # GPS for XY position
|
||||
EK3_SRC1_POSZ 1 # Barometer for Z position
|
||||
EK3_SRC1_VELXY 3 # GPS for XY velocity
|
||||
EK3_SRC1_VELZ 0 # None for Z velocity
|
||||
EK3_SRC1_YAW 1 # Compass for yaw
|
||||
|
||||
# EKF3 Position Innovation Gate
|
||||
EK3_POS_I_GATE 300 # Larger gate
|
||||
|
||||
# ====================
|
||||
# Vision Position Input
|
||||
# ====================
|
||||
# Disable vision odometry (not using for simulation)
|
||||
VISO_TYPE 0 # Disabled
|
||||
VISO_POS_X 0.0
|
||||
VISO_POS_Y 0.0
|
||||
VISO_POS_Z 0.0
|
||||
VISO_ORIENT 0
|
||||
VISO_DELAY_MS 50
|
||||
|
||||
|
||||
# ====================
|
||||
# Optical Flow
|
||||
# ====================
|
||||
# Disable optical flow (using GPS instead)
|
||||
FLOW_TYPE 0 # Disabled
|
||||
|
||||
# ====================
|
||||
# Rangefinder
|
||||
# ====================
|
||||
# Disable rangefinder (using barometer + GPS)
|
||||
RNGFND1_TYPE 0 # Disabled
|
||||
|
||||
# ====================
|
||||
# Failsafe Settings
|
||||
# ====================
|
||||
FS_EKF_ACTION 1 # Land on EKF failsafe
|
||||
FS_EKF_THRESH 0.8 # EKF failsafe threshold
|
||||
FS_VIBE_ENABLE 0 # Disable vibration failsafe
|
||||
FS_GPS_ENABLE 0 # Disable GPS failsafe for simulation
|
||||
FS_GPS_ENABLE 0 # Disable GPS failsafe (we simulate GPS-denied)
|
||||
|
||||
# ====================
|
||||
# Flight Modes
|
||||
@@ -82,12 +55,10 @@ FLTMODE6 9 # Land
|
||||
# ====================
|
||||
# Arming Checks
|
||||
# ====================
|
||||
# Disable arming checks for simulation testing
|
||||
ARMING_CHECK 0 # Disable all checks (for sim only)
|
||||
ARMING_CHECK 0 # Disable all checks (for simulation)
|
||||
|
||||
# ====================
|
||||
# Logging
|
||||
# ====================
|
||||
LOG_BITMASK 176126 # Log all relevant data
|
||||
LOG_DISARMED 0 # Don't log when disarmed
|
||||
|
||||
|
||||
Reference in New Issue
Block a user