Started preparing for Replacing state

- Also made sure units cannot be placed outside navigation mesh