This is the code to compute the forward and inverse kinematics for the humanoid robot HOAP-3 arms in real time. The inverse of the Jacobian is computed as a pseudoinverse. In folder "docs" you can find the manual with DH parameters.
For more information please visit my blog or my youtube channel