Skip to content

[Bug]: Pose not updated after go_to_home_pose() #260

Description

@XiaoweiLinXL

What happened?

After I initialize the arm using arm = InterbotixManipulatorXS(robot_model='wx250s', robot_name='wx250s', group_name="arm"), I get the initial robot pose using arm.arm.get_ee_pose(). Then I move the robot to the home pose using arm.arm.go_to_home_pose() and check the pose again using arm.arm.get_ee_pose(). The return pose doesn't change even the robot moved. Why is it the case? Thank you for your help!

Robot Model

WX250S

Operating System

Ubuntu 22.04

ROS Distro

ROS 2 Humble

Steps To Reproduce

from interbotix_xs_modules.xs_robot.arm import InterbotixManipulatorXS

arm = InterbotixManipulatorXS(robot_model='wx250s', robot_name='wx250s', group_name="arm")
print(f"Initial pose: {arm.arm.get_ee_pose()}")
arm.arm.go_to_home_pose()
print(f"After pose: {arm.arm.get_ee_pose()}")

Relevant log output

[INFO] [1772065472.074720363] [interbotix_robot_manipulation]: Initialized InterbotixRobotNode!
[INFO] [1772065472.101441123] [interbotix_robot_manipulation]: 
	Robot Name: wx250s
	Robot Model: wx250s
[INFO] [1772065472.101638873] [interbotix_robot_manipulation]: Initialized InterbotixRobotXSCore!
[INFO] [1772065472.105767765] [interbotix_robot_manipulation]: 
	Arm Group Name: arm
	Moving Time: 2.00 seconds
	Acceleration Time: 0.30 seconds
	Drive Mode: Time-Based-Profile
[INFO] [1772065472.106019281] [interbotix_robot_manipulation]: Initialized InterbotixArmXSInterface!
[INFO] [1772065472.609486673] [interbotix_robot_manipulation]: 
	Gripper Name: gripper
	Gripper Pressure: 50.0%
[INFO] [1772065472.610128324] [interbotix_robot_manipulation]: Initialized InterbotixGripperXSInterface!
Initial pose: [[ 0.92192475 -0.07448875  0.38013968  0.13093145]
 [ 0.02541982  0.99085561  0.13251033  0.00245674]
 [-0.38653407 -0.11250147  0.91538781  0.08271443]
 [ 0.          0.          0.          1.        ]]
After pose: [[ 0.92192475 -0.07448875  0.38013968  0.13093145]
 [ 0.02541982  0.99085561  0.13251033  0.00245674]
 [-0.38653407 -0.11250147  0.91538781  0.08271443]
 [ 0.          0.          0.          1.        ]]

Additional Info

No response

Metadata

Metadata

Assignees

No one assigned

    Labels

    bugSomething isn't workingmanipulatorsIssues related to manipulators

    Type

    No type

    Fields

    No fields configured for issues without a type.

    Projects

    No projects

    Milestone

    No milestone

    Relationships

    None yet

    Development

    No branches or pull requests

    Issue actions