Added sagittal and lateral squatting primitives for PID tests (open loop)

Lateral squatting also turns out a quite stable trajectory, while sagittal is totally unstable
Merge branch 'master' of https://github.com/EnricoMingo/coman_yarp_apps