Added parsing of covariance params.
Updated manifest with unlisted dependencies + new deps for testing.
Adding test infrastructure to controller with dummy robot + test node skeleton.