Move src files
This commit is contained in:
parent
0fb572ee72
commit
c1710eb2da
1
setup.py
1
setup.py
@ -7,6 +7,7 @@ from catkin_pkg.python_setup import generate_distutils_setup
|
||||
# Fetch values from package.xml.
|
||||
setup_args = generate_distutils_setup(
|
||||
packages=["active_grasp"],
|
||||
package_dir={"": "src"},
|
||||
)
|
||||
|
||||
setup(**setup_args)
|
||||
|
@ -242,33 +242,3 @@ def create_cam_view_marker(
|
||||
]
|
||||
marker.points = [to_point_msg(p) for p in points]
|
||||
return marker
|
||||
|
||||
|
||||
def create_grasp_markers(
|
||||
frame,
|
||||
grasp,
|
||||
color,
|
||||
ns,
|
||||
id=0,
|
||||
finger_depth=0.05,
|
||||
radius=0.003,
|
||||
):
|
||||
w, d = grasp.width, finger_depth
|
||||
|
||||
pose = grasp.pose * Transform.translation([0.0, -w / 2, d / 2])
|
||||
scale = [radius, radius, d]
|
||||
left = create_marker(Marker.CYLINDER, frame, pose, scale, color, ns, id)
|
||||
|
||||
pose = grasp.pose * Transform.translation([0.0, w / 2, d / 2])
|
||||
scale = [radius, radius, d]
|
||||
right = create_marker(Marker.CYLINDER, frame, pose, scale, color, ns, id + 1)
|
||||
|
||||
pose = grasp.pose * Transform.translation([0.0, 0.0, -d / 4])
|
||||
scale = [radius, radius, d / 2]
|
||||
wrist = create_marker(Marker.CYLINDER, frame, pose, scale, color, ns, id + 2)
|
||||
|
||||
pose = grasp.pose * Transform.rotation(Rotation.from_rotvec([np.pi / 2, 0, 0]))
|
||||
scale = [radius, radius, w]
|
||||
palm = create_marker(Marker.CYLINDER, frame, pose, scale, color, ns, id + 3)
|
||||
|
||||
return [left, right, wrist, palm]
|
Loading…
x
Reference in New Issue
Block a user