Corrected the method to get Pelvis Position
Fixed the method to read orientation angles and velocities
(for pelvis and feet, used in controlOrientation method)
Fixed reading foot position in setFootCoMDistRatio method
(it's used for controlling the ratio of mass distrib. between feet)
Fixed CoM controller PD command
(was removed before, COM state reading should be double-checked for this method)