cog posture/gait controller
wrote cog posture. gait controller

no compile problems
needs hard test to optimize of gains
includes following compensations
- with body orientation
- with lean
- target COG
backup before changing posture/gait