-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathmain.ts
More file actions
98 lines (98 loc) · 2.81 KB
/
main.ts
File metadata and controls
98 lines (98 loc) · 2.81 KB
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
89
90
91
92
93
94
95
96
97
98
/**
* Infra-red Control Mode
*/
IrRemote.onPressEvent(RemoteButton.D, function () {
basic.showLeds(`
. . # . .
. # . . .
# # # # #
. # . . .
. . # . .
`)
magicbit.MotorRunDual(magicbit.Motors.M1, 150, magicbit.Motors.M4, -150)
})
/**
* Control which program to run
*/
input.onButtonPressed(Button.A, function () {
numProgram = (numProgram + 1) % 3
magicbit.MotorRunDual(magicbit.Motors.M1, 0, magicbit.Motors.M4, 0)
basic.showString("" + (numProgram))
basic.pause(1000)
magicbit.MotorRunDual(magicbit.Motors.M1, 0, magicbit.Motors.M4, 0)
})
IrRemote.onPressEvent(RemoteButton.UP, function () {
basic.showLeds(`
. . . . .
. . . . .
# # # # #
. . . . .
. . . . .
`)
magicbit.MotorRunDual(magicbit.Motors.M1, 0, magicbit.Motors.M4, 0)
})
IrRemote.onPressEvent(RemoteButton.A, function () {
basic.showLeds(`
. . # . .
. # # # .
# . # . #
. . # . .
. . # . .
`)
magicbit.MotorRunDual(magicbit.Motors.M1, 150, magicbit.Motors.M4, 150)
})
IrRemote.onPressEvent(RemoteButton.B, function () {
basic.showLeds(`
. . # . .
. . # . .
# . # . #
. # # # .
. . # . .
`)
magicbit.MotorRunDual(magicbit.Motors.M1, -150, magicbit.Motors.M4, -150)
})
IrRemote.onPressEvent(RemoteButton.C, function () {
basic.showLeds(`
. . # . .
. . . # .
# # # # #
. . . # .
. . # . .
`)
magicbit.MotorRunDual(magicbit.Motors.M1, -150, magicbit.Motors.M4, 150)
})
let ultraDistance = 0
let numProgram = 0
music.setVolume(135)
numProgram = 0
IrRemote.init(Pins.P1)
/**
* Ultra sonic
*
* Robot sumo mode
*/
basic.forever(function () {
if (numProgram == 0) {
pins.digitalWritePin(DigitalPin.P12, 1)
basic.pause(100)
pins.digitalWritePin(DigitalPin.P12, 0)
ultraDistance = pins.pulseIn(DigitalPin.P2, PulseValue.High) / 58
if (ultraDistance > 20) {
if (randint(0, 1) == 0) {
magicbit.MotorRunDual(magicbit.Motors.M1, 120, magicbit.Motors.M4, -120)
magicbit.Servo(magicbit.Servos.S1, 0)
} else {
magicbit.Servo(magicbit.Servos.S1, 180)
magicbit.MotorRunDual(magicbit.Motors.M1, -120, magicbit.Motors.M4, 120)
}
} else if (ultraDistance < 5) {
magicbit.MotorRunDual(magicbit.Motors.M1, -150, magicbit.Motors.M4, -130)
basic.pause(100)
magicbit.MotorRunDual(magicbit.Motors.M1, -120, magicbit.Motors.M4, 120)
basic.pause(randint(200, 1000))
} else {
magicbit.Servo(magicbit.Servos.S1, 90)
magicbit.MotorRunDual(magicbit.Motors.M1, 150, magicbit.Motors.M4, 150)
}
}
})