add effort to robot state
use trajectory_msgs::JointTrajectory for object attach information instead of sensor_msgs::JointState
Merge branch 'hydro-devel' into pick_place_traj
Merge branch 'pick_place_traj' into hydro-devel
add cyan color
minor fixes
switch to debug msg
add some comments and improve message output