Always calculate the error.

Gives nicer, continuous graphs in the status output msgs.
Clean up comments.
Turn friction compensation back on.
iDouble the rate of PID processing.