BrooklynAPI/StressTest.py at master · gatordevin/BrooklynAPI · 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
import brooklyn as brd
import time
import keyboard
import random
test = brd.Brooklyn("COM6")
test.setcard(1, brd.EMPIRE_STATE)
test.setcard(2, brd.EMPIRE_STATE)
test.setcard(3, brd.EMPIRE_STATE)
test.setcard(4, brd.EMPIRE_STATE)

test.begin()

motors = [test.getmotor(1,1),test.getmotor(1,2),test.getmotor(2,1),test.getmotor(2,2),test.getmotor(3,1),test.getmotor(3,2),test.getmotor(4,1),test.getmotor(4,2)]


def driveMotors(val):
    for i in motors:
        i.setPWM(val)

def driveMotorsTurn(val):
    motors[0].setPWM(val)
    motors[1].setPWM(val)
    motors[4].setPWM(val)
    motors[5].setPWM(val)
    motors[2].setPWM(-val)
    motors[3].setPWM(-val)
    motors[6].setPWM(-val)
    motors[7].setPWM(-val)

while True:
    driveMotors(255)
    if keyboard.is_pressed('`'):
        driveMotors(0)
        test.end()