https://mixrolikus.cc/video/67xDIyiu7oA/robotics-2-robotics-toolbox-by-peter-corke-for-python