1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58
| #include <Servo.h>
#define S0 4
#define S1 5
#define S2 7
#define S3 6
#define sensorOut 8
Servo myservo;
int pos = 90;
int redFrequency = 0;
int greenFrequency = 0;
int blueFrequency = 0;
void setup() {
pinMode(S0, OUTPUT);
pinMode(S1, OUTPUT);
pinMode(S2, OUTPUT);
pinMode(S3, OUTPUT);
pinMode(sensorOut, INPUT);
myservo.attach(9);
digitalWrite(S0,HIGH);
digitalWrite(S1,LOW);
Serial.begin(9600);
}
void loop() {
digitalWrite(S2,LOW);
digitalWrite(S3,LOW);
redFrequency = pulseIn(sensorOut, LOW);
if(redFrequency ==50 && greenFrequency ==140 && blueFrequency ==105){
myservo.attach(135);
delay(10);}
digitalWrite(S2, HIGH);
digitalWrite(S3, HIGH);
greenFrequency = pulseIn(sensorOut, LOW);
if(redFrequency ==130 && greenFrequency ==141 && blueFrequency==42){
myservo.attach(90);
delay(10);}
digitalWrite(S2, LOW);
digitalWrite(S3, HIGH);
blueFrequency = pulseIn(sensorOut, LOW);
if (redFrequency ==146 && greenFrequency ==121 && blueFrequency ==36){
myservo.attach(45);
delay(10);}
} |
Partager