https://junpark-ai.github.io/posts/robotics-6/
Robotics - Chapter 6. Robot Statics - Jun Park