Hacktoberfest 2026: los issues que los mantenedores marcaron para octubre, abiertos y aptos para principiantes. Explorar issues de Hacktoberfest

Interbotix URDF models (wx200 etc.): gripper counted as arm joints, ambiguous end-effector, qr outside joint limits

Abierto
  • ¿Algo no está bien?
#729 0 comentarios 0 reacciones 0 asignados Ver en GitHub

Los mantenedores suelen responder en 2 días

@huxiaoyi-ovo ya está trabajando en esto.

Desde el 12/10/2026.

  • #739 de @huxiaoyi-ovo — abierto

Evaluación

Dificultad
4/5
Tiempo estimado
3-5 días
Aptitud para principiantes
35/100
Tipo de issue
Error
Claridad
Bastante claro
Estado de actividad
Activo
Stack tecnológico
python
Área
robotics

Línea de trabajo

Start with the Interbotix wx200 model in rtb.models.URDF and compare it with the Panda model, which already has a Gripper. Check r.qr and r.qlim for wx200, and confirm r.ee_links lists four candidates with gripper_prop_link first. Done means each Interbotix model has in-limit qr and qz, one unambiguous default end-effector, and a test per model checking those values and n. Gripper modeling is a design choice, so confirm the approach with maintainers first.

Escrito por el modelo de indexación a partir del texto del issue.

Descripción

bug

The Interbotix URDF models (rtb.models.URDF.wx200 and its siblings) are not set up like the other arm models: the gripper joints are counted as arm joints, there are four candidate end-effectors with a poor default, and the named qr configuration looks copied from the Panda and is outside the joint limits. Found while answering discussion #445 (a user servoing a wx200 whose loop never terminated).

RTB 1.4.4, rtb.models.URDF.wx200().

1. The gripper is part of the "arm"

ERobot: wx200 (by Interbotix), 8 joints (RRRRRRPP), 4 branches, dynamics, geometry, collision
...
│    5 │ /gripper_link       │     4 │ /wrist_link       │ SE3(0.065, 0, 0; -180°, -0°, 0°) ⊕ Rx(q4) │
│    6 │ /ee_arm_link        │       │ /gripper_link     │ SE3(0.043, 0, 0)                          │
│    7 │ @/gripper_prop_link │     5 │ /ee_arm_link      │ SE3(0.0055, 0, 0) ⊕ Rx(q5)                │
│    8 │ /gripper_bar_link   │       │ /ee_arm_link      │ SE3()                                     │
│    9 │ /fingers_link       │       │ /gripper_bar_link │ SE3(0.023, 0, 0)                          │
│   10 │ @/left_finger_link  │     6 │ /fingers_link     │ SE3() ⊕ ty(q6)                            │
│   11 │ @/right_finger_link │     7 │ /fingers_link     │ SE3() ⊕ ty(q7)                            │
│   12 │ @/ee_gripper_link   │       │ /fingers_link     │ SE3(0.02757, 0, 0)                        │

The wx200 is a 5-DoF arm (q0 to q4). The model has n = 8: q5 is the gripper's rotary "prop" joint (Rx, limits ±π), and q6 and q7 are the two prismatic fingers. robot.q, qr, qlim and the Jacobian all mix arm and gripper coordinates. Compare rtb.models.URDF.Panda, where the hand is a Gripper and n = 7.

2. Four end-effectors, default is not the tool point

>>> r.ee_links
['/gripper_prop_link', '/left_finger_link', '/right_finger_link', '/ee_gripper_link']
>>> r.grippers
[]
>>> r.fkine(r.qr)    # prints: multiple end-effectors present, ambiguous, using self.ee_links[0]
  • fkine and jacob0 default to gripper_prop_link, which is a rotary joint link, not the tool point. At qr its position differs from /ee_gripper_link by about 4.5 cm: (0.143, 0, 0.268) vs (0.128, 0, 0.225).
  • Because gripper_prop_link carries the q5 joint, the default Jacobian is 6 x 6. It reports a 6-DoF arm, but the sixth "DoF" is the gripper roll.
  • grippers is empty even though there are finger joints.

Related: #725 (default end-effector frame of the Panda matches no named link) and #705 (payload() has no answer for multiple end-effectors).

3. qr and qz are not valid configurations

qr  = [0, -0.3, 0, -2.2, 0, 2.0, 0.785, 0]
qz  = [0, 0, 0, 0, 0, 0, 0, 0]
qlim (rows are joints):
  q0 [-3.142, 3.142]   q1 [-1.885, 1.972]   q2 [-1.623, 1.885]   q3 [-2.147, 1.745]
  q4 [-3.142, 3.142]   q5 [-3.142, 3.142]   q6 [ 0.015, 0.037]   q7 [-0.037, -0.015]
  • qr is exactly the Panda's qr plus a trailing zero. Here that sets the finger joint q6 to 0.785 m (the finger travel is 0.015 to 0.037 m), the wrist-angle joint q3 to -2.2 (limit -2.147), and q7 to 0, outside its range.
  • qz has the fingers at 0, outside their limits (0.015 to 0.037 m).

4. Same pattern on the other Interbotix models

Checked on 1.4.4. All have 4 ee_links with gripper_prop_link first, and the same copied qr:

model n qr outside qlim at joints
px100 7 3, 5, 6
px150, rx150, rx200, wx200, wx250 8 3, 6, 7
vx300 8 6, 7
vx300s, wx250s 9 7, 8

Effect on users

Someone servoing the default end-effector to a full 6-DoF pose with a pseudo-inverse loop never converges, because the arm has 5 DoF plus the gripper roll. A full-pose goal from fkine converges (about 110 steps), but an arbitrary position and orientation does not (still 5.5 cm away after 1500 steps), while servoing on position only arrives in about 170 steps.

Suggested fix

  • Model the gripper as a Gripper (like the Panda), so n is the number of arm joints, with the fingers and prop as gripper joints.
  • Set the default end-effector to /ee_gripper_link (the URDF's own tool point) and make ee_links unambiguous.
  • Replace qr with a real, in-limit "ready" configuration for each model, and make qz in-limit or document it.
  • Add a test per model: qr and qz within qlim, one end-effector, expected n.
Lenguaje dominante
C++
Estrellas
3.5k
Forks
630
Merge medio
3 d 7 h
PR fusionados (30 d)
50

Preparar el entorno

Primeros pasos

  1. Lee el issue completo y luego la guía de contribución del proyecto.
  2. Comenta en el issue que vas a ocuparte — evita que dos personas hagan lo mismo.
  3. Haz un fork del repositorio y trabaja en una rama.
  4. Abre un pull request que haga referencia al número del issue.

Más de petercorke/robotics-toolbox-python

Todos los issues de petercorke/robotics-toolbox-python

Issues similares

Más issues de C++

Recibe los nuevos issues en tu correo

Un resumen breve de issues de GitHub para principiantes.