Clean up headers in MathConvert.h, Convert.h, and other dependencies.
Specialize YAML::convert<> for SurgSim::Math::Shape class.
Revise UnitTest for math shapes.