Minor fixes and log updates.
Minor fixes and log updates.

ScazLab/baxter_collaboration,ScazLab/baxter_collaboration,ScazLab/human_robot_collaboration,ScazLab/baxter_collaboration,ScazLab/human_robot_collaboration,ScazLab/human_robot_collaboration,ScazLab/baxter_collaboration,ScazLab/human_robot_collaboration