1

0

Sens - Ref

S + 1024 WHEN (S <= -512) S - 1024 WHEN (S >= 512) S OTHERWISE

diff[-1]

Kp * Error

32

P < 0

-P WHEN (P < 0) P OTHERWISE

O[-1] / 16