Implemented BIT Star for point robot example