id change

Gripper/Gripper.ino

@@ -4,7 +4,7 @@
 #define DirectionPin 	(10u)
 #define BaudRate  		(1000000ul)
 #define ID1				(4u)
-#define ID1				(5u)
+#define ID2				(5u)
 
 #include <XYZrobotServo.h>
 
@@ -49,9 +49,17 @@ void ax12(int position){
 }
 
 void a116_1(int position){
+    if((position<300) || (position>700)){
+    Serial.print("invalide position. Try again");
+    return;
+  }
   servo1.setPosition(position, playtime);
 }
 void a116_2(int position){
+    if((position<300) || (position>700)){
+    Serial.print("invalide position. Try again");
+    return;
+  }
   servo2.setPosition(position, playtime);
 }