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

The condition to determine the target position overlapping with the initial position #33

Open
Benjizhang opened this issue May 16, 2021 · 0 comments

Comments

@Benjizhang
Copy link

In line 114 of ur5_mp.py , the condition to determine the target position overlapping with the initial position is
np.sqrt((wpose.position.x-start_pose.position.x)**2+(wpose.position.x-start_pose.position.x)**2+(wpose.position.x-start_pose.position.x)**2)<0.1

It should consider x, y, z coordinates instead of x three times, isn't is?
np.sqrt((wpose.position.**x**-start_pose.position.**x**)**2+(wpose.position.**y**-start_pose.position.**y**)**2+(wpose.position.**z**-start_pose.position.**z**)**2)<0.1

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