Added torque minimization without using QP
Init file balancing V2