From d66368af159d2f46fa8e85f65c0b1565b97ebfcd Mon Sep 17 00:00:00 2001
From: shrkey <barry@shrkey.com>
Date: Mon, 10 Oct 2016 21:06:25 +0100
Subject: [PATCH] servo ms bug

---
 darkwater/DW640.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/darkwater/DW640.cpp b/darkwater/DW640.cpp
index 2e8dc1e..bee6189 100644
--- a/darkwater/DW640.cpp
+++ b/darkwater/DW640.cpp
@@ -305,7 +305,7 @@ void DW640::setServoPWMmS(uint8_t servo, float length_mS) {
 				setPWMmS( 0, length_mS ); // Servo 1 is on PWM 0
 				break;
 		case 2:
-				setPWMmS( 0, length_mS ); // Servo 2 is on PWM 1
+				setPWMmS( 1, length_mS ); // Servo 2 is on PWM 1
 				break;
 		default:
 				fprintf(stderr, "Servo number must be between 1 and 2 inclusive");