Added unit tests package and services unit test
Merge branch 'master' of https://github.com/pemami4911/High-Level-Planner-CIMAR

THIS MERGE IS NECESSARY FOR REASONS
System status: Able to initialize sub-systems, parse config file, read in mdf/rndf files, and shutdown properly