GCC Code Coverage Report

Directory:	./
File:	tests/test-transition.cpp
Date:	2025-04-18 04:07:36

	Exec	Total	Coverage
Lines:	539	539	100.0%
Branches:	1760	3488	50.5%

Line	Branch	Exec	Source
1			//
2			// Copyright (c) 2018 CNRS
3			// Authors: Pierre Fernbach
4			//
5			// This file is part of bezier_COM_traj
6			// hpp-core is free software: you can redistribute it
7			// and/or modify it under the terms of the GNU Lesser General Public
8			// License as published by the Free Software Foundation, either version
9			// 3 of the License, or (at your option) any later version.
10			//
11			// hpp-core is distributed in the hope that it will be
12			// useful, but WITHOUT ANY WARRANTY; without even the implied warranty
13			// of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14			// General Lesser Public License for more details. You should have
15			// received a copy of the GNU Lesser General Public License along with
16			// hpp-core If not, see
17			// <http://www.gnu.org/licenses/>.
18
19			#define BOOST_TEST_MODULE transition
20			#include <boost/test/included/unit_test.hpp>
21			#include <hpp/bezier-com-traj/common_solve_methods.hh>
22			#include <hpp/bezier-com-traj/data.hh>
23			#include <hpp/bezier-com-traj/solve.hh>
24			#include <hpp/centroidal-dynamics/centroidal_dynamics.hh>
25
26			#include "test_helper.hh"
27
28			#define NOMINAL_COM_HEIGHT 0.795
29
30		47	std::vector<double> computeDiscretizedTime(const VectorX& phaseTimings,
31			const int pointsPerPhase) {
32		47	std::vector<double> timeArray;
33		47	double t = 0;
34		47	double t_total = 0;
35	3/4 ✓ Branch 1 taken 135 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 135 times. ✓ Branch 5 taken 47 times.	182	for (long int i = 0; i < phaseTimings.size(); ++i) t_total += phaseTimings[i];
36
37	2/2 ✓ Branch 1 taken 135 times. ✓ Branch 2 taken 47 times.	182	for (long int i = 0; i < phaseTimings.size(); ++i) {
38	1/2 ✓ Branch 1 taken 135 times. ✗ Branch 2 not taken.	135	double step = (double)phaseTimings[i] / pointsPerPhase;
39	2/2 ✓ Branch 0 taken 675 times. ✓ Branch 1 taken 135 times.	810	for (int j = 0; j < pointsPerPhase; ++j) {
40		675	t += step;
41	1/2 ✓ Branch 1 taken 675 times. ✗ Branch 2 not taken.	675	timeArray.push_back(t);
42			}
43			}
44		47	timeArray.pop_back();
45	1/2 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken.	47	timeArray.push_back(t_total); // avoid numerical errors
46		94	return timeArray;
47			}
48
49		763	bool check_constraints(const bezier_com_traj::ContactData& contactPhase,
50			Vector3 c, Vector3 dc, Vector3 ddc) {
51	7/14 ✓ Branch 3 taken 763 times. ✗ Branch 4 not taken. ✓ Branch 9 taken 763 times. ✗ Branch 10 not taken. ✓ Branch 12 taken 763 times. ✗ Branch 13 not taken. ✓ Branch 15 taken 763 times. ✗ Branch 16 not taken. ✓ Branch 18 taken 763 times. ✗ Branch 19 not taken. ✓ Branch 21 taken 763 times. ✗ Branch 22 not taken. ✗ Branch 27 not taken. ✓ Branch 28 taken 763 times.	763	BOOST_CHECK(verifyKinematicConstraints(
52			std::make_pair(contactPhase.Kin_, contactPhase.kin_), c));
53	10/20 ✓ Branch 3 taken 763 times. ✗ Branch 4 not taken. ✓ Branch 9 taken 763 times. ✗ Branch 10 not taken. ✓ Branch 12 taken 763 times. ✗ Branch 13 not taken. ✓ Branch 15 taken 763 times. ✗ Branch 16 not taken. ✓ Branch 18 taken 763 times. ✗ Branch 19 not taken. ✓ Branch 21 taken 763 times. ✗ Branch 22 not taken. ✓ Branch 24 taken 763 times. ✗ Branch 25 not taken. ✓ Branch 27 taken 763 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 763 times. ✗ Branch 31 not taken. ✗ Branch 36 not taken. ✓ Branch 37 taken 763 times.	763	BOOST_CHECK(
54			verifyStabilityConstraintsDLP(*contactPhase.contactPhase_, c, dc, ddc));
55	10/20 ✓ Branch 3 taken 763 times. ✗ Branch 4 not taken. ✓ Branch 9 taken 763 times. ✗ Branch 10 not taken. ✓ Branch 12 taken 763 times. ✗ Branch 13 not taken. ✓ Branch 15 taken 763 times. ✗ Branch 16 not taken. ✓ Branch 18 taken 763 times. ✗ Branch 19 not taken. ✓ Branch 21 taken 763 times. ✗ Branch 22 not taken. ✓ Branch 24 taken 763 times. ✗ Branch 25 not taken. ✓ Branch 27 taken 763 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 763 times. ✗ Branch 31 not taken. ✗ Branch 36 not taken. ✓ Branch 37 taken 763 times.	763	BOOST_CHECK(
56			verifyStabilityConstraintsPP(*contactPhase.contactPhase_, c, dc, ddc));
57		763	return true;
58			}
59
60		47	void discretized_check(const bezier_com_traj::ProblemData& pData,
61			const VectorX& Ts,
62			const bezier_com_traj::ResultDataCOMTraj& res,
63			const int pointsPerPhase, const double t_total) {
64			// check if timing is respected
65	1/2 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken.	47	std::vector<double> timings = computeDiscretizedTime(Ts, pointsPerPhase);
66	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(timings.back(), t_total);
67
68	3/6 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 47 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 47 times. ✗ Branch 8 not taken.	47	Vector3 c, dc, ddc;
69	1/2 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken.	47	bezier_com_traj::bezier_t ct = res.c_of_t_;
70	1/2 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken.	47	bezier_com_traj::bezier_t dct = ct.compute_derivate(1);
71	1/2 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken.	47	bezier_com_traj::bezier_t ddct = dct.compute_derivate(1);
72
73	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(ct.min(), 0);
74	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(dct.min(), 0);
75	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(ddct.min(), 0);
76	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(ct.max(), t_total);
77	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(dct.max(), t_total);
78	5/10 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✗ Branch 18 not taken. ✓ Branch 19 taken 47 times.	47	BOOST_CHECK_EQUAL(ddct.max(), t_total);
79
80			// check if each discretized point is feasible :
81
82			std::vector<int>
83		47	stepIdForPhase; // stepIdForPhase[i] is the id of the last step of phase
84			// i / first step of phase i+1 (overlap)
85	2/2 ✓ Branch 1 taken 135 times. ✓ Branch 2 taken 47 times.	182	for (int i = 0; i < Ts.size(); ++i)
86	1/2 ✓ Branch 1 taken 135 times. ✗ Branch 2 not taken.	135	stepIdForPhase.push_back(pointsPerPhase * (i + 1) - 1);
87		47	std::size_t id_phase = 0;
88	1/2 ✓ Branch 2 taken 47 times. ✗ Branch 3 not taken.	47	bezier_com_traj::ContactData phase = pData.contacts_[id_phase];
89
90	2/2 ✓ Branch 1 taken 675 times. ✓ Branch 2 taken 47 times.	722	for (size_t id_step = 0; id_step < timings.size(); ++id_step) {
91	1/2 ✓ Branch 2 taken 675 times. ✗ Branch 3 not taken.	675	c = ct(timings[id_step]);
92	1/2 ✓ Branch 2 taken 675 times. ✗ Branch 3 not taken.	675	dc = dct(timings[id_step]);
93	1/2 ✓ Branch 2 taken 675 times. ✗ Branch 3 not taken.	675	ddc = ddct(timings[id_step]);
94
95			// check i (c,dc,ddc) verify the constraints of current phase
96	4/8 ✓ Branch 1 taken 675 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 675 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 675 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 675 times. ✗ Branch 11 not taken.	675	check_constraints(phase, c, dc, ddc);
97
98			// check if we switch phases
99	2/2 ✓ Branch 1 taken 1320 times. ✓ Branch 2 taken 675 times.	1995	for (std::size_t i = 0; i < (stepIdForPhase.size() - 1); ++i) {
100	2/2 ✓ Branch 1 taken 88 times. ✓ Branch 2 taken 1232 times.	1320	if (id_step == (std::size_t)stepIdForPhase[i]) {
101		88	id_phase = i + 1;
102	1/2 ✓ Branch 2 taken 88 times. ✗ Branch 3 not taken.	88	phase = pData.contacts_[id_phase];
103	4/8 ✓ Branch 1 taken 88 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 88 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 88 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 88 times. ✗ Branch 11 not taken.	88	check_constraints(phase, c, dc, ddc);
104			}
105			}
106			}
107		47	}
108
109		51	void check_transition(bezier_com_traj::ProblemData& pData, VectorX Ts,
110			bool shouldFail = false, bool continuous = false,
111			bool test_continuous = true) {
112	5/10 ✓ Branch 1 taken 51 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 51 times. ✗ Branch 6 not taken. ✓ Branch 12 taken 51 times. ✗ Branch 13 not taken. ✓ Branch 15 taken 51 times. ✗ Branch 16 not taken. ✗ Branch 19 not taken. ✓ Branch 20 taken 51 times.	51	BOOST_CHECK_EQUAL(pData.contacts_.size(), Ts.size());
113
114		51	double t_total = 0;
115	3/4 ✓ Branch 1 taken 147 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 147 times. ✓ Branch 5 taken 51 times.	198	for (long int i = 0; i < Ts.size(); ++i) t_total += Ts[i];
116
117		51	int pointsPerPhase = 5;
118
119			// check if transition is feasible (should be)
120	1/2 ✓ Branch 1 taken 51 times. ✗ Branch 2 not taken.	51	bezier_com_traj::ResultDataCOMTraj res;
121	2/2 ✓ Branch 0 taken 28 times. ✓ Branch 1 taken 23 times.	51	if (continuous) {
122			// testing all available solvers
123	1/2 ✓ Branch 1 taken 28 times. ✗ Branch 2 not taken.	56	res = bezier_com_traj::computeCOMTraj(pData, Ts, -1,
124	1/2 ✓ Branch 1 taken 28 times. ✗ Branch 2 not taken.	28	solvers::SOLVER_QUADPROG);
125		28	if (pData.representation_ == bezier_com_traj::FORCE) {
126			/*bezier_com_traj::ResultDataCOMTraj res2 =
127			bezier_com_traj::computeCOMTraj(pData,Ts,-1,solvers::SOLVER_QUADPROG_SPARSE);
128			BOOST_CHECK(res.success_ == res2.success_);
129			if(res.success_)
130			{
131			std::cout << " x " << res.cost_ << std::endl;
132			std::cout << " x2 " << res2.cost_ << std::endl;
133			discretized_check(pData,Ts,res2,pointsPerPhase,t_total);
134			BOOST_CHECK(!res.success_ \|\| (res.x.head<3>() -
135			res2.x.head<3>()).norm() < EPSILON);
136			}*/
137			#ifdef USE_GLPK_SOLVER
138			// clock_t s0,e0;
139			// s0 = clock();
140			bezier_com_traj::ResultDataCOMTraj res3 =
141			bezier_com_traj::computeCOMTraj(pData, Ts, -1, solvers::SOLVER_GLPK);
142			// e0 = clock();
143			// std::cout<<"Time to perform full lp :
144			// "<<((double)(e0-s0)/CLOCKS_PER_SEC)*1000.<<" ms "<<std::endl;
145			BOOST_CHECK(res.success_ == res3.success_);
146			if (res3.success_) {
147			discretized_check(pData, Ts, res3, pointsPerPhase, t_total);
148			}
149			#endif
150			}
151			} else
152	2/4 ✓ Branch 1 taken 23 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 23 times. ✗ Branch 5 not taken.	23	res = bezier_com_traj::computeCOMTrajFixedSize(pData, Ts, pointsPerPhase);
153
154	2/2 ✓ Branch 0 taken 4 times. ✓ Branch 1 taken 47 times.	51	if (shouldFail) {
155	6/12 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 4 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 4 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 4 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 4 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 4 times.	4	BOOST_CHECK(!res.success_);
156	1/2 ✓ Branch 0 taken 4 times. ✗ Branch 1 not taken.	4	if (test_continuous) {
157	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	8	res = bezier_com_traj::computeCOMTraj(pData, Ts, -1,
158	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	solvers::SOLVER_QUADPROG);
159	6/12 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 4 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 4 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 4 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 4 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 4 times.	4	BOOST_CHECK(!res.success_);
160		4	pData.representation_ = bezier_com_traj::FORCE;
161	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	8	res = bezier_com_traj::computeCOMTraj(pData, Ts, -1,
162	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	solvers::SOLVER_QUADPROG);
163	6/12 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 4 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 4 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 4 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 4 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 4 times.	4	BOOST_CHECK(!res.success_);
164			#ifdef USE_GLPK_SOLVER
165			res =
166			bezier_com_traj::computeCOMTraj(pData, Ts, -1, solvers::SOLVER_GLPK);
167			BOOST_CHECK(!res.success_);
168			#endif
169			}
170		4	return;
171			}
172
173	6/12 ✓ Branch 1 taken 47 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 47 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 47 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 47 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 47 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 47 times.	47	BOOST_CHECK(res.success_);
174
175	2/4 ✓ Branch 0 taken 47 times. ✗ Branch 1 not taken. ✓ Branch 3 taken 47 times. ✗ Branch 4 not taken.	47	if (res.success_) discretized_check(pData, Ts, res, pointsPerPhase, t_total);
176	2/2 ✓ Branch 0 taken 28 times. ✓ Branch 1 taken 19 times.	47	if (continuous &&
177	2/2 ✓ Branch 0 taken 14 times. ✓ Branch 1 taken 14 times.	28	pData.representation_ == bezier_com_traj::DOUBLE_DESCRIPTION) {
178		14	pData.representation_ = bezier_com_traj::FORCE;
179	2/4 ✓ Branch 1 taken 14 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 14 times. ✗ Branch 5 not taken.	14	check_transition(pData, Ts, shouldFail, true);
180	4/4 ✓ Branch 0 taken 19 times. ✓ Branch 1 taken 14 times. ✓ Branch 2 taken 14 times. ✓ Branch 3 taken 5 times.	33	} else if (!continuous && test_continuous)
181	2/4 ✓ Branch 1 taken 14 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 14 times. ✗ Branch 5 not taken.	14	check_transition(pData, Ts, shouldFail, true);
182			else {
183	2/2 ✓ Branch 1 taken 55 times. ✓ Branch 2 taken 19 times.	74	for (size_t i = 0; i < pData.contacts_.size(); ++i) {
184	1/2 ✓ Branch 1 taken 55 times. ✗ Branch 2 not taken.	55	delete pData.contacts_[i].contactPhase_;
185			}
186			}
187	2/2 ✓ Branch 1 taken 47 times. ✓ Branch 2 taken 4 times.	51	}
188
189			BOOST_AUTO_TEST_SUITE(flat_ground)
190
191			// one step (left foot) : init pos of end effector : (0,0.1)(0,-0.1)
192			// end pos : (0.3,0.1)(0,-0.1)
193			// three phases : both feet in contact, only right feet, both feet
194
195		20	bezier_com_traj::ContactData phase0_flat() {
196	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	bezier_com_traj::ContactData cData;
197	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	MatrixX3 normals(2, 3), positions(2, 3);
198	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
199	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	positions.block<1, 3>(0, 0) = Vector3(0, 0.1, 0);
200	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	normals.block<1, 3>(1, 0) = Vector3(0, 0, 1);
201	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	positions.block<1, 3>(1, 0) = Vector3(0, -0.1, 0);
202			std::pair<MatrixX3, MatrixX3> contacts =
203	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	40	computeRectangularContacts(normals, positions, LX, LY);
204	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	40	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
205	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	ComputeContactCone(contacts.first, contacts.second));
206
207			ConstraintsPair kin1 =
208	5/10 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 20 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 20 times. ✗ Branch 14 not taken.	20	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0, -0.1, 0));
209			ConstraintsPair kin = stackConstraints(
210			kin1,
211	6/12 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 20 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 20 times. ✗ Branch 14 not taken. ✓ Branch 16 taken 20 times. ✗ Branch 17 not taken.	40	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0, 0.1, 0)));
212	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	cData.Kin_ = kin.first;
213	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	cData.kin_ = kin.second;
214
215		40	return cData;
216		20	}
217
218		21	bezier_com_traj::ContactData phase1_flat() {
219	1/2 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken.	21	bezier_com_traj::ContactData cData;
220	2/4 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken.	21	MatrixX3 normals(1, 3), positions(1, 3);
221	3/6 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 21 times. ✗ Branch 8 not taken.	21	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
222	3/6 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 21 times. ✗ Branch 8 not taken.	21	positions.block<1, 3>(0, 0) = Vector3(0, -0.1, 0);
223			std::pair<MatrixX3, MatrixX3> contacts =
224	3/6 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 21 times. ✗ Branch 8 not taken.	42	computeRectangularContacts(normals, positions, LX, LY);
225	2/4 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken.	42	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
226	2/4 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken.	21	ComputeContactCone(contacts.first, contacts.second));
227
228			ConstraintsPair kin =
229	5/10 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 21 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 21 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 21 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 21 times. ✗ Branch 14 not taken.	21	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0, -0.1, 0));
230	1/2 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken.	21	cData.Kin_ = kin.first;
231	1/2 ✓ Branch 1 taken 21 times. ✗ Branch 2 not taken.	21	cData.kin_ = kin.second;
232
233		42	return cData;
234		21	}
235
236		20	bezier_com_traj::ContactData phase2_flat() {
237	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	bezier_com_traj::ContactData cData;
238	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	MatrixX3 normals(2, 3), positions(2, 3);
239	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
240	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	positions.block<1, 3>(0, 0) = Vector3(0.3, 0.1, 0);
241	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	normals.block<1, 3>(1, 0) = Vector3(0, 0, 1);
242	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	20	positions.block<1, 3>(1, 0) = Vector3(0, -0.1, 0);
243			std::pair<MatrixX3, MatrixX3> contacts =
244	3/6 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken.	40	computeRectangularContacts(normals, positions, LX, LY);
245	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	40	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
246	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	ComputeContactCone(contacts.first, contacts.second));
247
248			ConstraintsPair kin1 =
249	5/10 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 20 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 20 times. ✗ Branch 14 not taken.	20	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0, -0.1, 0));
250			ConstraintsPair kin = stackConstraints(
251			kin1,
252	6/12 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 20 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 20 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 20 times. ✗ Branch 14 not taken. ✓ Branch 16 taken 20 times. ✗ Branch 17 not taken.	40	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0.3, 0.1, 0)));
253	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	cData.Kin_ = kin.first;
254	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	cData.kin_ = kin.second;
255
256		40	return cData;
257		20	}
258
259		20	bezier_com_traj::ProblemData gen_problem_data_flat() {
260		20	bezier_com_traj::ProblemData pData;
261	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	pData.c0_ = Vector3(0, 0, NOMINAL_COM_HEIGHT);
262	1/2 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken.	20	pData.c1_ = Vector3(0.15, 0, NOMINAL_COM_HEIGHT);
263	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.dc0_ = Vector3::Zero();
264	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.dc1_ = Vector3::Zero();
265	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.ddc0_ = Vector3::Zero();
266	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.ddc1_ = Vector3::Zero();
267
268	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.contacts_.push_back(phase0_flat());
269	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.contacts_.push_back(phase1_flat());
270	2/4 ✓ Branch 1 taken 20 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 20 times. ✗ Branch 5 not taken.	20	pData.contacts_.push_back(phase2_flat());
271
272		20	return pData;
273			}
274
275	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(quasi_static) {
276			// compute kinematic constraints for the right foot :
277			ConstraintsPair kin1 =
278	5/10 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken.	2	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0, -0.1, 0));
279			ConstraintsPair kin0 = stackConstraints(
280			kin1,
281	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken. ✓ Branch 16 taken 1 times. ✗ Branch 17 not taken.	4	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0, 0.1, 0)));
282			ConstraintsPair kin2 = stackConstraints(
283			kin1,
284	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken. ✓ Branch 16 taken 1 times. ✗ Branch 17 not taken.	4	generateKinematicsConstraints(Matrix3::Identity(), Vector3(0.3, 0.1, 0)));
285
286	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataMid = phase1_flat();
287	5/10 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken.	4	ConstraintsPair stab = generateStabilityConstraints(*cDataMid.contactPhase_);
288
289	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::pair<Matrix3, Vector3> Hg = computeCost();
290	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	Vector3 init = Vector3::Zero();
291
292	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_first = stackConstraints(kin0, stab);
293			bezier_com_traj::ResultData res_first =
294	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_first, Hg, init);
295	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(res_first.success_);
296
297	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_second = stackConstraints(kin2, stab);
298			bezier_com_traj::ResultData res_second =
299	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_second, Hg, init);
300	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(res_second.success_);
301	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataMid.contactPhase_;
302		2	}
303
304	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition) {
305	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
306	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
307	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
308	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
309		2	}
310
311	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_noc1) {
312	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
313		2	pData.constraints_.flag_ = bezier_com_traj::INIT_POS \|
314		2	bezier_com_traj::INIT_VEL \|
315			bezier_com_traj::END_VEL;
316	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
317	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
318	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
319		2	}
320
321	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_no_terminal_constraints) {
322	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
323		2	pData.contacts_.pop_back();
324		2	pData.contacts_.pop_back();
325		2	pData.constraints_.flag_ = bezier_com_traj::INIT_POS \|
326		2	bezier_com_traj::INIT_VEL \|
327			bezier_com_traj::INIT_ACC;
328	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(1);
329	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	Ts << 0.2;
330	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, false, false, true);
331		2	}
332
333	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_noDc1) {
334	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
335		2	pData.constraints_.flag_ ^= bezier_com_traj::END_VEL;
336	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
337	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
338	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
339		2	}
340
341	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0) {
342	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
343		2	pData.constraints_.flag_ \|= bezier_com_traj::INIT_ACC;
344	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
345	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
346	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
347		2	}
348
349	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0_ddc1) {
350	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
351		2	pData.constraints_.flag_ \|= bezier_com_traj::INIT_ACC;
352		2	pData.constraints_.flag_ \|= bezier_com_traj::END_ACC;
353	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
354	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
355	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
356		2	}
357
358	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_noAcc) {
359	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
360		2	pData.constraints_.constraintAcceleration_ = false;
361	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
362	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
363	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
364		2	}
365
366	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_noDc1_noAcc) {
367	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
368		2	pData.constraints_.flag_ ^= bezier_com_traj::END_VEL;
369		2	pData.constraints_.constraintAcceleration_ = false;
370	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
371	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
372	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
373		2	}
374	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	2	BOOST_AUTO_TEST_CASE(transition_ddc0_noAcc) {
375	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
376		2	pData.constraints_.flag_ \|= bezier_com_traj::INIT_ACC;
377		2	pData.constraints_.constraintAcceleration_ = false;
378	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
379	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
380	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
381		2	}
382
383	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0_ddc1_noAcc) {
384	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
385			pData.constraints_.flag_ \|=
386		2	bezier_com_traj::INIT_ACC \| bezier_com_traj::END_ACC;
387		2	pData.constraints_.constraintAcceleration_ = false;
388	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
389	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
390	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
391		2	}
392
393	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_Acc1) {
394	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
395		2	pData.constraints_.maxAcceleration_ = 1.;
396	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
397	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
398	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, false, false,
399			false); // fail with continuous formulation
400		2	}
401
402	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_noDc1_Acc1) {
403	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
404		2	pData.constraints_.flag_ ^= bezier_com_traj::END_VEL;
405		2	pData.constraints_.maxAcceleration_ = 1.;
406	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
407	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
408	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, false, false,
409			false); // fail with continuous formulation
410		2	}
411	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	2	BOOST_AUTO_TEST_CASE(transition_ddc0_Acc2) {
412	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
413		2	pData.constraints_.flag_ \|= bezier_com_traj::INIT_ACC;
414		2	pData.constraints_.maxAcceleration_ = 2.;
415	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
416	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
417	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, false, false,
418			false); // fail with continuous formulation
419		2	}
420
421	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0_ddc1_Acc2) {
422	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
423			pData.constraints_.flag_ \|=
424		2	bezier_com_traj::INIT_ACC \| bezier_com_traj::END_ACC;
425		2	pData.constraints_.maxAcceleration_ = 2.;
426	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
427	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
428	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
429		2	}
430
431	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0_ddc1_Acc05) {
432	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
433			pData.constraints_.flag_ \|=
434		2	bezier_com_traj::INIT_ACC \| bezier_com_traj::END_ACC;
435		2	pData.constraints_.maxAcceleration_ = 0.5;
436	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
437	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
438	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, false, false,
439			false); // fail with continuous formulation
440		2	}
441
442	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_Acc05) {
443	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
444		2	pData.constraints_.maxAcceleration_ = 0.5;
445	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
446	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
447	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, false, false,
448			false); // fail with continuous formulation
449		2	}
450
451			// constraints that should fails :
452
453	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_Acc02) {
454	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
455		2	pData.constraints_.maxAcceleration_ = 0.2;
456		2	pData.constraints_.constraintAcceleration_ = true;
457	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
458	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
459	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, true);
460		2	}
461
462	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_noDc1_Acc05) {
463	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
464		2	pData.constraints_.flag_ ^= bezier_com_traj::END_VEL;
465		2	pData.constraints_.maxAcceleration_ = 0.5;
466		2	pData.constraints_.constraintAcceleration_ = true;
467	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
468	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
469	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, true);
470		2	}
471
472	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0_Acc1) {
473	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
474		2	pData.constraints_.flag_ \|= bezier_com_traj::INIT_ACC;
475		2	pData.constraints_.maxAcceleration_ = 1.;
476		2	pData.constraints_.constraintAcceleration_ = true;
477	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
478	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
479	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, true);
480		2	}
481
482	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_ddc0_ddc1_Acc02) {
483	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_flat();
484			pData.constraints_.flag_ \|=
485		2	bezier_com_traj::INIT_ACC \| bezier_com_traj::END_ACC;
486		2	pData.constraints_.maxAcceleration_ = 0.2;
487		2	pData.constraints_.constraintAcceleration_ = true;
488	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
489	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.6, 0.6, 0.6;
490	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts, true);
491		2	}
492
493			BOOST_AUTO_TEST_SUITE_END()
494
495			BOOST_AUTO_TEST_SUITE(platform)
496
497			// platform : first step :
498			// (0.35,0.1,0) ; (0.35,-0.1,0) -> (0.775, 0.23, -0.02);(0.35,-0.1,0) (normal :
499			// 0.0, -0.423, 0.906)
500
501			// second step :
502			// (0.775, 0.23, -0.02);(0.35,-0.1,0) -> (0.775, 0.23, -0.02);(1.15,-0.1,0)
503			// unfeasible in quasi-static
504
505			// third step :
506			//(0.775, 0.23, -0.02);(1.15,-0.1,0) -> (1.15,0.1,0);(1.15,-0.1,0)
507
508		2	bezier_com_traj::ContactData phase0_platform() {
509	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cData;
510	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	MatrixX3 normals(2, 3), positions(2, 3);
511	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
512	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(0, 0) = Vector3(0.35, 0.1, 0);
513	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	normals.block<1, 3>(1, 0) = Vector3(0, 0, 1);
514	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(1, 0) = Vector3(0.35, -0.1, 0);
515			std::pair<MatrixX3, MatrixX3> contacts =
516	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	4	computeRectangularContacts(normals, positions, LX, LY);
517	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
518	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	ComputeContactCone(contacts.first, contacts.second));
519
520	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	ConstraintsPair kin1 = generateKinematicsConstraints(Matrix3::Identity(),
521	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	Vector3(0.35, -0.1, 0));
522			ConstraintsPair kin =
523	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	stackConstraints(kin1, generateKinematicsConstraints(
524	4/8 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 2 times. ✗ Branch 11 not taken.	6	Matrix3::Identity(), Vector3(0.35, 0.1, 0)));
525	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.Kin_ = kin.first;
526	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.kin_ = kin.second;
527
528		4	return cData;
529		2	}
530
531		2	bezier_com_traj::ContactData phase1_platform() {
532	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cData;
533	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	MatrixX3 normals(1, 3), positions(1, 3);
534	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
535	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(0, 0) = Vector3(0.35, -0.1, 0);
536			std::pair<MatrixX3, MatrixX3> contacts =
537	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	4	computeRectangularContacts(normals, positions, LX, LY);
538	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
539	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	ComputeContactCone(contacts.first, contacts.second));
540
541	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	ConstraintsPair kin = generateKinematicsConstraints(Matrix3::Identity(),
542	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	Vector3(0.35, -0.1, 0));
543	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.Kin_ = kin.first;
544	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.kin_ = kin.second;
545
546		4	return cData;
547		2	}
548
549		4	bezier_com_traj::ContactData phase2_platform() {
550	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	bezier_com_traj::ContactData cData;
551	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	4	MatrixX3 normals(2, 3), positions(2, 3);
552	4/8 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 4 times. ✗ Branch 11 not taken.	4	normals.block<1, 3>(0, 0) = Vector3(0.0, -0.423, 0.906).normalized();
553	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	positions.block<1, 3>(0, 0) = Vector3(0.775, 0.23, -0.02);
554	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	normals.block<1, 3>(1, 0) = Vector3(0, 0, 1);
555	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	positions.block<1, 3>(1, 0) = Vector3(0.35, -0.1, 0);
556			std::pair<MatrixX3, MatrixX3> contacts =
557	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	8	computeRectangularContacts(normals, positions, LX, LY);
558	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	8	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
559	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	4	ComputeContactCone(contacts.first, contacts.second));
560
561	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	ConstraintsPair kin1 = generateKinematicsConstraints(Matrix3::Identity(),
562	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	8	Vector3(0.35, -0.1, 0));
563			Eigen::Quaterniond quat = Eigen::Quaterniond::FromTwoVectors(
564	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	Eigen::Vector3d::UnitZ(), Eigen::Vector3d(0.0, -0.423, 0.906));
565	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	4	Matrix3 rot = quat.normalized().toRotationMatrix();
566			ConstraintsPair kin = stackConstraints(
567	5/10 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 4 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 4 times. ✗ Branch 14 not taken.	8	kin1, generateKinematicsConstraints(rot, Vector3(0.775, 0.23, -0.02)));
568	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	cData.Kin_ = kin.first;
569	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	cData.kin_ = kin.second;
570
571		8	return cData;
572		4	}
573
574		2	bezier_com_traj::ContactData phase3_platform() {
575	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cData;
576	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	MatrixX3 normals(1, 3), positions(1, 3);
577	4/8 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 2 times. ✗ Branch 11 not taken.	2	normals.block<1, 3>(0, 0) = Vector3(0.0, -0.423, 0.906).normalized();
578	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(0, 0) = Vector3(0.775, 0.23, -0.02);
579
580			std::pair<MatrixX3, MatrixX3> contacts =
581	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	4	computeRectangularContacts(normals, positions, LX, LY);
582	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
583	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	ComputeContactCone(contacts.first, contacts.second));
584
585			Eigen::Quaterniond quat = Eigen::Quaterniond::FromTwoVectors(
586	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	Eigen::Vector3d::UnitZ(), Eigen::Vector3d(0.0, -0.423, 0.906));
587	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	Matrix3 rot = quat.normalized().toRotationMatrix();
588			ConstraintsPair kin =
589	4/8 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 2 times. ✗ Branch 11 not taken.	2	generateKinematicsConstraints(rot, Vector3(0.775, 0.23, -0.02));
590	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.Kin_ = kin.first;
591	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.kin_ = kin.second;
592
593		4	return cData;
594		2	}
595
596		4	bezier_com_traj::ContactData phase4_platform() {
597	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	bezier_com_traj::ContactData cData;
598	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	4	MatrixX3 normals(2, 3), positions(2, 3);
599	4/8 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 4 times. ✗ Branch 11 not taken.	4	normals.block<1, 3>(0, 0) = Vector3(0.0, -0.423, 0.906).normalized();
600	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	positions.block<1, 3>(0, 0) = Vector3(0.775, 0.23, -0.02);
601	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	normals.block<1, 3>(1, 0) = Vector3(0, 0, 1);
602	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	positions.block<1, 3>(1, 0) = Vector3(1.15, -0.1, 0);
603			std::pair<MatrixX3, MatrixX3> contacts =
604	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	8	computeRectangularContacts(normals, positions, LX, LY);
605	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	8	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
606	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	4	ComputeContactCone(contacts.first, contacts.second));
607
608	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	ConstraintsPair kin1 = generateKinematicsConstraints(Matrix3::Identity(),
609	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	8	Vector3(1.15, -0.1, 0));
610			Eigen::Quaterniond quat = Eigen::Quaterniond::FromTwoVectors(
611	3/6 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken.	4	Eigen::Vector3d::UnitZ(), Eigen::Vector3d(0.0, -0.423, 0.906));
612	2/4 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken.	4	Matrix3 rot = quat.normalized().toRotationMatrix();
613			ConstraintsPair kin = stackConstraints(
614	5/10 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 4 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 4 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 4 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 4 times. ✗ Branch 14 not taken.	8	kin1, generateKinematicsConstraints(rot, Vector3(0.775, 0.23, -0.02)));
615	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	cData.Kin_ = kin.first;
616	1/2 ✓ Branch 1 taken 4 times. ✗ Branch 2 not taken.	4	cData.kin_ = kin.second;
617
618		8	return cData;
619		4	}
620
621		2	bezier_com_traj::ContactData phase5_platform() {
622	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cData;
623	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	MatrixX3 normals(1, 3), positions(1, 3);
624	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
625	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(0, 0) = Vector3(1.15, -0.1, 0);
626
627			std::pair<MatrixX3, MatrixX3> contacts =
628	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	4	computeRectangularContacts(normals, positions, LX, LY);
629	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
630	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	ComputeContactCone(contacts.first, contacts.second));
631
632	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	ConstraintsPair kin = generateKinematicsConstraints(Matrix3::Identity(),
633	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	Vector3(1.15, -0.1, 0));
634	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.Kin_ = kin.first;
635	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.kin_ = kin.second;
636
637		4	return cData;
638		2	}
639
640		2	bezier_com_traj::ContactData phase6_platform() {
641	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cData;
642	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	MatrixX3 normals(2, 3), positions(2, 3);
643	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	normals.block<1, 3>(0, 0) = Vector3(0, 0, 1);
644	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(0, 0) = Vector3(1.15, -0.1, 0);
645	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	normals.block<1, 3>(1, 0) = Vector3(0, 0, 1);
646	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	positions.block<1, 3>(1, 0) = Vector3(1.15, 0.1, 0);
647
648			std::pair<MatrixX3, MatrixX3> contacts =
649	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	4	computeRectangularContacts(normals, positions, LX, LY);
650	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	cData.contactPhase_ = new centroidal_dynamics::Equilibrium(
651	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	ComputeContactCone(contacts.first, contacts.second));
652
653	3/6 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken.	2	ConstraintsPair kin1 = generateKinematicsConstraints(Matrix3::Identity(),
654	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	4	Vector3(1.15, -0.1, 0));
655			ConstraintsPair kin =
656	2/4 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken.	2	stackConstraints(kin1, generateKinematicsConstraints(
657	4/8 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 2 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 2 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 2 times. ✗ Branch 11 not taken.	6	Matrix3::Identity(), Vector3(1.15, 0.1, 0)));
658	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.Kin_ = kin.first;
659	1/2 ✓ Branch 1 taken 2 times. ✗ Branch 2 not taken.	2	cData.kin_ = kin.second;
660
661		4	return cData;
662		2	}
663
664		1	bezier_com_traj::ProblemData gen_problem_data_Step0() {
665		1	bezier_com_traj::ProblemData pData;
666	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	1	pData.c0_ = Vector3(0.35, 0, NOMINAL_COM_HEIGHT);
667	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	1	pData.c1_ = Vector3(0.56, 0.04, NOMINAL_COM_HEIGHT);
668	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.dc0_ = Vector3::Zero();
669	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.dc1_ = Vector3::Zero();
670	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.ddc0_ = Vector3::Zero();
671	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.ddc1_ = Vector3::Zero();
672
673	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase0_platform());
674	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase1_platform());
675	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase2_platform());
676
677		1	return pData;
678			}
679
680		1	bezier_com_traj::ProblemData gen_problem_data_Step1() {
681		1	bezier_com_traj::ProblemData pData;
682	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	1	pData.c0_ = Vector3(0.56, 0.04, 0.765);
683	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	1	pData.c1_ = Vector3(0.98, 0.02, 0.77);
684	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.dc0_ = Vector3::Zero();
685	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.dc1_ = Vector3::Zero();
686	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.ddc0_ = Vector3::Zero();
687	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.ddc1_ = Vector3::Zero();
688
689	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase2_platform());
690	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase3_platform());
691	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase4_platform());
692
693		1	return pData;
694			}
695
696		1	bezier_com_traj::ProblemData gen_problem_data_Step2() {
697		1	bezier_com_traj::ProblemData pData;
698	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	1	pData.c0_ = Vector3(0.98, 0.04, NOMINAL_COM_HEIGHT);
699	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	1	pData.c1_ = Vector3(1.15, 0, NOMINAL_COM_HEIGHT);
700	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.dc0_ = Vector3::Zero();
701	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.dc1_ = Vector3::Zero();
702	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.ddc0_ = Vector3::Zero();
703	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.ddc1_ = Vector3::Zero();
704
705	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase4_platform());
706	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase5_platform());
707	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	1	pData.contacts_.push_back(phase6_platform());
708
709		1	return pData;
710			}
711
712	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(quasi_static_0) {
713			// should be successfull in quasiStatic
714			// compute kinematic constraints for the right foot :
715	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataFirst = phase0_platform();
716	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataMid = phase1_platform();
717	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataSecond = phase2_platform();
718
719	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair kin_first = std::make_pair(cDataFirst.Kin_, cDataFirst.kin_);
720			ConstraintsPair kin_second =
721	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::make_pair(cDataSecond.Kin_, cDataSecond.kin_);
722	5/10 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken.	4	ConstraintsPair stab = generateStabilityConstraints(*cDataMid.contactPhase_);
723	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::pair<Matrix3, Vector3> Hg = computeCost();
724	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	Vector3 init = Vector3::Zero();
725
726	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_first = stackConstraints(kin_first, stab);
727			bezier_com_traj::ResultData res_first =
728	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_first, Hg, init);
729	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(res_first.success_);
730
731	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_second = stackConstraints(kin_second, stab);
732			bezier_com_traj::ResultData res_second =
733	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_second, Hg, init);
734	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(res_second.success_);
735
736	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataFirst.contactPhase_;
737	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataMid.contactPhase_;
738	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataSecond.contactPhase_;
739		2	}
740
741	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(quasi_static_1) {
742			// should NOT be successfull in quasiStatic
743			// compute kinematic constraints for the right foot :
744	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataFirst = phase2_platform();
745	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataMid = phase3_platform();
746	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataSecond = phase4_platform();
747
748	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair kin_first = std::make_pair(cDataFirst.Kin_, cDataFirst.kin_);
749			ConstraintsPair kin_second =
750	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::make_pair(cDataSecond.Kin_, cDataSecond.kin_);
751	5/10 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken.	4	ConstraintsPair stab = generateStabilityConstraints(*cDataMid.contactPhase_);
752	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::pair<Matrix3, Vector3> Hg = computeCost();
753	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	Vector3 init = Vector3::Zero();
754
755	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_first = stackConstraints(kin_first, stab);
756			bezier_com_traj::ResultData res_first =
757	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_first, Hg, init);
758	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(!res_first.success_);
759
760	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_second = stackConstraints(kin_second, stab);
761			bezier_com_traj::ResultData res_second =
762	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_second, Hg, init);
763	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(!res_second.success_);
764
765	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataFirst.contactPhase_;
766	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataMid.contactPhase_;
767	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataSecond.contactPhase_;
768		2	}
769
770	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(quasi_static_2) {
771			// should be successfull in quasiStatic
772			// compute kinematic constraints for the right foot :
773	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataFirst = phase4_platform();
774	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataMid = phase5_platform();
775	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ContactData cDataSecond = phase6_platform();
776
777	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair kin_first = std::make_pair(cDataFirst.Kin_, cDataFirst.kin_);
778			ConstraintsPair kin_second =
779	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::make_pair(cDataSecond.Kin_, cDataSecond.kin_);
780	5/10 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken. ✓ Branch 13 taken 1 times. ✗ Branch 14 not taken.	4	ConstraintsPair stab = generateStabilityConstraints(*cDataMid.contactPhase_);
781	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	std::pair<Matrix3, Vector3> Hg = computeCost();
782	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	Vector3 init = Vector3::Zero();
783
784	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_first = stackConstraints(kin_first, stab);
785			bezier_com_traj::ResultData res_first =
786	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_first, Hg, init);
787	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(res_first.success_);
788
789	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	ConstraintsPair Ab_second = stackConstraints(kin_second, stab);
790			bezier_com_traj::ResultData res_second =
791	4/8 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken. ✓ Branch 10 taken 1 times. ✗ Branch 11 not taken.	4	bezier_com_traj::solve(Ab_second, Hg, init);
792	6/12 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 17 taken 1 times. ✗ Branch 18 not taken. ✗ Branch 22 not taken. ✓ Branch 23 taken 1 times.	2	BOOST_CHECK(res_second.success_);
793
794	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataFirst.contactPhase_;
795	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataMid.contactPhase_;
796	1/2 ✓ Branch 0 taken 1 times. ✗ Branch 1 not taken.	2	delete cDataSecond.contactPhase_;
797		2	}
798
799	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_0) {
800	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_Step0();
801	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
802	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.8, 0.6, 0.8;
803	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
804		2	}
805
806	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_1) {
807	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_Step1();
808	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
809	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.4, 0.2, 0.4;
810
811	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
812		2	}
813
814	33/66 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 5 taken 1 times. ✗ Branch 6 not taken. ✓ Branch 8 taken 1 times. ✗ Branch 9 not taken. ✓ Branch 11 taken 1 times. ✗ Branch 12 not taken. ✓ Branch 14 taken 1 times. ✗ Branch 15 not taken. ✓ Branch 19 taken 1 times. ✗ Branch 20 not taken. ✓ Branch 23 taken 1 times. ✗ Branch 24 not taken. ✓ Branch 27 taken 1 times. ✗ Branch 28 not taken. ✓ Branch 30 taken 1 times. ✗ Branch 31 not taken. ✓ Branch 33 taken 1 times. ✗ Branch 34 not taken. ✓ Branch 36 taken 1 times. ✗ Branch 37 not taken. ✓ Branch 41 taken 1 times. ✗ Branch 42 not taken. ✓ Branch 45 taken 1 times. ✗ Branch 46 not taken. ✓ Branch 48 taken 1 times. ✗ Branch 49 not taken. ✓ Branch 52 taken 1 times. ✗ Branch 53 not taken. ✓ Branch 55 taken 1 times. ✗ Branch 56 not taken. ✓ Branch 58 taken 1 times. ✗ Branch 59 not taken. ✓ Branch 61 taken 1 times. ✗ Branch 62 not taken. ✓ Branch 66 taken 1 times. ✗ Branch 67 not taken. ✓ Branch 70 taken 1 times. ✗ Branch 71 not taken. ✓ Branch 73 taken 1 times. ✗ Branch 74 not taken. ✓ Branch 77 taken 1 times. ✗ Branch 78 not taken. ✓ Branch 80 taken 1 times. ✗ Branch 81 not taken. ✓ Branch 83 taken 1 times. ✗ Branch 84 not taken. ✓ Branch 86 taken 1 times. ✗ Branch 87 not taken. ✓ Branch 91 taken 1 times. ✗ Branch 92 not taken. ✓ Branch 95 taken 1 times. ✗ Branch 96 not taken. ✓ Branch 98 taken 1 times. ✗ Branch 99 not taken. ✓ Branch 102 taken 1 times. ✗ Branch 103 not taken. ✓ Branch 105 taken 1 times. ✗ Branch 106 not taken. ✓ Branch 108 taken 1 times. ✗ Branch 109 not taken. ✓ Branch 111 taken 1 times. ✗ Branch 112 not taken. ✓ Branch 116 taken 1 times. ✗ Branch 117 not taken.	4	BOOST_AUTO_TEST_CASE(transition_2) {
815	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	bezier_com_traj::ProblemData pData = gen_problem_data_Step2();
816	1/2 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken.	2	VectorX Ts(3);
817	3/6 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken. ✓ Branch 7 taken 1 times. ✗ Branch 8 not taken.	2	Ts << 0.8, 0.6, 0.8;
818
819	2/4 ✓ Branch 1 taken 1 times. ✗ Branch 2 not taken. ✓ Branch 4 taken 1 times. ✗ Branch 5 not taken.	2	check_transition(pData, Ts);
820		2	}
821
822			BOOST_AUTO_TEST_SUITE_END()
823