Skip to content
This repository has been archived by the owner on Jul 8, 2024. It is now read-only.

Treat robot heading as a manifold (cos/sin unit vector) #200

Merged
merged 18 commits into from
Jun 22, 2024

Conversation

shueja
Copy link
Collaborator

@shueja shueja commented Jun 22, 2024

No description provided.

@shueja shueja marked this pull request as ready for review June 22, 2024 05:04
@shueja shueja changed the title Make the cos/sin components of robot heading variables Treat robot heading as a manifold (cos/sin unit vector) Jun 22, 2024
src/optimization/TrajoptUtil.hpp Outdated Show resolved Hide resolved
src/optimization/TrajoptUtil.hpp Outdated Show resolved Hide resolved
Comment on lines 95 to 96
problem.SubjectTo(theta_diff_cos * sleipnir::sin(omega_n * dt_sgmt) ==
theta_diff_sin * sleipnir::cos(omega_n * dt_sgmt));
Copy link
Member

@calcmogul calcmogul Jun 22, 2024

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

This SubjectTo() line could use a derivation in a comment. I assume it's something like the arctangents of the two angles being equal, then rearranged to use just cosine and sine, and avoid division.

@calcmogul
Copy link
Member

Does this PR supersede #191?

@shueja
Copy link
Collaborator Author

shueja commented Jun 22, 2024

Yes, due to the refactors breaking mergeability.

@shueja shueja merged commit 9b508df into SleipnirGroup:main Jun 22, 2024
16 checks passed
Sign up for free to subscribe to this conversation on GitHub. Already have an account? Sign in.
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants