PID example

This commit is contained in:
Peli de Halleux 2018-01-08 14:06:39 -08:00
parent dd5e1957d5
commit f4b78c3ee7

View File

@ -0,0 +1,16 @@
```blocks
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
})
```