Skip to content
Snippets Groups Projects
Commit 382e3b4e authored by Jayant Khatkar's avatar Jayant Khatkar
Browse files

IK and FK using sawyer interface, trajectory execution is not availble in desired interface

parent bb93853b
Branches master
No related merge requests found
Showing
with 20 additions and 1 deletion
import rospy
from time import sleep
import intera_interface
from geometry_msgs.msg import Pose
if __name__=="__main__":
rospy.init_node("sawyer_controller")
......@@ -10,4 +12,21 @@ if __name__=="__main__":
angles[k]=0.0
limb.move_to_neutral()
sleep(10)
limb.move_to_joint_positions(angles)
# Inverse Kinematics
pose0 = Pose()
pose0.position.x = 1.0155
pose0.position.y = 0.158
pose0.position.z = 0.3157
pose0.orientation.x = 0.544
pose0.orientation.y = -0.45
pose0.orientation.z = 0.544
pose0.orientation.w = -0.45
angles_from_ik = limb.ik_request(pose0)
limb.move_to_joint_positions(angles_from_ik)
# Forward Kinematics
limb.fk_request(angles_from_ik)
File deleted
File deleted
File deleted
File deleted
File deleted
File deleted
File deleted
File deleted
File deleted
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment