Improve safety features.

Includes the addition of new pickup detection code that
automatically disables the wheels.
Logging and bug fixes.

Actually tested some of the recent changes on the robot, and
fixed the ensuing problems.