Zebulon: Implement mpc-walkgen as a parametric SQP and add a local obstacle avoidance

Change-Id: Icf48111339d66e65e2c32eead1d844dbec44416b
Improve weigtings for zebulon

Change-Id: Id0abbc2830106c0a57e775886a8420a089195649