Skip to content
Snippets Groups Projects
Commit e5f581f0 authored by Fabian Reister's avatar Fabian Reister
Browse files

Merge branch 'eurobin' into 'master'

Drawer-related params

See merge request sw/simox/simox!138
parents 274077cd e14eeff7
No related branches found
No related tags found
No related merge requests found
......@@ -42,12 +42,15 @@ namespace simox::geometric_planning
CHECK_MESSAGE(params.doorContactHandleDistance > 0.,
"Grasping from the other side not implemented yet!");
constexpr float doorContactHandleLateralShift = 25;
constexpr float doorContactHandleDistance = -140;
return DoorInteractionContext{
.rns = {.joint = rns->getNode(jointNodeName),
.handle = rns->getNode(handleNodeName),
.handleSurfaceProjection = rns->getNode(surfaceProjectionNodeName)},
.handleSurfaceProjection_T_door_initial_contact =
Pose(Eigen::Translation3f{0.F, -params.doorContactHandleDistance, 0.F}),
Pose(Eigen::Translation3f{doorContactHandleLateralShift, doorContactHandleDistance, 0.F}),
.door_initial_contact_T_pre_contact =
Pose(Eigen::Translation3f{0.F, 0, params.preContactDistance})};
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment