add nod function for pr2

implement simplest nod function for pr2 . jsk-ros-pkg/jsk_robot#168