Add behavior planner base logic

[mesmatyi]

Add a very basic logic for the behavior planner, and a relay for the Scenario -> TargetSpace messages