Write entrance gate mission

[kev-the-dev]

Write a mission for the entrance gate task, which involves going between two totems with the active pinger, circling either a totem or light buoy if it is on.

This is just the "mission" side of the code. You can use ground truth from simulation to test the mission while the perception is being developed.