Test hip flexibility compensation on a walking motion

I've integrated hip flexibility compensation for a walking motion in my fork on branch topic/hip_flex_trajectory. I have tested it in simulation, but I did it with infinite rigidity, just to confirm that the graph is working, as it does not make sense to compensate the flexibility in simulation. We should test this on the real robot