[cpp][header][test] 3 new function implemente & many change in unittest
Can't show this merge request because the source branch TheophaneL:dev is missing from project stack-of-tasks/sot-dynamic-pinocchio. Close this merge request or update the source branch.