RoboticExplorationLab/RobotDynamics.jl

Implement `discrete_dynamics!` and `jacobian!` for implicit integrators using Newton and IFT

Closed this issue · 0 comments

Right now implicit integrators can only call dynamics_error! and related functions. We can use implicit integrators as drop-in replacements for explicit ones by using Newton's method to solve for the next state (defining discrete_dynamics!) and the implicit function theorem to get the dynamics Jacobian (defining jacobian!).