mindstorms-robot-inventor-python/tricky/bowling_with_spin.py at main · rchigvintsev/mindstorms-robot-inventor-python · GitHub

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
from mindstorms import MSHub, Motor, MotorPair, ColorSensor, DistanceSensor, App
from mindstorms.control import wait_for_seconds, wait_until, Timer
from mindstorms.operator import greater_than, greater_than_or_equal_to, less_than, less_than_or_equal_to, equal_to, not_equal_to

ANIM_BOWLING = [
    '08970:89887:89857:89887:08970',
    '08970:89887:89887:89587:08970',
    '08970:89887:85887:89887:08970',
    '08970:89887:85887:89887:08970',
    '08970:89587:89887:89887:08970'
]

ANIM_CELEBRATE = [
    '00000:00000:00000:00000:00900',
    '00000:00000:00000:00900:00800',
    '00000:00000:00900:00800:00700',
    '00000:00000:00900:00500:00300',
    '00000:00000:00900:00100:00100',
    '00000:00600:06960:00600:00100',
    '00000:05750:07970:05750:00100',
    '00000:07970:09990:07970:00100',
    '70807:08980:89898:08980:70807',
    '90809:09890:98689:08980:90909',
    '90809:09690:96569:08680:90909',
    '70907:09190:90909:09090:70907',
    '07070:70907:09090:70907:07070',
    '70907:09090:90909:09090:70907',
    '60806:08080:80808:08080:60806',
    '40704:07070:70707:07070:40704',
    '30603:06060:60606:06060:30603',
    '50505:05050:50505:05050:50505',
    '00000:00000:00000:00000:00000'
]

wheels_motor_pair = MotorPair('B', 'A')

claw_motor = Motor('C')
spinner_motor = Motor('F')

distance_sensor = DistanceSensor('D')

hub = MSHub()
hub.light_matrix.set_orientation('upside down')

def start_animation_bowling():
    hub.light_matrix.start_animation(ANIM_BOWLING, 7, True, 'overlay', False)

def start_animation_celebrate():
    hub.light_matrix.start_animation(ANIM_CELEBRATE, 8, False, 'overlay', False)

claw_motor.run_for_seconds(0.5, 50)
distance_sensor.light_up_all()

while True:
    distance_sensor.wait_for_distance_closer_than(10, 'cm')
    claw_motor.run_for_degrees(35, -50)
    spinner_motor.start(-100)
    start_animation_bowling()
    wait_for_seconds(1)

    hub.speaker.start_sound('Bowling')
    wheels_motor_pair.start(0, 100)
    claw_motor.run_for_seconds(0.2, 100)
    wheels_motor_pair.move(0.4, 'seconds', 0, 80)
    start_animation_celebrate()
    spinner_motor.stop()
    wheels_motor_pair.move(-16, 'cm', 0, 80)
    hub.speaker.play_sound('Strike')
    claw_motor.run_for_seconds(0.5, 50)