Precise Vehicle Position and Heading Estimation Using a Binary Road Marking Map

Algorithm 1

ICP algorithm.

Input: Two point cloud dat Local

Output: The correct transformation which aligns Map and Local map

While

 for

 if

 elseif

  end

 end

end