https://123dok.co/document/zx5x11ov-force-control-of-manipulators.html