Add new nodelet to pass pointcloud only if joint states is stable