https://5dok.org/document/wq27w42y-a-method-for-collision-handling-for-industrial-robots.html