Skip to content
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

Question about the calculation of joint local velocity(lvrt) #55

Open
ColinZhou1993 opened this issue Apr 15, 2024 · 0 comments
Open

Question about the calculation of joint local velocity(lvrt) #55

ColinZhou1993 opened this issue Apr 15, 2024 · 0 comments

Comments

@ColinZhou1993
Copy link

Hello, I am confused about the calculation of joint local velocity(lvrt) when reading code:

lvrt = np.zeros_like(lpos)
lvrt[1:] = quat.to_helical(quat.abs(quat.mul(lrot[1:], quat.inv(lrot[:-1])))) / dt
lvrt[0] = lvrt[1] - (lvrt[3] - lvrt[2])

But in my understanding, something should like this (used in the fk_vel function):
lvrt[1:] = quat.to_helical(quat.abs(quat.inv(quat.mul(lrot[1:]), (lrot[:-1])))) / dt

Am I right? Thanks for your reply.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

1 participant