#include <Servo.h> // include the Servo library
Servo feeding ;
int servo_pin = 10 ;
int botton_pin = 12 ;
int LED0_pin = 6 ; // reset mode
int LED1_pin = 7 ; // start mode
// int LED2_pin = 8 ; // servo2
int mode ;
boolean reset ;
boolean start ;
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
pinMode(botton_pin, INPUT_PULLUP);
pinMode(LED0_pin, OUTPUT );
pinMode(LED1_pin, OUTPUT );
feeding.attach(servo_pin);
reset = true ;
start = false ;
}
void loop() {
// put your main code here, to run repeatedly:
Serial.print("mode : ");
Serial.println(mode);
// ปุ่ม
if(digitalRead(botton_pin) == 0){
delay(200);
while(digitalRead(botton_pin) == 0){}
mode++ ;
if( mode > 1 ) {
mode = 0 ;
}
}
if(mode == 0) {
reset = true ;
start = false ;
}
if(reset == true) {
digitalWrite(LED0_pin, HIGH);
digitalWrite(LED1_pin, LOW);
feeding.write(90);
}
if(mode == 1) {
reset = false ;
start = true ;
}
if(start == true) {
digitalWrite(LED0_pin, LOW);
digitalWrite(LED1_pin, HIGH);
feeding.write(180);
}
}