Added AssignmentPlanerRunnable, and updated Mainbus, CalculateTrajectory and MatlabProxyConnection