Uses the position and laser data reported by DATAPOSUPDATE and DATALASERUPDATE and maintains an occupancy grid map. The map tracks unknown, open, and occupied space.
Takes goal position requests and maintains a path from the current position to the closest goal. Multiple goals may be added and the requester must remove the goal when it is no longer valid (has been reached).