pxt-tank/main.ts at master · INGcoderdojoMicrobit/pxt-tank · 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
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
radio.onReceivedString(function (receivedString) {
    lpredkosc = parseInt(receivedString.substr(2, 3))
    lk = parseInt(receivedString.charAt(0))
    if (lk == 0) { lk = -1 }
    //
    ppredkosc = parseInt(receivedString.substr(5, 3))
    pk = parseInt(receivedString.charAt(1))
    if (pk == 0) { pk = -1 }
    klawisz = parseInt(receivedString.substr(8, 1))


    //serial.writeLine("l=" + lpredkosc + " w=" + lk + " p=" + ppredkosc + " w=" + pk)


    motor.MotorRun(motor.Motors.M1, lk, lpredkosc)
    //motor.MotorRun(motor.Motors.M3, -lk, lpredkosc)
    motor.MotorRun(motor.Motors.M2, -pk, ppredkosc)
    //motor.MotorRun(motor.Motors.M4, -pk, ppredkosc)

    if (klawisz==1) {
        //motor.servo(motor.Servos.S8,255)
        pins.analogWritePin(AnalogPin.P1, 1023)
    }
    if (klawisz==2) {
        motor.servo(motor.Servos.S8,0)
        pins.analogWritePin(AnalogPin.P1, 0)
    }

    doMalujBiegi(0, Math.floor(Math.map(lpredkosc, 0, 240, 0, 5)))
    doMalujBiegi(4, Math.floor(Math.map(ppredkosc, 0, 240, 0, 5)))
    //serial.writeLine("l=" + Math.map(ppredkosc, 0, 240, 0, 5))
    if (lk == -1) {
        led.plot(1, 0)
        led.unplot(1, 4)
    } else {
        led.plot(1, 4)
        led.unplot(1, 0)
    }
    if (pk == -1) {
        led.plot(3, 0)
        led.unplot(3, 4)
    } else {
        led.plot(3, 4)
        led.unplot(3, 0)
    }
})

let lpredkosc = 0
let ppredkosc = 0
let lk = 0
let pk = 0
let klawisz = 0
radio.setGroup(1)

//basic.showIcon(IconNames.Heart)

function doMalujBiegi(kol: number, ile: number) {
    for (let i = 0; i <= ile; i++) {
        led.plot(kol, 4 - i)
    }
    for (let i = ile; i <= 5; i++) {
        led.unplot(kol, 4 - i)
    }
}

basic.showIcon(IconNames.Heart)
basic.pause(1000)
if (input.buttonIsPressed(Button.A)
) {
    basic.showString("Demo!")
    motor.MotorRun(motor.Motors.M1, 1, 255)
    motor.MotorRun(motor.Motors.M2, -1, 255)
    basic.pause(1000)
    motor.MotorRun(motor.Motors.M1, 1, 255)
    motor.MotorRun(motor.Motors.M2, 1, 255)
    basic.pause(1000)
    motor.MotorRun(motor.Motors.M1, 1, 100)
    motor.MotorRun(motor.Motors.M2, -1, 100)
    basic.pause(1000)
    motor.MotorRun(motor.Motors.M1, -1, 100)
    motor.MotorRun(motor.Motors.M2, 1, 100)
    basic.pause(1000)
    motor.MotorRun(motor.Motors.M1, -1, 255)
    motor.MotorRun(motor.Motors.M2, 1, 255)
    basic.pause(1000)
    motor.motorStopAll()
    basic.showIcon(IconNames.Yes)
}
basic.clearScreen()