Skip to content

Commit 054f5a3

Browse files
timobktcjue
timobkt
authored and
cjue
committed
Add fanuc m20id25 with opw config
1 parent 379ac8d commit 054f5a3

28 files changed

Lines changed: 434 additions & 0 deletions

‎fanuc_m20id_support/CHANGELOG.rst‎

Lines changed: 21 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,21 @@
1+
^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
2+
Changelog for package fanuc_m20id_support
3+
^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
4+
5+
0.5.1 (2021-04-02)
6+
------------------
7+
* bump min CMake version (`#309 <https://github.com/ros-industrial/fanuc/issues/309>`_).
8+
* correct missing dependency on ``industrial_robot_client`` (RViz cfg) (`#306 <https://github.com/ros-industrial/fanuc/issues/306>`_).
9+
* point to manifest for info on package contents (`#292 <https://github.com/ros-industrial/fanuc/issues/292>`_).
10+
* remove roslaunch version requirements as they're no longer needed (`#278 <https://github.com/ros-industrial/fanuc/issues/278>`_).
11+
* migrate to JSP GUI (was split out of JSP).
12+
* for a complete list of changes see the `commit log for 0.5.1 <https://github.com/ros-industrial/fanuc/compare/0.5.0...0.5.1>`_.
13+
14+
0.5.0 (2019-09-25)
15+
------------------
16+
* first release of this package.
17+
* make ``flange`` parent of ``tool0`` (`#271 <https://github.com/ros-industrial/fanuc/issues/271>`_).
18+
* migrate M-20iB support and moveit pkgs from experimental repository (`#253 <https://github.com/ros-industrial/fanuc/pull/253>`_).
19+
* update xacro xmlns uri (`#239 <https://github.com/ros-industrial/fanuc/issues/239>`_).
20+
* add 'support level' indicators (`#232 <https://github.com/ros-industrial/fanuc/issues/232>`_).
21+
* for a complete list of changes see the `commit log for 0.5.0 <https://github.com/ros-industrial/fanuc/compare/0.4.4...0.5.0>`_.

‎fanuc_m20id_support/CMakeLists.txt‎

Lines changed: 17 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,17 @@
1+
cmake_minimum_required(VERSION 3.0.2)
2+
3+
project(fanuc_m20id_support)
4+
5+
find_package(catkin REQUIRED)
6+
7+
catkin_package()
8+
9+
if (CATKIN_ENABLE_TESTING)
10+
find_package(roslaunch REQUIRED)
11+
roslaunch_add_file_check(tests/roslaunch_test_m20id25.xml)
12+
endif()
13+
14+
install(DIRECTORY config launch meshes urdf
15+
DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION})
16+
17+
install(FILES readme.md DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION})

‎fanuc_m20id_support/config/joint_names_m20id25.yaml‎

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1 @@
1+
controller_joint_names: ['joint_1', 'joint_2', 'joint_3', 'joint_4', 'joint_5', 'joint_6']

‎fanuc_m20id_support/config/opw_parameters_m20id25.yaml‎

Lines changed: 20 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,20 @@
1+
#
2+
# Parameters for use with IK solvers which support OPW (Ortho-Parallel Wrist)
3+
# kinematic configurations, as described in the paper "An Analytical Solution
4+
# of the Inverse Kinematics Problem of Industrial Serial Manipulators with an
5+
# Ortho-parallel Basis and a Spherical Wrist" by Mathias Brandstötter, Arthur
6+
# Angerer, and Michael Hofbaur (Proceedings of the Austrian Robotics Workshop
7+
# 2014, 22-23 May, 2014, Linz, Austria).
8+
#
9+
# The moveit_opw_kinematics_plugin package provides such a solver.
10+
#
11+
opw_kinematics_geometric_parameters:
12+
a1: 0.075
13+
a2: -0.215
14+
b: 0.0
15+
c1: 0.425
16+
c2: 0.84
17+
c3: 0.89
18+
c4: 0.09
19+
opw_kinematics_joint_offsets: [0.0, 0.0, deg(-90.0), 0.0, 0.0, deg(180.0)]
20+
opw_kinematics_joint_sign_corrections: [1, 1, -1, -1, -1, -1]

‎fanuc_m20id_support/launch/load_m20id25.launch‎

Lines changed: 4 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,4 @@
1+
<?xml version="1.0"?>
2+
<launch>
3+
<param name="robot_description" command="$(find xacro)/xacro --inorder '$(find fanuc_m20id_support)/urdf/m20id25.xacro'" />
4+
</launch>

‎fanuc_m20id_support/launch/robot_interface_streaming_m20id25.launch‎

Lines changed: 25 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,25 @@
1+
<?xml version="1.0"?>
2+
<!--
3+
Manipulator specific version of 'robot_interface_streaming.launch'.
4+
5+
Defaults provided for M-20iB/25:
6+
- J23_factor = 1
7+
- use_bswap = true
8+
- 6 joints
9+
10+
Usage:
11+
robot_interface_streaming_m20id25.launch robot_ip:=<value>
12+
-->
13+
<launch>
14+
<arg name="robot_ip" doc="IP of controller" />
15+
<arg name="J23_factor" default="1" doc="Compensation factor for joint 2-3 coupling (-1, 0 or 1)" />
16+
<arg name="use_bswap" default="true" doc="If true, robot driver will byte-swap all incoming and outgoing data" />
17+
18+
<rosparam command="load" file="$(find fanuc_m20id_support)/config/joint_names_m20id25.yaml" />
19+
20+
<include file="$(find fanuc_driver)/launch/robot_interface_streaming.launch">
21+
<arg name="robot_ip" value="$(arg robot_ip)" />
22+
<arg name="J23_factor" value="$(arg J23_factor)" />
23+
<arg name="use_bswap" value="$(arg use_bswap)" />
24+
</include>
25+
</launch>

‎fanuc_m20id_support/launch/robot_state_visualize_m20id25.launch‎

Lines changed: 32 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,32 @@
1+
<?xml version="1.0"?>
2+
<!--
3+
Manipulator specific version of the state visualizer.
4+
5+
Defaults provided for M-20iB/25:
6+
- J23_factor = 1
7+
- use_bswap = true
8+
- 6 joints
9+
10+
Usage:
11+
robot_state_visualize_m20id25.launch robot_ip:=<value>
12+
-->
13+
<launch>
14+
<arg name="robot_ip" doc="IP of controller" />
15+
<arg name="J23_factor" default="1" doc="Compensation factor for joint 2-3 coupling (-1, 0 or 1)" />
16+
<arg name="use_bswap" default="true" doc="If true, robot driver will byte-swap all incoming and outgoing data" />
17+
18+
<rosparam command="load" file="$(find fanuc_m20id_support)/config/joint_names_m20id25.yaml" />
19+
20+
<include file="$(find fanuc_driver)/launch/robot_state.launch">
21+
<arg name="robot_ip" value="$(arg robot_ip)" />
22+
<arg name="J23_factor" value="$(arg J23_factor)" />
23+
<arg name="use_bswap" value="$(arg use_bswap)" />
24+
</include>
25+
26+
<node name="robot_state_publisher" pkg="robot_state_publisher"
27+
type="robot_state_publisher" />
28+
29+
<include file="$(find fanuc_m20id_support)/launch/load_m20id25.launch" />
30+
31+
<node name="rviz" pkg="rviz" type="rviz" args="-d $(find industrial_robot_client)/config/robot_state_visualize.rviz" required="true" />
32+
</launch>

‎fanuc_m20id_support/launch/test_m20id25.launch‎

Lines changed: 7 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,7 @@
1+
<?xml version="1.0"?>
2+
<launch>
3+
<include file="$(find fanuc_m20id_support)/launch/load_m20id25.launch" />
4+
<node name="joint_state_publisher_gui" pkg="joint_state_publisher_gui" type="joint_state_publisher_gui" />
5+
<node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" />
6+
<node name="rviz" pkg="rviz" type="rviz" args="-d $(find industrial_robot_client)/config/robot_state_visualize.rviz" required="true" />
7+
</launch>

‎fanuc_m20id_support/meshes/m20id25/collision/base.stl‎

4.54 MB
Binary file not shown.

‎fanuc_m20id_support/meshes/m20id25/collision/base_link.stl‎

8.87 KB
Binary file not shown.

0 commit comments

Comments
 (0)