Accelerations of the CoM and swing foot are variables in WB control.
compute_robot_constraints is now calls for trajectory generation function.
compute_robot_objective merged into form_objective.
Use raw MPC solution in compute_robot_constraints.