set tool center point for interaction control

[Guru]

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

[Andy Park]

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

[Guru]

Hi Andy, 

Thanks for getting back to me. We will try to work around this and wait for SDK 5.4's release.

Thanks!

Guru

[Guru]

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