/ 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 }