fix test
This commit is contained in:
parent
3891040307
commit
9c5f5f3394
|
@ -302,11 +302,13 @@ class SplineOptimization {
|
||||||
// std::cout << "spline.minTimeNs() " << spline.minTimeNs() << std::endl;
|
// std::cout << "spline.minTimeNs() " << spline.minTimeNs() << std::endl;
|
||||||
// std::cout << "spline.maxTimeNs() " << spline.maxTimeNs() << std::endl;
|
// std::cout << "spline.maxTimeNs() " << spline.maxTimeNs() << std::endl;
|
||||||
|
|
||||||
while (mocap_measurements.front().timestamp_ns <=
|
while (!mocap_measurements.empty() &&
|
||||||
|
mocap_measurements.front().timestamp_ns <=
|
||||||
spline.minTimeNs() + spline.getDtNs())
|
spline.minTimeNs() + spline.getDtNs())
|
||||||
mocap_measurements.pop_front();
|
mocap_measurements.pop_front();
|
||||||
|
|
||||||
while (mocap_measurements.back().timestamp_ns >=
|
while (!mocap_measurements.empty() &&
|
||||||
|
mocap_measurements.back().timestamp_ns >=
|
||||||
spline.maxTimeNs() - spline.getDtNs())
|
spline.maxTimeNs() - spline.getDtNs())
|
||||||
mocap_measurements.pop_back();
|
mocap_measurements.pop_back();
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue