Fix kinect_control endless loop