Improve foot behaviour
There are three problems with the foot behaviour when it is raised:
- It is not fixed in the world frame
- It is visibly vibrating
- We could not put it back in the right position
I analysed the signals and I think I identified the reason for the second point. In fact, the reference ZMP is vibrating a lot in simulation.
We are definitely going to run more experiments with the foot raised to explore these problems