added matlab-based control;
refactored simulation;
added TacticalPlanner