Arm Robot + Mobile App

1String inString = "";    // string to hold input
2
3#include <Servo.h>  
4// Declare the Servo pin 
5int servoPin = 8 , servoPin2 = 9,servoPin3 = 10,  servoPin4 = 11 ; 
6
7Servo Servo1, Servo2 , Servo3 , Servo4; 
8
9void setup()  {
10
11  Servo1.attach(servoPin); 
12  Servo2.attach(servoPin2); 
13  Servo3.attach(servoPin3);  
14  Servo4.attach(servoPin4); 
15
16  Servo1.write(0);
17  Servo2.write(0);
18  Servo3.write(0);
19  Servo4.write(0);
20  
21  // Open serial communications  and wait for port to open:
22  Serial.begin(9600);
23  /*while (!Serial) {
24    ; // wait for serial port to connect. Needed for native USB port only
25  }
26
27  // send an intro:
28  Serial.println("\
29\
30String toInt():");
31  Serial.println();
32
33  */
34}
35
36
37void loop() {
38  // Read serial input:
39  while (Serial.available()  > 0) {
40    int inChar = Serial.read();
41    if (isDigit(inChar)) {
42      //  convert the incoming byte to a char and add it to the string:
43      inString  += (char)inChar;
44    }
45
46         
47    // if you get a newline, print  the string, then the string's value:
48    if (inChar == '\n') {
49      Serial.print("Value:");
50      Serial.println(inString.toInt());
51
52      int value = inString.toInt();
53      
54                      if(value>=0 && value<=90){
55                      Serial.println(value);  
56                      int servo1_position = map(value, 0, 90, 0, 180);
57                      Servo1.write(servo1_position);
58                      }
59                     if(value>90 && value<=181){
60                      Serial.println(value); 
61                      int servo2_position  = map(value, 91, 181, 0, 180);
62                      Servo2.write(servo2_position);
63                      }
64                
65                    if(value>181  && value<=272){
66                      Serial.println(value); 
67                      int  servo3_position = map(value, 182, 272, 0, 180);
68                      Servo3.write(servo3_position);
69                      }
70                
71                    if(value>272  && value<=363){
72                      Serial.println(value); 
73                      int  servo4_position = map(value, 273, 363, 0, 180);
74                      Servo4.write(servo4_position);
75                      }
76    
77      inString = "";
78
79  
80      
81      //Serial.print("String: ");
82      //Serial.println(inString);
83      //  clear the string for new input:
84     // 
85    }
86    
87  }
88}