In the process of implenting iterativeDynamics.

Also changed general dynamics to only first order taylor and precission
in rRvDynamics changed to be beased on acceleration.
Include iterative dynamics. Still buggy