externally set qdotdot now used in integration step
sets the qdotdot for the dynamics model to integrate