Fixed message stamps to use ros::Time::now() instead of the time from hubo-ach
Added handling for additional error cases
Updated readme to reflect ongoing work
Added PointHead action
Added end-effector pose action for use with async teleop