Mapping Integration

[kimichenn]

• Implement (fake) mapping tick when manual landing is called.
• It does a two pass system (like the mapping integration test), and then it stays in manual landing.
• This is done through a new isMappingDone state variable, which is set to true after mapping is done after the second pass.
• Mapping is also updated to allow a single pass system, though after some naive testing, it doesn't seem to be performing well, so we're still sticking to the two pass system.
• For future work, we probably should implement multithreading for the first pass (see Mapping Multithreading #254)

[AskewParity]

Looks good to me, we should still SITL test it.