toward a fully autonomous uav : research platform for indoor and outdoor urban search and rescue .
An ICP variant using a point-to-line metric