https://123dok.net/document/4yrv5mjq-efficient-trajectories-computing-using-inversibilities-properties.html