Trajectory action should abort on robot error.

When a robot status message is received with a non-zero error code, any active trajectory goal should be aborted.  Without this, the only way to know that a failure has happened is for the action client to time-out.

Also fixed some compiler warnings about printing unsigned integers with %d format.