Nav Stack: Testing suite

[jeff-hykin]

• switch to Mujoco based sim, delete unity sim
• have named points tied to a map instead of hardcoded numbers
• cross-wall test in mujoco
• add a better loop closure test using a real simulator and simulated drift