Efficient scene modeling for underwater ROV driving