@@ -255,7 +255,7 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
255255
256256 c2 = m_J.trace ();
257257#ifdef EIQGUADPROG_TRACE_SOLVER
258- utils::print_matrix (" m_J" , m_J, nVars );
258+ utils::print_matrix (" m_J" , m_J);
259259#endif
260260
261261 /* c1 * c2 is an estimate for cond(Hess) */
@@ -283,7 +283,7 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
283283 f_value = 0.5 * g0.dot (x);
284284#ifdef EIQGUADPROG_TRACE_SOLVER
285285 std::cerr << " Unconstrained solution: " << f_value << std::endl;
286- utils::print_vector (" x" , x, nVars );
286+ utils::print_vector (" x" , x);
287287#endif
288288 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_1_UNCONSTR_MINIM);
289289
@@ -299,10 +299,10 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
299299 update_r (R, r, d, iq);
300300
301301#ifdef EIQGUADPROG_TRACE_SOLVER
302- utils::print_matrix (" R" , R, iq );
303- utils::print_vector (" z" , z, nVars );
304- utils::print_vector (" r" , r, iq );
305- utils::print_vector (" d" , d, nVars );
302+ utils::print_matrix (" R" , R);
303+ utils::print_vector (" z" , z);
304+ utils::print_vector (" r" , r);
305+ utils::print_vector (" d" , d);
306306#endif
307307
308308 /* compute full step length t2: i.e.,
@@ -386,7 +386,7 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
386386 START_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_1);
387387
388388#ifdef EIQGUADPROG_TRACE_SOLVER
389- utils::print_vector (" x" , x, nVars );
389+ utils::print_vector (" x" , x);
390390#endif
391391 /* step 1: choose a violated constraint */
392392 for (i = nEqCon; i < iq; i++) {
@@ -414,7 +414,7 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
414414#endif
415415 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_1_2);
416416#ifdef EIQGUADPROG_TRACE_SOLVER
417- utils::print_vector (" s" , s, nIneqCon );
417+ utils::print_vector (" s" , s);
418418#endif
419419
420420 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_1);
@@ -461,7 +461,7 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
461461
462462#ifdef EIQGUADPROG_TRACE_SOLVER
463463 std::cerr << " Trying with constraint " << ip << std::endl;
464- utils::print_vector (" np" , np, nVars );
464+ utils::print_vector (" np" , np);
465465#endif
466466 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_2);
467467
@@ -482,11 +482,11 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
482482 update_r (R, r, d, iq);
483483#ifdef EIQGUADPROG_TRACE_SOLVER
484484 std::cerr << " Step direction z" << std::endl;
485- utils::print_vector (" z" , z, nVars );
486- utils::print_vector (" r" , r, iq + 1 );
487- utils::print_vector (" u" , u, iq + 1 );
488- utils::print_vector (" d" , d, nVars );
489- utils::print_vector (" A" , A, iq + 1 );
485+ utils::print_vector (" z" , z);
486+ utils::print_vector (" r" , r);
487+ utils::print_vector (" u" , u);
488+ utils::print_vector (" d" , d);
489+ utils::print_vector (" A" , A);
490490#endif
491491 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_2A);
492492
@@ -539,9 +539,9 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
539539 delete_constraint (R, m_J, A, u, nEqCon, iq, l);
540540#ifdef EIQGUADPROG_TRACE_SOLVER
541541 std::cerr << " in dual space: " << f_value << std::endl;
542- utils::print_vector (" x" , x, nVars );
543- utils::print_vector (" z" , z, nVars );
544- utils::print_vector (" A" , A, iq + 1 );
542+ utils::print_vector (" x" , x);
543+ utils::print_vector (" z" , z);
544+ utils::print_vector (" A" , A);
545545#endif
546546 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_2C);
547547 goto l2a;
@@ -557,25 +557,25 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
557557
558558#ifdef EIQGUADPROG_TRACE_SOLVER
559559 std::cerr << " in both spaces: " << f_value << std::endl;
560- utils::print_vector (" x" , x, nVars );
561- utils::print_vector (" u" , u, iq + 1 );
562- utils::print_vector (" r" , r, iq + 1 );
563- utils::print_vector (" A" , A, iq + 1 );
560+ utils::print_vector (" x" , x);
561+ utils::print_vector (" u" , u);
562+ utils::print_vector (" r" , r);
563+ utils::print_vector (" A" , A);
564564#endif
565565
566566 if (t == t2) {
567567#ifdef EIQGUADPROG_TRACE_SOLVER
568568 std::cerr << " Full step has taken " << t << std::endl;
569- utils::print_vector (" x" , x, nVars );
569+ utils::print_vector (" x" , x);
570570#endif
571571 /* full step has taken */
572572 /* add constraint ip to the active set*/
573573 if (!add_constraint (R, m_J, d, iq, R_norm)) {
574574 iaexcl (ip) = 0 ;
575575 delete_constraint (R, m_J, A, u, nEqCon, iq, ip);
576576#ifdef EIQGUADPROG_TRACE_SOLVER
577- utils::print_matrix (" R" , R, nVars );
578- utils::print_vector (" A" , A, iq );
577+ utils::print_matrix (" R" , R);
578+ utils::print_vector (" A" , A);
579579#endif
580580 for (i = 0 ; i < nIneqCon; i++) iai (i) = static_cast <VectorXi::Scalar>(i);
581581 for (i = 0 ; i < iq; i++) {
@@ -589,8 +589,8 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
589589 } else
590590 iai (ip) = -1 ;
591591#ifdef EIQGUADPROG_TRACE_SOLVER
592- utils::print_matrix (" R" , R, nVars );
593- utils::print_vector (" A" , A, iq );
592+ utils::print_matrix (" R" , R);
593+ utils::print_vector (" A" , A);
594594#endif
595595 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_2C);
596596 goto l1;
@@ -603,10 +603,10 @@ EiquadprogFast_status EiquadprogFast::solve_quadprog(
603603
604604#ifdef EIQGUADPROG_TRACE_SOLVER
605605 std::cerr << " Partial step has taken " << t << std::endl;
606- utils::print_vector (" x" , x, nVars );
607- utils::print_matrix (" R" , R, nVars );
608- utils::print_vector (" A" , A, iq );
609- utils::print_vector (" s" , s, nIneqCon );
606+ utils::print_vector (" x" , x);
607+ utils::print_matrix (" R" , R);
608+ utils::print_vector (" A" , A);
609+ utils::print_vector (" s" , s);
610610#endif
611611 STOP_PROFILER_EIQUADPROG_FAST (EIQUADPROG_FAST_STEP_2C);
612612
0 commit comments