revive kinect_drive_and_reach
requires openrave > 0.8 and pcl > 1.6
removed wrong assert