Change address to test mode

Servo/include/ServoController.h

@@ -11,14 +11,14 @@ private:
 	const int SRV_START_ANGLE_INT_PART_REG = 2000;
 	const int SRV_STOP_ANGLE_INT_PART_REG = 2001;
 	const int SRV_AZIMUTH_SPEED_REG = 2002;
-	const int SRV_APPLY_SETTING_REG = 2004;
+	const int SRV_APPLY_SETTING_REG = 2003;//2004;
-	const int SRV_START_STOP_REG = 2005;
+	const int SRV_START_STOP_REG = 2004; //2005;
-	const int SRV_ZERO_OFFSET_ANGLE = 2007;
+	const int SRV_ZERO_OFFSET_ANGLE = 2005; //2007;
-	const int SRV_START_ANGLE_FRAC_PART_REG = 2010;
+	const int SRV_START_ANGLE_FRAC_PART_REG = 2006; //2010;
-	const int SRV_STOP_ANGLE_FRAC_PART_REG = 2011;
+	const int SRV_STOP_ANGLE_FRAC_PART_REG = 2007; //2011;
-	const int SRV_CALIBRATE_REG = 2013;
+	const int SRV_CALIBRATE_REG = 2008;  //2013;
-	const int SRV_ENABLE_DRIVE_REG = 2017;
+	const int SRV_ENABLE_DRIVE_REG = 2009; //2017;
-	const int SRV_AZIMUTH_REG = 2030;
+	const int SRV_AZIMUTH_REG = 2010; //2030;
 
 	const double SRV_ANGLE_FACTOR = 100.0;
 	const double SRV_SPEED_FACTOR = 1000.0;