Converted all getters/setters for generalized coordinates/velocities/accelerations/forces to shared vectors