/
motors.js
55 lines (44 loc) · 1.18 KB
/
motors.js
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
var five = require("johnny-five");
var max_speed_l = 150;
var max_speed_r = 140;
// set up the input
var stdin = process.stdin;
stdin.setRawMode(true);
var board = new five.Board({port: process.argv[2]});
var l_motor = r_motor = null;
board.on("ready", function(err) {
if (err){
console.log(err);
return;
}
l_motor = new five.Motor({pins: {pwm: 6, dir: 7}});
r_motor = new five.Motor({pins: {pwm: 5, dir: 4}});
console.info("Board connected. Robot set up. LRUD to control");
});
stdin.on('keypress', function(chunk, key) {
// process the keypresses
if (key) {
switch (key.name) {
case "up":
l_motor.reverse(max_speed_l);
r_motor.forward(max_speed_r);
break;
case "down":
r_motor.reverse(max_speed_r);
l_motor.forward(max_speed_l);
break;
case "left":
l_motor.forward(max_speed_l);
r_motor.forward(max_speed_r);
break;
case "right":
r_motor.reverse(max_speed_r);
l_motor.reverse(max_speed_l);
break;
case "space":
l_motor.stop();
r_motor.stop();
break;
}
}
});