blob: 64d7699ee32293d28ca3baad6ad1ffdf491decf6 (
plain)
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
59
60
61
62
|
#include <Servo.h>
#define B_S 7
#define J_S 8
#define M_S 9
#define T_S 10
Servo bases;
Servo joints;
Servo mans;
Servo turns;
int basea = 90;
int jointa = 60;
int mana = 30;
int turna = 90;
char in = 0;
void setup() {
pinMode(B_S,OUTPUT);
pinMode(J_S,OUTPUT);
pinMode(T_S,OUTPUT);
pinMode(M_S,OUTPUT);
bases.attach(B_S);
joints.attach(J_S);
mans.attach(M_S);
turns.attach(T_S);
Serial.begin(9600);
}
void loop() {
if (Serial.available()) {
in = Serial.read();
Serial.print(in,HEX);
switch (in) {
case 'A' :
basea = basea + 5;
Serial.print(basea,DEC);
break;
case 'S' :
basea = basea - 5;
Serial.print(basea,DEC);
break;
case 'X' :
jointa = jointa + 5;
break;
case 'C' :
jointa = jointa - 5;
break;
case 'W' :
mana = mana + 1;
break;
case 'E' :
mana = mana - 1;
break;
}
}
bases.write(basea);
joints.write(jointa);
mans.write(mana);
}
|
