#!/usr/bin/env python
import numpy as np
from roboticstoolbox.robot.Robot import Robot
[docs]class wx250s(Robot):
"""
Class that imports a wx250s URDF model
``wx250s()`` is a class which imports an Interbotix wx250s robot definition
from a URDF file. The model describes its kinematic and graphical
characteristics.
.. runblock:: pycon
>>> import roboticstoolbox as rtb
>>> robot = rtb.models.URDF.wx250s()
>>> print(robot)
Defined joint configurations are:
- qz, zero joint angle configuration, 'L' shaped configuration
- qr, vertical 'READY' configuration
:reference:
- https://docs.trossenrobotics.com/interbotix_xsarms_docs/specifications/wx250s.html
.. codeauthor:: Jesse Haviland
.. sectionauthor:: Peter Corke
"""
def __init__(self):
links, name, urdf_string, urdf_filepath = self.URDF_read(
"interbotix_descriptions/urdf/wx250s.urdf.xacro"
)
super().__init__(
links,
name=name,
manufacturer="Interbotix",
urdf_string=urdf_string,
urdf_filepath=urdf_filepath,
)
self.qr = np.array([0, -0.3, 0, -2.2, 0, 2.0, np.pi / 4, 0, 0])
self.qz = np.zeros(9)
self.addconfiguration("qr", self.qr)
self.addconfiguration("qz", self.qz)
if __name__ == "__main__": # pragma nocover
robot = wx250s()
print(robot)