-
Notifications
You must be signed in to change notification settings - Fork 0
/
CrowsTrap_1.ino
53 lines (42 loc) · 1.31 KB
/
CrowsTrap_1.ino
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
#include <Servo.h>
Servo myservo;
int SERVO_VAL_ON; // 糸を緩める(リールのロックを外す)
int SERVO_VAL_OFF; // 糸を固定(リールをロック状態(初期値))
int CNV_IR_TO_DISTANCE; // 赤外線センサー値を距離に変換する定数
int ang_temp;
int ir_val; // 赤外線センサーの読み取り値
int distance; // 距離に変換後の値
void setup() {
// Serial.begin(9600);
while (!Serial) {}
SERVO_VAL_ON = 45;
SERVO_VAL_OFF = 100;
CNV_IR_TO_DISTANCE = 12288;
myservo.attach(9); //デジタル9番ピンをサーボの角度命令出力ピンとして設定
}
void loop() {
ir_val = analogRead(A0);
distance = ir_val;
distance = 12288/distance;
if(ir_val > 250) {
servo_cnt(SERVO_VAL_ON);
} else {
servo_cnt(SERVO_VAL_OFF);
}
// Serial.print(ir_val);
// Serial.print(" ");
// Serial.println(distance);
delay(500);
}
int servo_cnt( int ang ){
// 同じ値が設定されていたら何もしない
if( ang != ang_temp ){
ang_temp = ang;
if( myservo.attached() == false )
myservo.attach(9); //デジタル9番ピンをサーボの角度命令出力ピンとして設定
myservo.write(ang); //サーボを動かす
// Serial.println(ang);
delay(1000);
myservo.detach();
}
}