Drift correction using Landmarks

[vortexuser]

Map Landmarks you have seen, and then when you revisit them do drift correction in the ESKF.

[kluge7]

Mainly relevant for the Pipeline mission. Idea is to store the location of the landmarks we have seen (ArUco marker, start of pipeline), and then when we revist them (when we do the return home part of the mission) we use it as drift correction for the ESKF (temu loop closure)

[kluge7]

See related issue: vortexntnu/vortex-auv#608