Underwater navigation and mapping with an omnidirecional optical sensor