diff --git a/docs/examples/line-follower-pid.md b/docs/examples/line-follower-pid.md new file mode 100644 index 00000000..fb8c5ca1 --- /dev/null +++ b/docs/examples/line-follower-pid.md @@ -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 +}) +``` \ No newline at end of file