The library is a basic dynamic simulator for kinematic chains. You just need to provide the symbolic Denavit-Hartenber parameter matrix. 'ComputeDynamics' function uses the Euler-Lagrange method to find the joint-space dynamics equation matrices. SimulateRobot function uses Euler method to simulate the kinematic chain. The rest of the functions are from my earlier submission "Simple Forward Kinematics library for robotic chains"
There is a clear and easy example of a 2DOF pendulum. Feel free to modify add and improve on the code.
P.S. The code still requires lots of development and testing. Testing needs to be done on different DH parameters. I didn't have the time to test for prismatic joints. And the performance is really slow. Any help is appreciated.
Create scripts with code, output, and formatted text in a single executable document.