Commit f9e558da authored by stevet's avatar stevet
Browse files

fix debug execution with wrong use of segment

parent 093b8e8e
...@@ -61,7 +61,7 @@ linear_variable_t* wayPointsToLists(const bezier_linear_variable_t& self) { ...@@ -61,7 +61,7 @@ linear_variable_t* wayPointsToLists(const bezier_linear_variable_t& self) {
int i = 0; int i = 0;
for (cit_point cit = wps.begin(); cit != wps.end(); ++cit, ++i) { for (cit_point cit = wps.begin(); cit != wps.end(); ++cit, ++i) {
matrices.block(0, i * 3, dim, 3) = cit->B().transpose(); matrices.block(0, i * 3, dim, 3) = cit->B().transpose();
vectors.segment<3>(i * 3, i * 3 + 2) = cit->c(); vectors.segment<3>(i * 3) = cit->c();
} }
return new linear_variable_t(matrices.transpose(), vectors.transpose()); return new linear_variable_t(matrices.transpose(), vectors.transpose());
} }
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment