set tool center point for interaction control


Guru

Recommended Posts

Hi!

I'm trying to set the interaction control frame using "InteractionOptions" python API.

No matter how I change the end_point_frame and interaction_frame items in InteractionOptions object I cannot change the frame.

Essentially I am trying to change the tool center point location so the interaction control is about a different point. Consider the gif below:

http://sdk.rethinkrobotics.com/intera/File:SawyerConstrainedZeroG_orientation_small.gif

I would like to do what this .gif does except rotate about a different point ideally offset about the tool frame. How do I do this with code?

Here is a code snippet of my failed attempt:

from geometry_msgs.msg import Pose
from intera_motion_interface import (
    MotionTrajectory,
    MotionWaypoint,
    MotionWaypointOptions,
    InteractionOptions)
interaction_options.set_in_endpoint_frame(False)
interaction_options.set_endpoint_name('right_hand')
interaction_options.set_disable_damping_in_force_control(False)
interaction_options.set_rotations_for_constrained_zeroG(True)

interaction_frame = Pose()

interaction_frame.position.x = 0.0
interaction_frame.position.y = 0.0
interaction_frame.position.z = 0.1
interaction_frame.orientation.w = 1
interaction_frame.orientation.x = 0
interaction_frame.orientation.y = 0
interaction_frame.orientation.z = 0

interaction_options.set_interaction_frame(interaction_frame)

I've highlighted the change I would like to do to the frame - offset the tool center point by 10 cm along the z axis w.r.t the 'right_hand' frame. How do I get this to happen?

 

Thanks for all your help!

Guru

Link to comment
Share on other sites

Hey I am glad that you are exploring different ways to define interaction behaviors! :)

My short and quick answer is that currently SDK 5.2 does not support translating the tool center point where impedance behavior is defined. To give you a bit of context on why, it is not a simple issue since our maximum impedance values will change depending on where tool center point is in order to maintain the stability of the system, so at the time when we worked on 5.2 features we did support that.

However, we now have it enabled in our software developer's build (you can translate the tool center point upto 50cm, yay!), but it won't be available to you until SDK 5.4 release. I would have to ask you wait patiently until that happens (hopefully it will be by the end of this year). Your patience will be greatly appreciated. In the meantime, you can try to create your desired behavior with tool center point at the tool plate.. Sorry.

Best,

-- Andy

Link to comment
Share on other sites

Hi Andy,

I have another question,

Can I still set the orientation of the impedance behavior wrt the base frame? Right now it is wrt the tool frame. If I can, how do I do this?

Thanks!

Guru

Link to comment
Share on other sites

Archived

This topic is now archived and is closed to further replies.