https://123dok.net/document/9ynv3dkz-semi-autonomous-trajectory-generation-for-mobile-robots-with-integral-haptic-shared-control.html