-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathbot.js
88 lines (68 loc) · 1.65 KB
/
bot.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
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
/*
With much credit to @BrianGenisio, this code is almost entirely his.
https://github.com/CareEvolution/nodebots-unleashed-codemash-docs/blob/master/examples/base-sumobot.js
*/
var five = require("johnny-five");
var Particle = require("particle-io");
var board = new five.Board({
io: new Particle({
token: process.env.PARTICLE_TOKEN,
deviceName: process.env.PARTICLE_DEVICE_NAME
})
});
board.on("ready", function() {
console.log('ready');
var leftWheelSpeedPin = 'D0';
var leftWheelDirPin = 'D1';
var rightWheelSpeedPin = 'D3';
var rightWheelDirPin = 'D2';
var rightWheel = new five.Motor({
pins: { pwm: rightWheelSpeedPin, dir: rightWheelDirPin },
invertPWM: true
});
var leftWheel = new five.Motor({
pins: { pwm: leftWheelSpeedPin, dir: leftWheelDirPin },
invertPWM: true
});
var speed = 255;
function reverse() {
leftWheel.rev(speed);
rightWheel.rev(speed);
}
function forward() {
leftWheel.fwd(speed);
rightWheel.fwd(speed);
}
function stop() {
leftWheel.stop();
rightWheel.stop();
}
function left() {
leftWheel.rev(speed);
rightWheel.fwd(speed);
}
function right() {
leftWheel.fwd(speed);
rightWheel.rev(speed);
}
function exit() {
leftWheel.rev(0);
rightWheel.rev(0);
setTimeout(process.exit, 1000);
}
var keyMap = {
'up': forward,
'down': reverse,
'left': left,
'right': right,
'space': stop,
'q': exit
};
var stdin = process.stdin;
stdin.setRawMode(true);
stdin.resume();
stdin.on("keypress", function(chunk, key) {
if (!key || !keyMap[key.name]) return;
keyMap[key.name]();
});
});