Function iterative_linear_mpc_control 

pub fn iterative_linear_mpc_control(
    xref: &[Vector4<f64>],
    state: &State,
    warm_start: &[Vector2<f64>],
) -> MpcResult