Remove unnecessary methods
Special case z axis code
Basic instansiation of collision object child class
Sketched outline for collision shape
Merge branch 'corde' of https://github.com/NASA-Tensegrity-Robotics-Toolkit/NTRTsim into corde