function GoMotor(m1Dir: number, m1Speed: number, m2Dir: number, m2Speed: number, time: number) {
    switch (m1Dir) {
        case 0:
            pins.analogWritePin(AnalogPin.P8, m1Speed * 10);
            pins.digitalWritePin(DigitalPin.P12, 0);
            break;
        case 1:
            pins.analogWritePin(AnalogPin.P12, m1Speed * 10);
            pins.digitalWritePin(DigitalPin.P8, 0);
            break;
    }
    switch (m2Dir) {
        case 0:
            pins.analogWritePin(AnalogPin.P0, m2Speed * 10);
            pins.digitalWritePin(DigitalPin.P16, 0);
            break;
        case 1:
            pins.analogWritePin(AnalogPin.P16, m2Speed * 10);
            pins.digitalWritePin(DigitalPin.P0, 0);
            break;
    }
    //basic.pause(time)
    // Stop motor 1
    pins.digitalWritePin(DigitalPin.P8, 0)
    pins.digitalWritePin(DigitalPin.P12, 0)
    // Stop motor 2
}

function Forward(speed: number, time: number) {
    GoMotor(0, speed, 0, speed, time)
}
function Reverse(speed: number, time: number) {
    GoMotor(1, speed, 1, speed, time)
}
function Left(time: number) {
    GoMotor(0, 50, 1, 50, time)
}
function Right(time: number) {
    GoMotor(1, 50, 0, 50, time)
}

function Stop() {
    pins.digitalWritePin(DigitalPin.P0, 0)
    pins.digitalWritePin(DigitalPin.P16, 0)
}

radio.setGroup(1)
basic.showString("OK")

radio.onReceivedString(function (receivedString: string) {
    basic.showString(receivedString)

    if (receivedString.substr(0, 1) == "N")
        Forward(50, 1000)
    else if (receivedString.substr(0, 1) == "S")
        Reverse(50, 1000)
    else
        Stop()
})


basic.forever(function () {
})