sidedriver: some improvements in PID controller