Skip to content

MarcoMagriDev/tmr_ros2

Β 
Β 

Folders and files

NameName
Last commit message
Last commit date

Latest commit

Β 

History

90 Commits
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 
Β 

Repository files navigation

TM ROS Driver

1. Overview

Techman Robot is a state-of-the-art production tool that is highly compatible and flexible to collaboration between human and machine. The Robot Operating System (ROS) provides abundant libraries and tools which can be utilized to reduce the cost of trivial development software tool and build robot applications without struggling. Our TM ROS driver provides nodes for communication with Techman Robot controllers, data including robot states, images from the eye-in-hand camera and URDF models for various robot arms via TMflow.

2. Feature

This driver is for ROS2 Foxy version.
To use the driver, make sure your ROS PC is installed correctly.
If the user want to know how to use the ROS1 driver, please visit the TM ROS1 driver website or directly click the TM ROS driver version listed in the table below.

More information: TM ROS driver support list

ROS Distribution (ROS Environment Setup) TM ROS driver version TM ROS Vision Remark: switch GitHub branches
ROS Noetic Ninjemys TM ROS1 Noetic driver supported noetic
ROS Melodic Morenia TM ROS1 Melodic driver x master
ROS 2 Foxy Fitzroy TM ROS2 Foxy driver supported master
ROS 2 Dashing Diademata TM ROS2 Dashing driver supported dashing-devel

Note1: The two current master branches are ROS1 Melodic and ROS2 Foxy.
Note2: The tutorial that follows mentioned how to build a ROS environment on Ubuntu by sourcing is to take the ROS installed through the Debian packages as an example.

ROS2 Driver

The driver for ROS2 publishes identical topics and provides identical services as TM ROS1 version.
This driver uses ROS2 composition, there are two nodes in the identical process: one node publishes topics while the other node sets up service servers.

Installation

Just clone the TM ROS driver of git repository into your working directory and then built it.
The user can directly refer to the chapters introduced in the following text: steps 1 to 4 of Β§ Usage with demo code & driver.

3. Usage

After installing the correct ROS2 version of the computer, the next step is to ensure that your hardware, control computer, and TM Robot are all properly configured to communicate with each other. See below to make sure the network settings on your computer are correct, the TM Robot's operating software (TMflow) network settings are ready and the Listen node is running.

Β§ TMflow Listen node setup

The Listen node: a socket server can be established and be connected with ROS by an external device to communicate according to the defined protocol. The user can make the robot communicate with the user's ROS (remote) computer equipment through a wired network, when all the network parameters in the Network setting are set.

  1. Create a Listen task of flow project of TMflow software, and then drag the Listen node from the nodes menu onto the project flow, as shown below. 1

  2. Set the Network settings: mouse-click to enter the page of System β‡’ Network in order.
    Example: Set the Subnet mask: 255.255.255.0 and IP address 192.168.10.2
    Note: Set the network mask, and the communication with the TM Robot must be in the set domain.
    2

  3. Set the Ethernet Slave Data Table Setting item: mouse-click to enter the page of Setting β‡’ Connection β‡’ Ethernet Slave in order.
    We recommend one easy method 1 to set the Ethernet Slave Data Table setting is to directly import the software package.
    1 See TM ROS Driver vs TMflow software Usage : Import Data Table Setting.
    Or the previously provided method as follows: (Note: TMflow software version changes may have slightly different settings.)
    The user can manually click the Data Table Setting 2 item and check the following boxes as item predefined 3 to receive/send specific data:

    • Robot_Error
    • Project_Run
    • Project_Pause
    • Safeguard_A
    • ESTOP
    • Camera_Light
    • Error_Code
    • Joint_Angle
    • Coord_Robot_Flange
    • Coord_Robot_Tool
    • TCP_Force
    • TCP_Force3D
    • TCP_Speed
    • TCP_Speed3D
    • Joint_Speed
    • Joint_Torque
    • Project_Speed
    • MA_Mode
    • Robot Light
    • Ctrl_DO0~DO7
    • Ctrl_DI0~DI7
    • Ctrl_AO0
    • Ctrl_AI0~AI1
    • END_DO0~DO3
    • END_DI0~DI2
    • END_AI0

    2 Turn off Ethernet Slave. Let "STATUS: Disable" displayed on Ethernet Slave setting page, then click Data Table Setting to enter the next page for related settings.
    3 The checked items listed above must all be selected for TM ROS setting.

    When you need to check more about the maximum, minimum, average calculation properties of joint torque, the three checked items 4 listed below can be checked individually or all of them, please leave them unchecked when not in use.

    • Joint_Torque_Average
    • Joint_Torque_Min
    • Joint_Torque_Max

    4 This function requires TMflow 1.84 or later versions to support.

  4. Enable the Ethernet Slave settings: mouse-click to enable or disable TM Ethernet Slave. Once enabled, the robot establish a Socket server to send the robot status and data to the connected clients and permissions to access specific robot data.
    Mouse-click to enable the Ethernet Slave setting and let STATUS: β‡’ Enable. 2

  5. Press the Play/Pause Button on the Robot Stick to start running this Listen task project.

Β§ Remote connection to TM ROBOT

Static IP of remote connection network settings through the wired network.

  1. Set the wired network of the user's (remote) Ubuntu computer by mouse-click on the top right of the desktop β‡’ Click on "Wired Settings" β‡’ Click on the gear icon β‡’ In the IPv4 feature options, click on "Manual" in order.
    user_remote_network_settings
  2. Set the Static IP settings: where the IP address is fixed for the first three yards same as the previous setting 192.168.10, last yards 3-254 machine numbers are available. (Because TM ROBOT, you have been set to 192.168.10.2)
    Example: Set the Netmask: 255.255.255.0 and IP address 192.168.10.30
    user_remote_IP_example
  3. Check Internet connection: start a terminal to test the connectivity with the target host TM ROBOT, by typing ping 192.168.10.2 ping_target_host.png

πŸ’‘ Tip: Remember to reconfigure the network settings due to static IP changes or replacement of the ROS control PC.
As mentioned above, a valuable debugging tool is your operating system's ping command. If nothing appears to happen or an error is thrown, the robot cannot be accessed from your computer. Please go back to the top of this chapter and re-operate in the order of instructions.
If you are an experienced user, you may just need to turn off β‡’ turn on the gear icon of "Wired Settings" on your computer or to turn off β‡’ turn on the "Ethernet Slave Data Table" setting of the robot to reconfigure the hardware settings.

Β§ TM ROS driver usage

ROS2 driver usage

After the user has set up the ROS2 environment (example : Debian packages for ROS 2 Foxy) and built the TM driver based on the specific workspace, please enter your workspace <workspace> by launching the terminal, and remember to make the workspace visible to ROS.

source /opt/ros/foxy/setup.bash
cd <workspace>
source ./install/setup.bash

πŸ’‘ Do you prepare the TM Robot ready ? Make sure that TM Robot's operating software (TMflow) network settings are ready and the Listen node is running.

Then, run the driver to maintain the connection with TM Robot by typing

ros2 run tm_driver tm_driver <robot_ip_address>

Example :ros2 run tm_driver tm_driver 192.168.10.2, if the <robot_ip_address> is 192.168.10.2

Now, the user can use a new terminal to run each ROS node or command, but don't forget to source the correct setup shell files as starting a new terminal.

Usage with MoveIt2 (Tentative)

See MoveIt2 tutorial to install the MoveIt2 packages.

Assuming that the user is ready to build MoveIt2, and the user wants to apply the MoveIt by TM Robot, please do'nt forget to source the MoveIt environment, or you can add source <MoveIt_WS>/install/setup.bash to your .bashrc.
The <MoveIt_WS> means the MoveIt2 workspace, for example COLCON_WS .
The <TMDriver_WS> means TM driver workspace, for example tmdriver_ws .

Then to built the TM driver based on the <TMDriver_WS> workspace, please enter the specific workspace tmdriver_ws by launching the terminal, and remember to make the workspace visible to ROS.

source /opt/ros/foxy/setup.bash
source ~/COLCON_WS/install/setup.bash
cd ~/tmdriver_ws 
colcon build
source ./install/setup.bash

πŸ’‘ If you have built the TM driver before, you must use colcon build --cmake-clean-cache or colcon build --cmake-force-configure instead of colcon build in the previous step to force execution CMake configuration step, for example

source /opt/ros/foxy/setup.bash
source ~/COLCON_WS/install/setup.bash
cd ~/tmdriver_ws 
colcon build --cmake-clean-cache
source ./install/setup.bash

The demo launches the RViz GUI and demonstrates planning and execution of a simple collision-free motion plan with TM Robot.
πŸ’‘ Do you prepare the TM Robot ready ? Make sure that TM Robot's operating software (TMflow) network settings are ready and the Listen node is running.

To bring up MoveIt2 demo environment in simulation mode with virtual TM Robot (Example: TM5-900), by typing

ros2 launch tm_moveit_cpp_demo tm5-900_run_moveit_cpp.launch.py

πŸ“‘ Note1: There are several built-in TM Robot nominal robot model settings, available for tm5-900, tm5-700, tm12 and tm14 models, as well as the eyeless models tm5x-900, tm5x-700, tm12x and tm14x models.

The user can also manipulate real TM5-900 Robot (Example: TM5-900) to run, by typing

⚠️[CAUTION] This demo will let the real TM Robot move, please be careful. If the user are a beginner or unfamiliar with the arm movement path, it is recommended that the user place his hand on the big red emergency Stick Stop Button at any time, and press the button appropriately in the event of any accident that may occur.

ros2 launch tm_moveit_cpp_demo tm5-900_run_moveit_cpp.launch.py robot_ip:=<robot_ip_address>

The parameter <robot_ip_address> means the IP address of the TM Robot.
πŸ“‘ Note2: If your real Robot is a TM12, in the above example, you should type "tm12_run_moveit_cpp.launch.py" to instead of "tm5-900_run_moveit_cpp.launch.py".
πŸ“‘ Note3: If your real Robot is the eyeless model as a TM12x, in the above example, you should type "tm12x_run_moveit_cpp.launch.py" to instead of "tm5-900_run_moveit_cpp.launch.py".

4. Vision

Β§ TM ROS Vision usage

Get image data through TMvisionβ„’ of TM Robot (Built-in Vision System)

Dependencies

  • ROS2 Foxy

  • Python packages:

    1. flask
    2. waitress
    3. opencv-python==3.4.13.47 (Minimum)
    4. numpy
    5. datetime

    For example, install Python3 packages:

    • pip3 install flask
    • pip3 install waitress
    • pip3 install opencv-python
    • pip3 install datetime

Techman Robot Vision

  • type: sensor_msgs::msg::Image
  • message name: techman_image

Build TM ROS Vision driver node on your (remote) computer

Under the environment settings have been finished with your workspace<workspace>, then type

cd ~/<workspace> && source install/setup.bash
ros2 run tm_get_status image_talker

πŸ’‘ The user can check whether the connection succeeds or not? When you proceed to the following steps introduced in the following text: steps 6 of Β§ TMflow Vision node setup.

Β§ TMflow Vision node setup

The Vision node provides the creation of a plane with fixed-point type, servo type, and object type as well as a variety of AOI identification functions.
πŸ’‘ Before going through the following steps, please build the TM ROS Vision driver node on your (remote) computer and then connect this (remote) computer to the local TM Robot computer.

  1. Create a Vision task project of TMflow software, and then drag the Vision node from the nodes menu onto the project flow, as shown below.
    create_a_vision_task

  2. Click the AOI -only icon, and then follow the steps below to handle some settings related to accessing TM Robot HMI.
    choose_aoi_only

    TMflow 1.76 second version only:
    If no suitable dongle is detected, warning alerts will be displayed in the window.
    open_need_dongle_key TMflow 1.80 version:
    The user don't need dongle to activate this function.

  3. Click the Find icon. select_find

  4. In TMflow 1.76 second version, click the AI_Detection icon.
    choose_ai_detection_only In TMflow 1.80 version, click the External Detection icon. change1

  5. In TMflow 1.76 second version, click the + Add Parameters button. choose_add_parameters In TMflow 1.80 version, click the Setting button. change2

  6. To check whether the connection succeeds or not, please enter <user_pc_ip_address>:6189/api in the HTTP Parameters blank text and click the Send button to get the information of the (remote) computer for ROS.
    The <user_pc_ip_address> means the IP address of the user's (remote) ROS computer, for example 192.168.2.12
    check_connect_success

    If the connection fails, a TIMEOUT error will be displayed in the window wrong_ip_address

    If the IP address of the user's (remote) ROS computer doesn't exist, ERROR_CODE_7 will be displayed in the window. wrong_port

  7. Enter <user_pc_ip_address>:6189/api/DET in the URL blank text and type arbitrary letters in the Value blank text; the Key will be generated automatically. add_model

  8. Assign a name to the model in the Model name blank text and click the Save button. save_model

  9. Press the Play/Pause Button on the Robot Stick to start running this Vision task project.

    Note: TMflow software version changes may have slightly different settings.(SW1.76_Rev2.00) (SW1.80_Rev2.00)

Β§ Receive image data on the user's computer from TMflow Vision node

πŸ’‘ Do you prepare the TM Robot ready ? Make sure that TM Robot's operating software (TMflow) relative HTTP Parameters Vision settings are ready and the Vision task project is running.

Now, in a new terminal of your (remote) ROS computer : Source setup.bash in the workspace path and run to get image data from TMvisionβ„’ by typing

source ./install/setup.bash
ros2 run custom_package sub_img

Then, the viewer will display image data from TMflow.

5. Program script demonstration

Β§ Demo package description

There are some demo codes showing how to use TM ROS driver.

  • demo_send_script:
    In this demo code, it shows how to send a Listen node script to control the TM Robot.
    The user can use service named "send_script" to send script.
    "id" β†’ The transaction number expressed in any alphanumeric 1 characters.
    "script" β†’ the script which the user want to send.
    "ok" β†’ the correctness of the script.
    1 If a non-alphanumeric byte is encountered, a CPERR 04 error is reported. When used as a communication packet response, it is a transaction number and identifies which group of commands to respond.

  • demo_ask_item:
    In this demo code, the user can use this service to send TMSCT 2 cmd.
    2 For more detailed information, please refer to defined protocol: Expression Editor and Listen Node.pdf (Chapter7.4 TMSCT)

  • demo_ask_sta:
    In this demo code, the user can use this service to send TMSTA 3 cmd.
    3 For more detailed information, please refer to defined protocol (Chapter7.5 TMSTA)

  • demo_connect_tm:
    In this demo code, the user can set the connection type.
    If the user sets reconnect to true, every time the driver disconnects from the Listen node, it will try to reconnect.
    There are two kind connection settings the user can select, one is "connect_tmsvr" for Ethernet server connection, and the other is "connect_tmsct" for TMflow connection.

  • demo_set_event:
    In this demo code, six event types can be selected.
    func β†’ TAG, WAIT_TAG, STOP, PAUSE, RESUME and EXIT
    arg0 β†’ if func is TAG or WAIT_TAG, arg0 is timeout in ms
    arg1 β†’ if func is TAG or WAIT_TAG, arg1 is id

  • demo_set_io:
    In this demo code, the user should set module, type, pin and state. 4
    module β†’ MODULE_CONTROLBOX or MODULE_ENDEFFECTOR
    type β†’ TYPE_DIGITAL_IN, TYPE_DIGITAL_OUT, TYPE_INSTANT_DO, TYPE_ANALOG_IN, TYPE_ANALOG_OUT, TYPE_INSTANT_AO
    pin β†’ pin number
    state β†’ STATE_OFF or STATE_ON value, or other value (if type expressed in a specific control module)
    4 For more detailed information, please refer to defined protocol (Chapter6.5 IO)

  • demo_set_positions:
    In this demo code, the user should pay attention to the parameter definition of the data format setting 5 and the unit of the parameter to be operated.
    motion_type β†’ PTP_J , PTP_T , LINE_J , LINE_T , CIRC_J ,CIRC_T , PLINE_J ,PLINE_T
    positions β†’ motion target position: If expressed in Cartesian coordinate (unit: m), if expressed in joint angles (unit: rad)
    velocity β†’ motion velocity: if expressed in Cartesian coordinate (unit: m/s) 6 , if expressed in joint velocity (unit: rad/s, and the maximum value is limited to Ο€ ) 6
    acc_time β†’ time to reach maximum speed (unit: ms)
    blend_percentage β†’ blending value: expressed as a percentage (unit: %, and the minimum value of 0 means no blending)
    fine_goal β†’ precise position mode : If activated, the amount of error in the final position will converge more, but it will take a few more milliseconds.
    5 For more detailed information, please refer to defined protocol (Chapter8 PTP, Line, Circle, Pline, Move_PTP, Move_Line, Move_PLine)
    6 The unit of the parameters are different, the user can find the conversion in the program of TM ROS driver.

  • demo_write_item:
    In this demo code, the user can use this service to send TMSVR 7 cmd.
    7 For more detailed information, please refer to defined protocol (Chapter9.3 svr_write())

  • demo_leave_listen_node:
    In this demo code, the user can use send_script service sending a script to leave the Listen node.
    πŸ’‘ If the user has sent the demo_leave_listen_node script to leave the Listen node, and you want to run the TM Robot again, please remember that the Listen task project should be resumed to run. You can press the Stop Button on the Robot Stick and then press the Play/Pause Button to resume operation.

Β§ Usage with demo code & driver

Note: If the user have even successfully built a specific code(tmr_ros2), the user only need to change to the TM driver workspace path cd ~/tmdriver_ws , and then directly refer to steps 5~6 below.

  1. Type to create a root workspace directory by starting a terminal: For example, tmdriver_ws or catkin_ws, then type to change current directory into the workspace directory path.
    mkdir ~/tmdriver_ws
    cd ~/tmdriver_ws
  2. Clone the the TM driver of git repository into the current directory by typing
    git clone https://github.com/TechmanRobotInc/tmr_ros2.git
  3. After the download done, rename the download folder tmr_ros2(or tmr_ros2-master) to src by typing
    mv tmr_ros2 src
    (or right-click on the download folder, select "Rename...")
  4. At the workspace directory to build the download packages and source 'setup.bash' in this workspace to make the worksapce visible to ROS.
    Note: Do you set source /opt/ros/foxy/setup.bash ready? Make sure to obtain the correct setup file according to your workspace hierarchy, and then type the following below to compile.
    colcon build
    source ./install/setup.bash
  5. In a new terminal: Source setup.bash in the workspace path and run the driver to connect to TM Robot by typing
    source ./install/setup.bash
    ros2 run tm_driver tm_driver <robot_ip_address>
    The <robot_ip_address> is the IP address of the TM Robot, the user can get it through TM Flow, for example 192.168.10.2
  6. In another new terminal: Source setup.bash in the workspace path and type specific demo node function which the user want to study for applications. For example: the user select to run demo_set_io, the user can type
    source ./install/setup.bash
    ros2 run demo demo_set_io
    ⚠️[CAUTION] Some demos will let the TM Robot move, please be careful.

6. TM GUI debugging and demonstration

The GUI displays tm_driver connection status, sct, sta, svr messages and robot status. Easily judge the message between the driver and the robot through the GUI display. If the connection fails, the user can also try to send a reconnect command on this GUI for debugging.

Β§ GUI Debugging description

  • If the user forgets to run the TM ROS driver, the user will see all the controlled label items of the GUI are displayed as "NaN".
  • The user can click "Quit_GUI" button or click the "x" close button in the upper right corner to close this GUI.
  • If "Ethernet" and "Listen Node" connection display are "on", it means that ROS SvrClient and SctClient are successfully connected.
  • If "Ethernet" connection display is is "off", the user should check whether the TM Robot has been started or whether the network settings are correct.
  • If "Listen Node" connection is "off", the user should check whether the task project is running.
    πŸ’‘ If "Listen Node" connection is interrupted as "Project_Run" is stopped, the "Listen Node" connection will be "off".
  • If both "Ethernet" and "Listen Node" connection display are "on", but the "Robot_Link" is false or "Robot_Error" is true; this means the robot is working abnormally, or maybe the ESTOP button was pressed or or some kind of protection or error 1 occurred. Therefore, when the user sends a move script command at this time, it will not work.
    1 For more detailed information, please refer to the TM Robot User Guide.
  • The user can use the self-developed script to read/write project data through communication protocols to control the TM Robot. If it does not work properly, the user can quickly determine whether there is a communication error code by viewing the "Response ROS Node Status" display.
  • When the user sends a command or clicks DO0 Ctrl "H/L" button of Control_Box, the user also can see the response message 2 embedded in the "Robot Response" item view.
    2 For details of this item, please refer to SctResponse.msg, StaResponse.msg and SvrResponse.msg of TM ROS driver code.
  • The user can click "clear" button to clear the old response message.
    πŸ’‘ If "Ethernet" connection is interrupted, the display of most controlled label items in the GUI will be displayed as "NaN" and the robot feedback state will remain the last state and become invalid.

Β§ Usage with GUI debugging

Note: If the user have even successfully built a specific code(tmr_ros2), the user only need to change to the TM driver workspace path cd ~/tmdriver_ws , and then directly refer to steps 5~6 below.

  1. Type to create a root workspace directory by starting a terminal: For example, tmdriver_ws or catkin_ws, then type to change current directory into the workspace directory path.
    mkdir ~/tmdriver_ws
    cd ~/tmdriver_ws
  2. Clone the the TM driver of git repository into the current directory by typing
    git clone https://github.com/TechmanRobotInc/tmr_ros2.git
  3. After the download done, rename the download folder tmr_ros2(or tmr_ros2-master) to src by typing
    mv tmr_ros2 src
    (or right-click on the download folder, select "Rename...")
  4. At the workspace directory to build the download packages and source 'setup.bash' in this workspace to make the worksapce visible to ROS.
    Note: Do you set source /opt/ros/foxy/setup.bash ready? Make sure to obtain the correct setup file according to your workspace hierarchy, and then type the following below to compile.
    colcon build
    source ./install/setup.bash
  5. In a new terminal: Source setup.bash in the workspace path and run the driver to connect to TM Robot by typing
    source ./install/setup.bash
    ros2 run tm_driver tm_driver <robot_ip_address>
    The <robot_ip_address> is the IP address of the TM Robot, the user can get it through TM Flow, for example 192.168.10.2
  6. In another new terminal: Source setup.bash in the workspace path and start GUI debug by typing
    source ./install/setup.bash
    ros2 run ui_for_debug_and_demo robot_ui

7. TM Robot corrected kinematics value loading and robot description file generation

Real kinematic values vary from TM robot to another one as each robot is calibrated at the factory.
The user can use the tm_mod_urdf package to extract specific kinematic values from your TM robot, which are taken into account by a python script function using a specific set of commands to automatically generate a new URDF or Xacro robot model description file.

If the user just want to use the TM Robot nominal model to control the robot, the user can skip the rest of this chapter.

Β§ Corrected kinematics value description

The precise kinematic parameters of a robot is useful for improving the end-point accuracy of the robot.
Due to manufacturing tolerances during manufacturing and the installation error in the robot assembly process, the positioning accuracy and precision of the mechanism will be affected. The error between reality and nominal robot model is significantly reduced by the corrected robot description. The kinematic parameter compensated deviations of the robot can improve the absolute positioning accuracy of the robot.
If the user need to improve simulation accuracy or end effector tracking performance, it is recommended that the user import the corrected calibrated kinematic parameters from real TM Robot to replace the nominal set of D-H parameters. Techman Robot provides a URDF file that configures the TM Robot model with a set of nominal DH parameters, and one that uses the programming scripts to obtain calibrated kinematic parameters from a parameter server connected to your TM robot and perform a set of overrides to output a new corrected URDF file.

The common python script is used as follows:

python3 <script_name> <urdf_from> <urdf_gen>
  • <script_name> : Provide modify_xacro.py or modify_urdf.py two Python scripts program as options.
  • <urdf_from> : The first argument represents the original URDF model form of the TM Robot, and the file part naming 1 is <urdf_from>.
    1 There are several built-in TM Robot nominal robot model settings, available for tm5-900, tm5-700, tm12 and tm14 models, as well as the eyeless models tm5x-900, tm5x-700, tm12x and tm14x models.
    For example, select the tm12 nominal robot model as the input model form, the user can type tm12 as the <urdf_from>. For details of this item, please refer to modify_urdf.py or modify_xacro.py code.
  • <urdf_gen> : The second argument means the newly generated URDF model form of the TM Robot, and the file 2 name is <urdf_gen>.
    2 For example, if the user names it test and select modify_xacro.py as script program, a test.urdf.xacro robot description file will be generated.

The python script for more specific arguments is used as follows:

python3 <script_name> <urdf_from> <urdf_gen> <specific_para>
  • <specific_para> : The third argument is provided for use in some special cases. Please refer to the scripting program 3 for details of this item.
    3 For a simple third argument example, type the argument "-M" is as follows:
    Example : python3 modify_xacro.py tm5-900 test -M
    β†’ A robot description file "macro.test.urdf.xacro" will be generated, the string 'macro.' is prepended to the <urdf_gen> name.

Β§ Create with specific kinematic parameters of the local TM Robot

πŸ’‘ Do you run the driver to maintain the connection with TM Robot, make sure that TM Robot's operating software (TMflow) network settings are ready and the Listen node is running.

  • Take generating a new Xacro file as an example

The following steps describe how to import specific kinematic values using a real TM5-900 Robot following the procedure below, and select the corresponding type tm5-900 as an example of <urdf_from>.

  1. In a terminal: Source setup.bash in the workspace path and run the driver to connect to TM Robot by typing
source /opt/ros/foxy/setup.bash
cd <workspace>
source ./install/setup.bash
ros2 run tm_driver tm_driver <robot_ip_address>

The parameter <robot_ip_address> means the IP address of your TM Robot, the user can get it through TM Flow.

  1. In another new terminal: source setup.bash in the workspace path, change the current directory to the directory path of the python script to correct urdf, and then enter the specified command format to generate a new named URDF with arguments, for example, named user_defined.
source /opt/ros/foxy/setup.bash
cd <workspace>
source ./install/setup.bash
cd src/tm_mod_urdf/tm_mod_urdf
python3 modify_xacro.py tm5-900 user_defined

When this procedure is completed, the user can find that the newly generated named robot description file has been saved, eg "user_defined.urdf.xacro".

  1. Next, the user must modify the filename part of the default pre-built nominal robot model in tm5-900.urdf.xacro to a newly generated robot model description naming file.
cd src\tm_description\xacro\
sudo vim tm5-900.urdf.xacro

or use gedit text editor instead of vim to edit the file contents, by typing

sudo gedit tm5-900.urdf.xacro

πŸ“‘ Note1: If your real Robot is a TM5-700, in the above example, you should type tm5-700 as an example for <urdf_from> and modify the tm5-700.urdf.xacro file.
πŸ“‘ Note2: If your real Robot is the eyeless model as a TM5X-700, in the above example, you should type tm5x-700 as an example for <urdf_from> and modify the tm5x-700.urdf.xacro file.

Please refer to the following to modify the content format of the filename line:

# Before modification : (Take the pre-built TM5-900 nominal robot model as an example) 
  <xacro:include filename="$(find tm_description)/xacro/macro.tm5-900-nominal.urdf.xacro" />
# After modification : (Replace with your actual newly generated Xacro file)
  <xacro:include filename="$(find tm_description)/xacro/user_defined.urdf.xacro" />

Finally, the user can launch the modified robot file "tm5-900.urdf.xacro" to run your TM Robot or simulate the robot more accurately.

πŸ’‘ Tip: Remember to recompile since the code has been changed.
Please go back to your specific workspace. Then you can choose colcon build --cmake-clean-cache to rebuild, or you can clean the build, install and log directories with rm -r build install log before executing colcon build.

  • Take generating a new URDF file as an example

The following steps describe how to import specific kinematic values using a real TM5-900 Robot following the procedure below, and select the corresponding type tm5-900 as an example of <urdf_from>.

  1. In a terminal: Source setup.bash in the workspace path and run the driver to connect to TM Robot by typing
source /opt/ros/foxy/setup.bash
cd <workspace>
source ./install/setup.bash
ros2 run tm_driver tm_driver <robot_ip_address>

The parameter <robot_ip_address> means the IP address of your TM Robot, the user can get it through TM Flow.

  1. In another new terminal: source setup.bash in the workspace path, change the current directory to the directory path of the python script to correct urdf, and then enter the specified command format to generate a new named URDF with arguments, for example, named user_defined.
source /opt/ros/foxy/setup.bash
cd <workspace>
source ./install/setup.bash
cd src/tm_mod_urdf/tm_mod_urdf
python3 modify_urdf.py tm5-900 user_defined

When this procedure is completed, the user can find that the newly generated named robot description file has been saved, eg "user_defined.urdf".

πŸ“‘ Note1: If your real Robot is a TM12, in the above example, you should type tm12 as an example for <urdf_from>.
πŸ“‘ Note2: If your real Robot is the eyeless model as a TM12X, in the above example, you should type tm12x as an example for <urdf_from>.

Finally, the user can use the new robot file, such as "user_defined.urdf", instead of the default nominal URDF model to run your TM Robot or simulate the robot more accurately.

πŸ’‘ Tip: Remember to recompile since the code has been changed.
Please go back to your specific workspace. Then you can choose colcon build --cmake-clean-cache to rebuild, or you can clean the build, install and log directories with rm -r build install log before executing colcon build.

Β§ Import information available on screen

  • How can the user confirm that the data conversion process has been completed?
    Ans: The user can find the string "File saved with new kinematic values." displayed on the screen.
  • How can the user find the location of the newly generated named robot description file?
    Ans: The user can first find the displayed string "[new save file path:] " on the screen, and the following string is the file save location.

8. Contact us/Technical support

More Support & Service, please contact us. @TECHMAN ROBOT[https://www.tm-robot.com/zh-hant/contact-us/]

About

Techman Robot ROS2 Driver (experimental)

Resources

License

Stars

Watchers

Forks

Packages

No packages published

Languages

  • C++ 65.4%
  • Python 29.4%
  • CMake 5.2%