diff --git a/params/ardupilot/ArduSub/4.1/heavy.params b/params/ardupilot/ArduSub/4.1/heavy.params
index 6d359e2..a20bdaf 100644
--- a/params/ardupilot/ArduSub/4.1/heavy.params
+++ b/params/ardupilot/ArduSub/4.1/heavy.params
@@ -4,7 +4,8 @@ ATC_ANG_YAW_P: 6.0,
 FRAME_CONFIG: 2,
 SERVO7_FUNCTION: 39, // Motor7
 SERVO8_FUNCTION: 40, // Motor8
-SERVO8_REVERSED: 0,
-SERVO9_FUNCTION: 59, // RCIN9 (camera)
-SERVO10_FUNCTION: 7, // mount_tilt
-SERVO10_REVERSED: 1,
+SERVO9_FUNCTION: 0, // Gripper
+SERVO13_FUNCTION: 59, // RCIN9 -- lights1
+SERVO14_FUNCTION: 60, // RCIN10 -- lights2
+SERVO16_FUNCTION: 7, // mount_tilt
+SERVO16_REVERSED: 1