/ Nextmind_Unity_Control / Nextmind_Unity_Control.ino
Nextmind_Unity_Control.ino
 1  // SPDX-FileCopyrightText: 2021 Collin Cunningham for Adafruit Industries
 2  //
 3  // SPDX-License-Identifier: MIT
 4  
 5  #include <Servo.h>
 6  
 7  Servo servo;
 8  int numberRecvd;
 9  String dataString = "";
10  
11  void setup(){
12    
13    Serial.begin(9600);
14    
15    pinMode(5, OUTPUT);
16    servo.attach(5);
17    servo.write(0);
18  }
19  
20  void loop(){
21    
22    if (Serial.available() > 0){
23      
24      dataString = "";
25      while (Serial.available() > 0)
26      {
27        dataString += char(Serial.read());
28        delay(2);
29      }
30  
31      numberRecvd = dataString.toInt();
32  
33      switch (numberRecvd) {
34        case 1:
35          servo.write(125);
36          break;
37        case 2:
38          servo.write(90);
39          break;
40        case 3:
41          servo.write(55);
42          break;
43        default:
44          servo.write(0);
45          break;
46      }
47  
48      Serial.flush();
49      Serial.print("received: ");
50      Serial.println(numberRecvd);
51    }
52    
53    delay(20);
54  }