- fix bugs in computation of force inequalities (min normal force was wrong, ZMP limits were wrong)
- add monitor parameters for plotting ZMP and friction cone limits
- use parameter “numerical damping” in solver rather than fixed value (i.e. 1e-6)
- modify size of iCub’s feet used to compute ZMP limits
Add yarpscope file to plot ZMP and friction cone constraints