minimize total contact force and ang. mom. and enable yaw

This gives much more reasonable walking gaits, without giving up the
ability to jump when necessary. It seems to work reasonably quickly
(20s) for 12 frames in 6 regions