-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy patharduino.ino
54 lines (46 loc) · 939 Bytes
/
arduino.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
54
char c;
#include <Servo.h>
int pwm=50;
int brakepin = 10;
int pwmpin = 11;
int dirpin = 9;
Servo myservo;
void setup() {
// put your setup code here, to run once:
pinMode(brakepin,OUTPUT);
pinMode(pwmpin ,OUTPUT);
pinMode(dirpin,OUTPUT);
digitalWrite(brakepin,HIGH);
analogWrite(pwmpin,255);
myservo.attach(6);
Serial.begin(9600);
myservo.write(70);
}
void loop() {
// put your main code here, to run repeatedly:
if(Serial.available()>0)
{
c=Serial.read();
if ((char)c=='a'){
//forward
myservo.write(70);
analogWrite(pwmpin,pwm);
digitalWrite(brakepin,LOW);
digitalWrite(dirpin,HIGH);
}
else if ((char)c=='c'){
//left
myservo.write(73.5);
analogWrite(pwmpin,pwm);
digitalWrite(brakepin,LOW);
digitalWrite(dirpin,HIGH);
}
else if((char)c=='b'){
//right
myservo.write(66.5);
analogWrite(pwmpin,pwm);
digitalWrite(brakepin,LOW);
digitalWrite(dirpin,HIGH);
}
}
}