[Behaviours/2] Navigator refactor: fill in implementation for the BehaviorTree Tasks

After the stubbed out Tasks have been created, write the actual implementation for each Task