added feedback control of ankle position
some exploration of math ideas
very simple multi-step recovery with step limits
much simpler capture model in 2D using real capture point