https://intlibrary.ir/download/principles-of-robot-motion:-theory,-algorithms,-an-93801/