* Fixed a big bug in getJointPositions
* Fixed a bug in which the collision objects weren't being put in the right marker_array