https://123dok.net/document/zx5oo7gd-position-force-control-nonsmooth-lagrangian-dynamical-systems-friction.html