https://123dok.net/document/zx5o6lwd-robust-motion-planning-safety-benchmarking-human-workspaces.html