Implement a smoother emergency stop

The emergency stop now has two phases.  The first phase stops normally by
setting the target speed to zero, the second kicks in after another half second
to ground the power wires.  This should both protect against the control
program dying, and against bugs in the PID controller.

Signed-off-by: Morten Hustveit <morten.hustveit@gmail.com>