Switched to using hubo_robot_msgs Trajectories instead of vanilla trajectory_msgs.
Changed to drchubo with underscores.
Making sure published plan state always has a timestamp.
Added separate TF tree for planning nodes.