bugfixes, plan compatibility, and faster conic constraints

fix some bugs to get the humanoids2014 demos working and output normal
FootstepPlan objects.

Also, it turns out that a conic constraint on the max foot velocity
gives better results faster than the x-y abs linear constraint. Cool!