From 7b079ca297a4ee6f6eb3092e1cf8c2e45b3b4f44 Mon Sep 17 00:00:00 2001
From: Dominic Clifton <me@dominicclifton.name>
Date: Fri, 18 Apr 2014 21:04:10 +0100
Subject: [PATCH] Remove code duplication for gimbal servo updates.

---
 src/flight_mixer.c | 12 ++++++++----
 1 file changed, 8 insertions(+), 4 deletions(-)

diff --git a/src/flight_mixer.c b/src/flight_mixer.c
index 7fe508ebd6..b1105aed4d 100755
--- a/src/flight_mixer.c
+++ b/src/flight_mixer.c
@@ -258,6 +258,12 @@ void mixerLoadMix(int index)
     }
 }
 
+static void updateGimbalServos(void)
+{
+    pwmWriteServo(0, servo[0]);
+    pwmWriteServo(1, servo[1]);
+}
+
 void writeServos(void)
 {
     if (!core.useServo)
@@ -288,8 +294,7 @@ void writeServos(void)
             break;
 
         case MULTITYPE_GIMBAL:
-            pwmWriteServo(0, servo[0]);
-            pwmWriteServo(1, servo[1]);
+            updateGimbalServos();
             break;
 
         case MULTITYPE_DUALCOPTER:
@@ -308,8 +313,7 @@ void writeServos(void)
         default:
             // Two servos for SERVO_TILT, if enabled
             if (feature(FEATURE_SERVO_TILT)) {
-                pwmWriteServo(0, servo[0]);
-                pwmWriteServo(1, servo[1]);
+                updateGimbalServos();
             }
             break;
     }