New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
Lane::DoEvalMotionDerivatives. #27
Conversation
{100., 0., 0.}, | ||
{100. + 50 * std::sqrt(2.), 0., 0.}, | ||
{100. + 50 * std::sqrt(2.), 2., 0.}} /* srh */, | ||
{{3, 2., 1.}, {3, 2., 1.}, {3, 2., 1.}, {3, 2., 1.}, {3, 2., 1.}} /* expected_motion_derivatives */ |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Note that the expected motion derivatives are equal to the velocity. The WDot implementation considers the heading dot as zero because of the linea interpolation between the points.
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
It's OK. It's the cost of a simplified model.
Signed-off-by: Franco Cipollone <franco.c@ekumenlabs.com>
20f3241
to
fe86938
Compare
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
LGTM
{100., 0., 0.}, | ||
{100. + 50 * std::sqrt(2.), 0., 0.}, | ||
{100. + 50 * std::sqrt(2.), 2., 0.}} /* srh */, | ||
{{3, 2., 1.}, {3, 2., 1.}, {3, 2., 1.}, {3, 2., 1.}, {3, 2., 1.}} /* expected_motion_derivatives */ |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
It's OK. It's the cost of a simplified model.
🎉 New feature
Closes #26
Summary
Implements
Lane::DoEvalMotionDerivatives
Checklist
Note to maintainers: Remember to use Squash-Merge and edit the commit message to match the pull request summary while retaining
Signed-off-by
messages.