add mjd_transitionFD implementation

mujoco reference: https://github.com/google-deepmind/mujoco/blob/192da87475d5bd14c5d3f0ece075d30b7d742feb/src/engine/engine_derivative_fd.c#L538