pxt-ev3/docs/examples/line-follower-pid.md
Peli de Halleux f4b78c3ee7 PID example
2018-01-08 14:06:39 -08:00

317 B

let lasterror = 0
let D = 0
let I = 0
let P = 0
let error = 0
loops.forever(function () {
    error = sensors.color3.light(LightIntensityMode.Reflected) - 35
    P = error * 5
    I = I + error * 0.01
    D = (error - lasterror) * 0.2
    motors.largeBC.steer(P + (I + D), 100)
    lasterror = error
})