Added gtest unit testing framework. Converted kinematic_maps over to use that framework.
Removed old headers and comments from new kinematic maps unit tests.