Created by: jmirabel
https://github.com/stack-of-tasks/sot-hpp/blob/0fd9dbb5cbda99571f0f6d9e5594b66898edc8ec/sot_hpp/tools.py#L62