รถดั๊มตรวจจับสี อุปกรณ์ 1.รถดั้มสิบล้อ 2.servo motor 3.color sensor 4.กล่องกระดาษสีแดง สีเขียว สีน้ำเงิน 5.ลูกแก้ว #include <Servo.h> #define S0 2 #define S1 3 #define S2 4 #define S3 5 #define Out 6 Servo topServo; int frequency = 0; int color=0; void setup() { pinMode(S0, OUTPUT); pinMode(S1, OUTPUT); pinMode(S2, OUTPUT); pinMode(S3, OUTPUT); pinMode(Out, INPUT); digitalWrite(S0, HIGH); digitalWrite(S1, LOW); topServo.attach(7); Serial.begin(9600); } void loop() { color = readColor(); delay(10); switch (color) { case 1: topServo.write(0); delay(5000); topServo.write(180); } color=0; } int readColor() { digitalWrite(S2, LOW); digitalWrite(S3, LOW); frequency = pulseIn(Out, LOW); int R = fr...
ความคิดเห็น
แสดงความคิดเห็น