====== pen part ======

==== These codes control the servo motor to raise or lower the pen when I press different buttons ====

basic.forever(function () {
    if (input.buttonIsPressed(Button.A)) {
        wuKong.setServoSpeed(wuKong.ServoList.S0, 20)
    } else {
        wuKong.setServoSpeed(wuKong.ServoList.S0, -100)
    }
})