From 5f068c763cb066c91ed96800a87695c9e632dd95 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?=E5=88=98=E5=BF=97=E9=80=9A?= <953598974@qq.com> Date: Thu, 26 Aug 2021 19:40:52 +0800 Subject: [PATCH] =?UTF-8?q?=E6=96=B0=E5=A2=9Egazebo=5Fdemo1=E5=8A=9F?= =?UTF-8?q?=E8=83=BD=E5=8C=85?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- gazebo_demo1/CMakeLists.txt | 42 ++ .../config/joint_names_gazebo_demo1.yaml | 53 +++ gazebo_demo1/export.log | 182 +++++++++ gazebo_demo1/launch/display.launch | 10 + gazebo_demo1/launch/gazebo.launch | 43 +++ gazebo_demo1/meshes/LB_LINK.STL | Bin 0 -> 5484 bytes gazebo_demo1/meshes/LF_LINK.STL | Bin 0 -> 5484 bytes gazebo_demo1/meshes/RB_LINK.STL | Bin 0 -> 5484 bytes gazebo_demo1/meshes/RF_LINK.STL | Bin 0 -> 5484 bytes gazebo_demo1/meshes/base_link.STL | Bin 0 -> 684 bytes gazebo_demo1/package.xml | 21 + gazebo_demo1/src/gazebo_demo1.cpp | 49 +++ gazebo_demo1/urdf/.gazebo_demo1.urdf | 342 +++++++++++++++++ gazebo_demo1/urdf/gazebo_demo1.urdf | 342 +++++++++++++++++ gazebo_demo1/urdf/gazebo_demo1.urdf.xacro | 362 ++++++++++++++++++ gazebo_demo1/urdf/gazebo_demo2.csv | 6 + 16 files changed, 1452 insertions(+) create mode 100644 gazebo_demo1/CMakeLists.txt create mode 100644 gazebo_demo1/config/joint_names_gazebo_demo1.yaml create mode 100644 gazebo_demo1/export.log create mode 100644 gazebo_demo1/launch/display.launch create mode 100644 gazebo_demo1/launch/gazebo.launch create mode 100644 gazebo_demo1/meshes/LB_LINK.STL create mode 100644 gazebo_demo1/meshes/LF_LINK.STL create mode 100644 gazebo_demo1/meshes/RB_LINK.STL create mode 100644 gazebo_demo1/meshes/RF_LINK.STL create mode 100644 gazebo_demo1/meshes/base_link.STL create mode 100644 gazebo_demo1/package.xml create mode 100644 gazebo_demo1/src/gazebo_demo1.cpp create mode 100644 gazebo_demo1/urdf/.gazebo_demo1.urdf create mode 100644 gazebo_demo1/urdf/gazebo_demo1.urdf create mode 100644 gazebo_demo1/urdf/gazebo_demo1.urdf.xacro create mode 100644 gazebo_demo1/urdf/gazebo_demo2.csv diff --git a/gazebo_demo1/CMakeLists.txt b/gazebo_demo1/CMakeLists.txt new file mode 100644 index 0000000..d9400b3 --- /dev/null +++ b/gazebo_demo1/CMakeLists.txt @@ -0,0 +1,42 @@ +cmake_minimum_required(VERSION 2.8.3) + +project(gazebo_demo1) + +add_compile_options(-std=c++11) + +find_package(catkin REQUIRED) + +catkin_package() + +find_package(catkin REQUIRED COMPONENTS + roslaunch + controller_manager + gazebo_ros + gazebo_ros_control + joint_state_publisher + robot_state_publisher + roscpp + rospy + rviz + xacro + kdl_parser + tf + sensor_msgs + std_msgs + trac_ik_lib + serial +) + +include_directories( + include + ${catkin_INCLUDE_DIRS} + ${orocos_kdl_INCLUDE_DIRS} +) + +add_executable(gazebo_demo1 src/gazebo_demo1.cpp) +target_link_libraries(gazebo_demo1 ${catkin_LIBRARIES} ${orocos_kdl_LIBRARIES}) + +foreach(dir config launch meshes urdf) + install(DIRECTORY ${dir}/ + DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}/${dir}) +endforeach(dir) diff --git a/gazebo_demo1/config/joint_names_gazebo_demo1.yaml b/gazebo_demo1/config/joint_names_gazebo_demo1.yaml new file mode 100644 index 0000000..b810d92 --- /dev/null +++ b/gazebo_demo1/config/joint_names_gazebo_demo1.yaml @@ -0,0 +1,53 @@ +gazebo_demo1: + + # Publish all joint states ----------------------------------- + + joint_state_controller: + + type: joint_state_controller/JointStateController + + publish_rate: 50 + + + + # Position Controllers --------------------------------------- + + lf_position_con: + + type: position_controllers/JointPositionController + + joint: LF_JOINT + + #pid: {p: 1.0, i: 0.01, d: 0.0} + + lb_position_con: + + type: position_controllers/JointPositionController + + joint: LB_JOINT + + #pid: {p: 1.0, i: 0.01, d: 0.0} + + rf_position_con: + + type: position_controllers/JointPositionController + + joint: RF_JOINT + + #pid: {p: 1.0, i: 0.01, d: 0.0} + + rb_position_con: + + type: position_controllers/JointPositionController + + joint: RB_JOINT + + #pid: {p: 1.0, i: 0.01, d: 0.0} + + + +gazebo_demo1/gazebo_ros_control/pid_gains: + LF_JOINT: {p: 1.0, i: 0.0, d: 0.0} + LB_JOINT: {p: 1.0, i: 0.0, d: 0.0} + RF_JOINT: {p: 1.0, i: 0.0, d: 0.0} + RB_JOINT: {p: 1.0, i: 0.0, d: 0.0} diff --git a/gazebo_demo1/export.log b/gazebo_demo1/export.log new file mode 100644 index 0000000..c1f01c7 --- /dev/null +++ b/gazebo_demo1/export.log @@ -0,0 +1,182 @@ +2021-08-24 10:46:42,896 INFO Logger.cs: 70 - +-------------------------------------------------------------------------------- +2021-08-24 10:46:42,947 INFO Logger.cs: 71 - Logging commencing for SW2URDF exporter +2021-08-24 10:46:42,950 INFO Logger.cs: 73 - Commit version 1.5.1-0-g916b5db +2021-08-24 10:46:42,951 INFO Logger.cs: 74 - Build version 1.5.7152.31018 +2021-08-24 10:46:42,978 INFO SwAddin.cs: 250 - Adding Assembly export to file menu +2021-08-24 10:46:42,979 INFO SwAddin.cs: 253 - Adding Part export to file menu +2021-08-24 10:46:43,010 INFO SwAddin.cs: 218 - Connecting plugin to SolidWorks +2021-08-24 11:18:05,520 INFO SwAddin.cs: 271 - Assembly export called for file gazebo_demo1.SLDASM +2021-08-24 11:18:12,570 INFO SwAddin.cs: 290 - Saving assembly +2021-08-24 11:18:12,666 INFO SwAddin.cs: 293 - Opening property manager +2021-08-24 11:18:12,702 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from gazebo_demo1.SLDASM +2021-08-24 11:18:12,721 INFO ExportHelperExtension.cs: 1142 - Found 48 in gazebo_demo1.SLDASM +2021-08-24 11:18:12,722 INFO ExportHelperExtension.cs: 1152 - Found 5 features of type [CoordSys] in gazebo_demo1.SLDASM +2021-08-24 11:18:12,722 INFO ExportHelperExtension.cs: 1155 - Proceeding through assembly components +2021-08-24 11:18:12,724 INFO ExportHelperExtension.cs: 1167 - 5 components to check +2021-08-24 11:18:12,726 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-2 +2021-08-24 11:18:12,726 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-2 +2021-08-24 11:18:12,727 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-2 +2021-08-24 11:18:12,728 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from 零件-1 +2021-08-24 11:18:12,729 INFO ExportHelperExtension.cs: 1142 - Found 27 in 零件-1 +2021-08-24 11:18:12,730 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in 零件-1 +2021-08-24 11:18:12,730 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-1 +2021-08-24 11:18:12,731 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-1 +2021-08-24 11:18:12,732 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-1 +2021-08-24 11:18:12,732 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-3 +2021-08-24 11:18:12,733 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-3 +2021-08-24 11:18:12,735 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-3 +2021-08-24 11:18:12,736 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-4 +2021-08-24 11:18:12,737 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-4 +2021-08-24 11:18:12,737 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-4 +2021-08-24 11:18:12,740 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from gazebo_demo1.SLDASM +2021-08-24 11:18:12,740 INFO ExportHelperExtension.cs: 1142 - Found 48 in gazebo_demo1.SLDASM +2021-08-24 11:18:12,742 INFO ExportHelperExtension.cs: 1152 - Found 5 features of type [RefAxis] in gazebo_demo1.SLDASM +2021-08-24 11:18:12,742 INFO ExportHelperExtension.cs: 1155 - Proceeding through assembly components +2021-08-24 11:18:12,743 INFO ExportHelperExtension.cs: 1167 - 5 components to check +2021-08-24 11:18:12,744 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-2 +2021-08-24 11:18:12,744 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-2 +2021-08-24 11:18:12,745 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-2 +2021-08-24 11:18:12,746 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from 零件-1 +2021-08-24 11:18:12,776 INFO ExportHelperExtension.cs: 1142 - Found 27 in 零件-1 +2021-08-24 11:18:12,777 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in 零件-1 +2021-08-24 11:18:12,777 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-1 +2021-08-24 11:18:12,778 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-1 +2021-08-24 11:18:12,779 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-1 +2021-08-24 11:18:12,780 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-3 +2021-08-24 11:18:12,781 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-3 +2021-08-24 11:18:12,782 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-3 +2021-08-24 11:18:12,783 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-4 +2021-08-24 11:18:12,784 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-4 +2021-08-24 11:18:12,785 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-4 +2021-08-24 11:18:13,048 INFO SwAddin.cs: 316 - Loading config tree +2021-08-24 11:18:13,056 INFO ExportPropertyManagerExtension.cs: 597 - Starting new configuration +2021-08-24 11:18:13,060 INFO SwAddin.cs: 321 - Showing property manager +2021-08-24 11:18:49,720 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:19:19,387 INFO ExportPropertyManager.cs: 1178 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:19:19,755 INFO ExportPropertyManager.cs: 1178 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:19:20,153 INFO ExportPropertyManager.cs: 1178 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:19:20,474 INFO ExportPropertyManager.cs: 1178 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:19:44,572 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:19:47,266 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:20:42,987 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:10,789 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:12,555 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:14,627 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:32,259 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:33,923 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:48,992 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:50,592 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:21:52,410 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:22:08,999 INFO ExportPropertyManager.cs: 1060 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:22:25,120 INFO ExportPropertyManager.cs: 456 - Configuration saved +2021-08-24 11:22:25,379 INFO ExportHelperExtension.cs: 338 - Creating joint LF_LINK +2021-08-24 11:22:25,696 WARN ExportHelperExtension.cs: 342 - Creating joint from parent base_link to child LF_LINK failed +2021-08-24 11:22:25,700 INFO ExportHelperExtension.cs: 338 - Creating joint LB_LINK +2021-08-24 11:22:25,729 WARN ExportHelperExtension.cs: 342 - Creating joint from parent base_link to child LB_LINK failed +2021-08-24 11:22:25,732 INFO ExportHelperExtension.cs: 338 - Creating joint RF_LINK +2021-08-24 11:22:25,761 WARN ExportHelperExtension.cs: 342 - Creating joint from parent base_link to child RF_LINK failed +2021-08-24 11:22:25,764 INFO ExportHelperExtension.cs: 338 - Creating joint RB_LINK +2021-08-24 11:22:25,796 WARN ExportHelperExtension.cs: 342 - Creating joint from parent base_link to child RB_LINK failed +2021-08-24 11:22:25,958 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from gazebo_demo1.SLDASM +2021-08-24 11:22:25,965 INFO ExportHelperExtension.cs: 1142 - Found 49 in gazebo_demo1.SLDASM +2021-08-24 11:22:25,966 INFO ExportHelperExtension.cs: 1152 - Found 5 features of type [CoordSys] in gazebo_demo1.SLDASM +2021-08-24 11:22:25,967 INFO ExportHelperExtension.cs: 1155 - Proceeding through assembly components +2021-08-24 11:22:25,967 INFO ExportHelperExtension.cs: 1167 - 5 components to check +2021-08-24 11:22:25,968 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-2 +2021-08-24 11:22:25,968 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-2 +2021-08-24 11:22:25,969 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-2 +2021-08-24 11:22:25,969 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from 零件-1 +2021-08-24 11:22:25,969 INFO ExportHelperExtension.cs: 1142 - Found 27 in 零件-1 +2021-08-24 11:22:25,969 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in 零件-1 +2021-08-24 11:22:25,970 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-1 +2021-08-24 11:22:25,970 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-1 +2021-08-24 11:22:25,971 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-1 +2021-08-24 11:22:25,971 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-3 +2021-08-24 11:22:25,971 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-3 +2021-08-24 11:22:25,972 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-3 +2021-08-24 11:22:25,972 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [CoordSys] from tui-4 +2021-08-24 11:22:25,973 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-4 +2021-08-24 11:22:25,974 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [CoordSys] in tui-4 +2021-08-24 11:22:25,979 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from gazebo_demo1.SLDASM +2021-08-24 11:22:25,980 INFO ExportHelperExtension.cs: 1142 - Found 49 in gazebo_demo1.SLDASM +2021-08-24 11:22:25,980 INFO ExportHelperExtension.cs: 1152 - Found 5 features of type [RefAxis] in gazebo_demo1.SLDASM +2021-08-24 11:22:25,981 INFO ExportHelperExtension.cs: 1155 - Proceeding through assembly components +2021-08-24 11:22:25,981 INFO ExportHelperExtension.cs: 1167 - 5 components to check +2021-08-24 11:22:25,982 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-2 +2021-08-24 11:22:25,982 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-2 +2021-08-24 11:22:25,982 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-2 +2021-08-24 11:22:25,983 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from 零件-1 +2021-08-24 11:22:26,001 INFO ExportHelperExtension.cs: 1142 - Found 27 in 零件-1 +2021-08-24 11:22:26,001 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in 零件-1 +2021-08-24 11:22:26,002 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-1 +2021-08-24 11:22:26,002 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-1 +2021-08-24 11:22:26,003 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-1 +2021-08-24 11:22:26,003 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-3 +2021-08-24 11:22:26,003 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-3 +2021-08-24 11:22:26,004 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-3 +2021-08-24 11:22:26,004 INFO ExportHelperExtension.cs: 1131 - Retrieving features of type [RefAxis] from tui-4 +2021-08-24 11:22:26,005 INFO ExportHelperExtension.cs: 1142 - Found 27 in tui-4 +2021-08-24 11:22:26,005 INFO ExportHelperExtension.cs: 1152 - Found 0 features of type [RefAxis] in tui-4 +2021-08-24 11:22:26,119 INFO ExportPropertyManager.cs: 1184 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2021-08-24 11:23:32,446 INFO AssemblyExportForm.cs: 254 - Completing URDF export +2021-08-24 11:23:32,452 INFO Serialization.cs: 275 - URDF Configuration found +nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalse?????????1linktruenametrueLF_LINKxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueLF_JOINTtypetruecontinuousxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalse?????????2?????????2linktruefalse+CoAAAUAAAD//v8SdAB1AGkALQAxAEAAZwBhAHoAZQBiAG8AXwBkAGUAbQBvADEABAAAABAAAAABAAAAAQAAABgAAAA=falsefalsenametrueLB_LINKxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueLB_JOINTtypetruecontinuousxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalse?????????3?????????3linktruefalse+CoAAAUAAAD//v8SdAB1AGkALQAyAEAAZwBhAHoAZQBiAG8AXwBkAGUAbQBvADEABAAAABAAAAABAAAAAQAAAB8AAAA=falsefalsenametrueRF_LINKxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueRF_JOINTtypetruecontinuousxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalse?????????4?????????4linktruefalse+CoAAAUAAAD//v8SdAB1AGkALQA0AEAAZwBhAHoAZQBiAG8AXwBkAGUAbQBvADEABAAAABAAAAABAAAAAQAAADkAAAA=falsefalsenametrueRB_LINKxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueRB_JOINTtypetruecontinuousxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalse?????????5?????????5linktruefalse+CoAAAUAAAD//v8SdAB1AGkALQAzAEAAZwBhAHoAZQBiAG8AXwBkAGUAbQBvADEABAAAABAAAAABAAAAAQAAACEAAAA=falsefalsefalse+CoAAAUAAAD//v8R9pb2Ti0AMQBAAGcAYQB6AGUAYgBvAF8AZABlAG0AbwAxAAQAAAAQAAAAAQAAAAEAAAAXAAAAfalsefalse +2021-08-24 11:23:49,039 INFO AssemblyExportForm.cs: 308 - Saving URDF package to C:\Users\Zhitong\Desktop\gazebo_demo2 +2021-08-24 11:23:49,043 INFO ExportHelper.cs: 147 - Beginning the export process +2021-08-24 11:23:49,045 INFO ExportHelper.cs: 153 - Creating package directories with name gazebo_demo2 and save path C:\Users\Zhitong\Desktop +2021-08-24 11:23:50,444 INFO ExportHelper.cs: 162 - Creating CMakeLists.txt at C:\Users\Zhitong\Desktop\gazebo_demo2\CMakeLists.txt +2021-08-24 11:23:50,445 INFO ExportHelper.cs: 166 - Creating joint names config at C:\Users\Zhitong\Desktop\gazebo_demo2\config\joint_names_gazebo_demo2.yaml +2021-08-24 11:23:50,448 INFO ExportHelper.cs: 170 - Creating package.xml at C:\Users\Zhitong\Desktop\gazebo_demo2\package.xml +2021-08-24 11:23:50,450 INFO PackageXMLWriter.cs: 21 - Creating package.xml at C:\Users\Zhitong\Desktop\gazebo_demo2\package.xml +2021-08-24 11:23:50,456 INFO ExportHelper.cs: 177 - Creating RVIZ launch file in C:\Users\Zhitong\Desktop\gazebo_demo2\launch\ +2021-08-24 11:23:50,460 INFO ExportHelper.cs: 182 - Creating Gazebo launch file in C:\Users\Zhitong\Desktop\gazebo_demo2\launch\ +2021-08-24 11:23:50,462 INFO ExportHelper.cs: 187 - Saving existing STL preferences +2021-08-24 11:23:50,463 INFO ExportHelper.cs: 451 - Saving users preferences +2021-08-24 11:23:50,465 INFO ExportHelper.cs: 190 - Modifying STL preferences +2021-08-24 11:23:50,466 INFO ExportHelper.cs: 465 - Setting STL preferences +2021-08-24 11:23:50,475 INFO ExportHelper.cs: 196 - Found 0 hidden components +2021-08-24 11:23:50,475 INFO ExportHelper.cs: 197 - Hiding all components +2021-08-24 11:23:50,598 INFO ExportHelper.cs: 204 - Beginning individual files export +2021-08-24 11:23:50,602 INFO ExportHelper.cs: 270 - Exporting link: base_link +2021-08-24 11:23:50,602 INFO ExportHelper.cs: 272 - Link base_link has 4 children +2021-08-24 11:23:50,603 INFO ExportHelper.cs: 270 - Exporting link: LF_LINK +2021-08-24 11:23:50,604 INFO ExportHelper.cs: 272 - Link LF_LINK has 0 children +2021-08-24 11:23:50,611 INFO ExportHelper.cs: 318 - LF_LINK: Exporting STL with coordinate frame 坐标系2 +2021-08-24 11:23:50,612 INFO ExportHelper.cs: 323 - LF_LINK: Reference geometry name +2021-08-24 11:23:50,692 INFO ExportHelper.cs: 331 - Saving STL to C:\Users\Zhitong\Desktop\gazebo_demo2\meshes\LF_LINK.STL +2021-08-24 11:23:50,803 INFO ExportHelper.cs: 406 - Removing SW header in STL file +2021-08-24 11:23:50,806 INFO ExportHelper.cs: 270 - Exporting link: LB_LINK +2021-08-24 11:23:50,807 INFO ExportHelper.cs: 272 - Link LB_LINK has 0 children +2021-08-24 11:23:50,809 INFO ExportHelper.cs: 318 - LB_LINK: Exporting STL with coordinate frame 坐标系3 +2021-08-24 11:23:50,810 INFO ExportHelper.cs: 323 - LB_LINK: Reference geometry name +2021-08-24 11:23:51,159 INFO ExportHelper.cs: 331 - Saving STL to C:\Users\Zhitong\Desktop\gazebo_demo2\meshes\LB_LINK.STL +2021-08-24 11:23:51,241 INFO ExportHelper.cs: 406 - Removing SW header in STL file +2021-08-24 11:23:51,242 INFO ExportHelper.cs: 270 - Exporting link: RF_LINK +2021-08-24 11:23:51,243 INFO ExportHelper.cs: 272 - Link RF_LINK has 0 children +2021-08-24 11:23:51,243 INFO ExportHelper.cs: 318 - RF_LINK: Exporting STL with coordinate frame 坐标系4 +2021-08-24 11:23:51,244 INFO ExportHelper.cs: 323 - RF_LINK: Reference geometry name +2021-08-24 11:23:51,340 INFO ExportHelper.cs: 331 - Saving STL to C:\Users\Zhitong\Desktop\gazebo_demo2\meshes\RF_LINK.STL +2021-08-24 11:23:51,423 INFO ExportHelper.cs: 406 - Removing SW header in STL file +2021-08-24 11:23:51,425 INFO ExportHelper.cs: 270 - Exporting link: RB_LINK +2021-08-24 11:23:51,426 INFO ExportHelper.cs: 272 - Link RB_LINK has 0 children +2021-08-24 11:23:51,427 INFO ExportHelper.cs: 318 - RB_LINK: Exporting STL with coordinate frame 坐标系5 +2021-08-24 11:23:51,427 INFO ExportHelper.cs: 323 - RB_LINK: Reference geometry name +2021-08-24 11:23:51,521 INFO ExportHelper.cs: 331 - Saving STL to C:\Users\Zhitong\Desktop\gazebo_demo2\meshes\RB_LINK.STL +2021-08-24 11:23:51,587 INFO ExportHelper.cs: 406 - Removing SW header in STL file +2021-08-24 11:23:51,588 INFO ExportHelper.cs: 318 - base_link: Exporting STL with coordinate frame 坐标系1 +2021-08-24 11:23:51,589 INFO ExportHelper.cs: 323 - base_link: Reference geometry name +2021-08-24 11:23:51,673 INFO ExportHelper.cs: 331 - Saving STL to C:\Users\Zhitong\Desktop\gazebo_demo2\meshes\base_link.STL +2021-08-24 11:23:51,724 INFO ExportHelper.cs: 406 - Removing SW header in STL file +2021-08-24 11:23:51,724 INFO ExportHelper.cs: 145 - Showing all components except previously hidden components +2021-08-24 11:23:51,926 INFO ExportHelper.cs: 145 - Resetting STL preferences +2021-08-24 11:23:51,927 INFO ExportHelper.cs: 479 - Returning STL preferences to user preferences +2021-08-24 11:23:51,928 INFO ExportHelper.cs: 228 - Writing URDF file to C:\Users\Zhitong\Desktop\gazebo_demo2\urdf\gazebo_demo2.urdf +2021-08-24 11:23:52,001 INFO CSVImportExport.cs: 32 - Writing CSV file C:\Users\Zhitong\Desktop\gazebo_demo2\urdf\gazebo_demo2.csv +2021-08-24 11:23:52,037 ERROR CSVImportExport.cs: 132 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2021-08-24 11:23:52,038 ERROR CSVImportExport.cs: 132 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2021-08-24 11:23:52,038 ERROR CSVImportExport.cs: 132 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2021-08-24 11:23:52,040 ERROR CSVImportExport.cs: 132 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2021-08-24 11:23:52,041 ERROR CSVImportExport.cs: 132 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2021-08-24 11:23:52,042 INFO ExportHelper.cs: 234 - Copying log file +2021-08-24 11:23:52,048 INFO ExportHelper.cs: 440 - Copying C:\Users\Zhitong\sw2urdf_logs\sw2urdf.log to C:\Users\Zhitong\Desktop\gazebo_demo2\export.log diff --git a/gazebo_demo1/launch/display.launch b/gazebo_demo1/launch/display.launch new file mode 100644 index 0000000..8488aa9 --- /dev/null +++ b/gazebo_demo1/launch/display.launch @@ -0,0 +1,10 @@ + + + + + + + + + + diff --git a/gazebo_demo1/launch/gazebo.launch b/gazebo_demo1/launch/gazebo.launch new file mode 100644 index 0000000..a0321ae --- /dev/null +++ b/gazebo_demo1/launch/gazebo.launch @@ -0,0 +1,43 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/gazebo_demo1/meshes/LB_LINK.STL b/gazebo_demo1/meshes/LB_LINK.STL new file mode 100644 index 0000000000000000000000000000000000000000..2ebaf3ac94e1d7dbe8bbc35e5201229231e1606e GIT binary patch literal 5484 zcmb`KJ%|)R5QR4|GLaJl6BExw6vXs;z0p7fLo)*t|1dZZgaad)$VmJN1yMLpjKn|` zxkd*R6A?^A0~13N!ALL=tgd-|^UdtEdw~NBkFEFmb#+%)&rBx&_gS&wet-RS<=Xtq%VDv7GjU5#VrP@%{AE`R_~Zen3%!70CiNkM&zutAjgM z-GdR}aJv35z4&L3JfNt-iev$s$7E9bIwimeaQ4_}^O&P>medJ%dAv?;i~#4gl85q` zQ79*80eAc13PynQp2yyP%qX-s&H^?MRY{ZbU<5eVt~^Q#)tIw@%|q4h9*h9zGboRe zLTANUz~-S->mG~%=UyU@l0s+RS-|F@e&rsF00(s?d6X1n0h>qr)b4Tn&FUeGrm^hj z{n0W04@E_w0@xHbt5?={XFNFWwa@o9tnVhje<;WTwmfWgUt8aG4@Q8)#}m7w^<81 ztnd1%Wdt~^9KIW^@2Z!S6l4LLhjpLE`mTF00vwhetwrm*UB4PtkOgcW)m|>=UKH1 z-LIa9?sLa_f6$5QGW-iCU_^JVvp7;;!3Y(cZCOET$nnNvZQ{vVkY=c_L2EUrj@R*X=gKEF}ikB}l{;f5RJfnJ+e z*VX9r0|g`KqSkW_4cE}De8Tnp%y}4fj!SR zS=w{<;DG`ap6{hO3S>T}aCLuHR0un(oW}@jj)G(1Obotpx_Q+V6*y6YFE1+4sq=oM z>I)pH<6HOXd7wMzFJV`g73j|SyVktY_eb~C6>hTpW$LW0%?h_c&V0m!W8sdyc{qzB r&7GAi(6t919E&V=jJ^l%rCe8W>(!1sG1soE`yQ+-yaD9%p|$!8So^|W literal 0 HcmV?d00001 diff --git a/gazebo_demo1/meshes/LF_LINK.STL b/gazebo_demo1/meshes/LF_LINK.STL new file mode 100644 index 0000000000000000000000000000000000000000..2ebaf3ac94e1d7dbe8bbc35e5201229231e1606e GIT binary patch literal 5484 zcmb`KJ%|)R5QR4|GLaJl6BExw6vXs;z0p7fLo)*t|1dZZgaad)$VmJN1yMLpjKn|` zxkd*R6A?^A0~13N!ALL=tgd-|^UdtEdw~NBkFEFmb#+%)&rBx&_gS&wet-RS<=Xtq%VDv7GjU5#VrP@%{AE`R_~Zen3%!70CiNkM&zutAjgM z-GdR}aJv35z4&L3JfNt-iev$s$7E9bIwimeaQ4_}^O&P>medJ%dAv?;i~#4gl85q` zQ79*80eAc13PynQp2yyP%qX-s&H^?MRY{ZbU<5eVt~^Q#)tIw@%|q4h9*h9zGboRe zLTANUz~-S->mG~%=UyU@l0s+RS-|F@e&rsF00(s?d6X1n0h>qr)b4Tn&FUeGrm^hj z{n0W04@E_w0@xHbt5?={XFNFWwa@o9tnVhje<;WTwmfWgUt8aG4@Q8)#}m7w^<81 ztnd1%Wdt~^9KIW^@2Z!S6l4LLhjpLE`mTF00vwhetwrm*UB4PtkOgcW)m|>=UKH1 z-LIa9?sLa_f6$5QGW-iCU_^JVvp7;;!3Y(cZCOET$nnNvZQ{vVkY=c_L2EUrj@R*X=gKEF}ikB}l{;f5RJfnJ+e z*VX9r0|g`KqSkW_4cE}De8Tnp%y}4fj!SR zS=w{<;DG`ap6{hO3S>T}aCLuHR0un(oW}@jj)G(1Obotpx_Q+V6*y6YFE1+4sq=oM z>I)pH<6HOXd7wMzFJV`g73j|SyVktY_eb~C6>hTpW$LW0%?h_c&V0m!W8sdyc{qzB r&7GAi(6t919E&V=jJ^l%rCe8W>(!1sG1soE`yQ+-yaD9%p|$!8So^|W literal 0 HcmV?d00001 diff --git a/gazebo_demo1/meshes/RB_LINK.STL b/gazebo_demo1/meshes/RB_LINK.STL new file mode 100644 index 0000000000000000000000000000000000000000..2ebaf3ac94e1d7dbe8bbc35e5201229231e1606e GIT binary patch literal 5484 zcmb`KJ%|)R5QR4|GLaJl6BExw6vXs;z0p7fLo)*t|1dZZgaad)$VmJN1yMLpjKn|` zxkd*R6A?^A0~13N!ALL=tgd-|^UdtEdw~NBkFEFmb#+%)&rBx&_gS&wet-RS<=Xtq%VDv7GjU5#VrP@%{AE`R_~Zen3%!70CiNkM&zutAjgM z-GdR}aJv35z4&L3JfNt-iev$s$7E9bIwimeaQ4_}^O&P>medJ%dAv?;i~#4gl85q` zQ79*80eAc13PynQp2yyP%qX-s&H^?MRY{ZbU<5eVt~^Q#)tIw@%|q4h9*h9zGboRe zLTANUz~-S->mG~%=UyU@l0s+RS-|F@e&rsF00(s?d6X1n0h>qr)b4Tn&FUeGrm^hj z{n0W04@E_w0@xHbt5?={XFNFWwa@o9tnVhje<;WTwmfWgUt8aG4@Q8)#}m7w^<81 ztnd1%Wdt~^9KIW^@2Z!S6l4LLhjpLE`mTF00vwhetwrm*UB4PtkOgcW)m|>=UKH1 z-LIa9?sLa_f6$5QGW-iCU_^JVvp7;;!3Y(cZCOET$nnNvZQ{vVkY=c_L2EUrj@R*X=gKEF}ikB}l{;f5RJfnJ+e z*VX9r0|g`KqSkW_4cE}De8Tnp%y}4fj!SR zS=w{<;DG`ap6{hO3S>T}aCLuHR0un(oW}@jj)G(1Obotpx_Q+V6*y6YFE1+4sq=oM z>I)pH<6HOXd7wMzFJV`g73j|SyVktY_eb~C6>hTpW$LW0%?h_c&V0m!W8sdyc{qzB r&7GAi(6t919E&V=jJ^l%rCe8W>(!1sG1soE`yQ+-yaD9%p|$!8So^|W literal 0 HcmV?d00001 diff --git a/gazebo_demo1/meshes/RF_LINK.STL b/gazebo_demo1/meshes/RF_LINK.STL new file mode 100644 index 0000000000000000000000000000000000000000..2ebaf3ac94e1d7dbe8bbc35e5201229231e1606e GIT binary patch literal 5484 zcmb`KJ%|)R5QR4|GLaJl6BExw6vXs;z0p7fLo)*t|1dZZgaad)$VmJN1yMLpjKn|` zxkd*R6A?^A0~13N!ALL=tgd-|^UdtEdw~NBkFEFmb#+%)&rBx&_gS&wet-RS<=Xtq%VDv7GjU5#VrP@%{AE`R_~Zen3%!70CiNkM&zutAjgM z-GdR}aJv35z4&L3JfNt-iev$s$7E9bIwimeaQ4_}^O&P>medJ%dAv?;i~#4gl85q` zQ79*80eAc13PynQp2yyP%qX-s&H^?MRY{ZbU<5eVt~^Q#)tIw@%|q4h9*h9zGboRe zLTANUz~-S->mG~%=UyU@l0s+RS-|F@e&rsF00(s?d6X1n0h>qr)b4Tn&FUeGrm^hj z{n0W04@E_w0@xHbt5?={XFNFWwa@o9tnVhje<;WTwmfWgUt8aG4@Q8)#}m7w^<81 ztnd1%Wdt~^9KIW^@2Z!S6l4LLhjpLE`mTF00vwhetwrm*UB4PtkOgcW)m|>=UKH1 z-LIa9?sLa_f6$5QGW-iCU_^JVvp7;;!3Y(cZCOET$nnNvZQ{vVkY=c_L2EUrj@R*X=gKEF}ikB}l{;f5RJfnJ+e z*VX9r0|g`KqSkW_4cE}De8Tnp%y}4fj!SR zS=w{<;DG`ap6{hO3S>T}aCLuHR0un(oW}@jj)G(1Obotpx_Q+V6*y6YFE1+4sq=oM z>I)pH<6HOXd7wMzFJV`g73j|SyVktY_eb~C6>hTpW$LW0%?h_c&V0m!W8sdyc{qzB r&7GAi(6t919E&V=jJ^l%rCe8W>(!1sG1soE`yQ+-yaD9%p|$!8So^|W literal 0 HcmV?d00001 diff --git a/gazebo_demo1/meshes/base_link.STL b/gazebo_demo1/meshes/base_link.STL new file mode 100644 index 0000000000000000000000000000000000000000..a8e9253e835af2cb72a72d3d71af3d007a1e6412 GIT binary patch literal 684 zcmb`D!3~2j3`Kpe*r-J;(4o8mLofy)B+m5QNqTR-;~xwPH@M_0@$<70x%X?Voi6P9 z+1_)%{-(!wczS+?jQbI_Rbs3VppDq6RMnmw^zr_hpo0Xb%~N&0hq?oH?7_awWhx~h zfq>&oz_(9jRH}kKI+%HXP0&FCKIB5!|LQ7}kbq;te!jCE3ZlF?9SO?^VhL583Vo4} PduZkqM0s&K5|%~&p|TD9 literal 0 HcmV?d00001 diff --git a/gazebo_demo1/package.xml b/gazebo_demo1/package.xml new file mode 100644 index 0000000..d2483eb --- /dev/null +++ b/gazebo_demo1/package.xml @@ -0,0 +1,21 @@ + + gazebo_demo1 + 1.0.0 + +

URDF Description package for gazebo_demo1

+

This package contains configuration data, 3D models and launch files +for gazebo_demo1 robot

+
+ TODO + + BSD + catkin + roslaunch + robot_state_publisher + rviz + joint_state_publisher + gazebo + + + +
diff --git a/gazebo_demo1/src/gazebo_demo1.cpp b/gazebo_demo1/src/gazebo_demo1.cpp new file mode 100644 index 0000000..2b62569 --- /dev/null +++ b/gazebo_demo1/src/gazebo_demo1.cpp @@ -0,0 +1,49 @@ +#include "ros/ros.h" +#include "std_msgs/Float64.h" +#include + +int main(int argc, char *argv[]) +{ + setlocale(LC_ALL,""); + ros::init(argc,argv,"control_gazebo_demo1"); + ros::NodeHandle nh; + ros::Publisher pub_lf = nh.advertise("/gazebo_demo1/lf_position_con/command",10); + ros::Publisher pub_lb = nh.advertise("/gazebo_demo1/lb_position_con/command",10); + ros::Publisher pub_rf = nh.advertise("/gazebo_demo1/rf_position_con/command",10); + ros::Publisher pub_rb = nh.advertise("/gazebo_demo1/rb_position_con/command",10); + std_msgs::Float64 control_gazebo_demo1; + control_gazebo_demo1.data=0.0; + bool flag=0;//0weizeng 1weijian + ros::Rate r(15); + while (ros::ok()) + { + + pub_lf.publish(control_gazebo_demo1); + pub_lb.publish(control_gazebo_demo1); + pub_rf.publish(control_gazebo_demo1); + pub_rb.publish(control_gazebo_demo1); + control_gazebo_demo1.data+=0.1; + r.sleep(); + +/* + for(control_gazebo_demo.data=0.0;control_gazebo_demo.data<=1.5;control_gazebo_demo.data+=0.01) + { + pub.publish(control_gazebo_demo); + + ROS_INFO("鍙戦佺殑娑堟伅:%f",control_gazebo_demo); + r.sleep(); + } + + for(control_gazebo_demo.data=1.5;control_gazebo_demo.data>=0.0;control_gazebo_demo.data-=0.01) + { + pub.publish(control_gazebo_demo); + + ROS_INFO("鍙戦佺殑娑堟伅:%f",control_gazebo_demo); + r.sleep(); + } + */ + + ros::spinOnce(); + } + return 0; +} diff --git a/gazebo_demo1/urdf/.gazebo_demo1.urdf b/gazebo_demo1/urdf/.gazebo_demo1.urdf new file mode 100644 index 0000000..f5caa25 --- /dev/null +++ b/gazebo_demo1/urdf/.gazebo_demo1.urdf @@ -0,0 +1,342 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + Gazebo/Black + + + + Gazebo/Black + + + + Gazebo/Black + + + + Gazebo/Black + + + + Gazebo/Black + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + + /gazebo_demo1 + gazebo_ros_control/DefaultRobotHWSim + true + + + + diff --git a/gazebo_demo1/urdf/gazebo_demo1.urdf b/gazebo_demo1/urdf/gazebo_demo1.urdf new file mode 100644 index 0000000..f5caa25 --- /dev/null +++ b/gazebo_demo1/urdf/gazebo_demo1.urdf @@ -0,0 +1,342 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + Gazebo/Black + + + + Gazebo/Black + + + + Gazebo/Black + + + + Gazebo/Black + + + + Gazebo/Black + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + + /gazebo_demo1 + gazebo_ros_control/DefaultRobotHWSim + true + + + + diff --git a/gazebo_demo1/urdf/gazebo_demo1.urdf.xacro b/gazebo_demo1/urdf/gazebo_demo1.urdf.xacro new file mode 100644 index 0000000..74ec4bb --- /dev/null +++ b/gazebo_demo1/urdf/gazebo_demo1.urdf.xacro @@ -0,0 +1,362 @@ + + + + + + /gazebo_demo1 + gazebo_ros_control/DefaultRobotHWSim + true + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + 0.2 + 0.2 + Gazebo/Black + + + + 1 + 1 + Gazebo/Black + + + + 1 + 1 + Gazebo/Black + + + + 1 + 1 + Gazebo/Black + + + + 1 + 1 + Gazebo/Black + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + transmission_interface/SimpleTransmission + + hardware_interface/PositionJointInterface + + + hardware_interface/PositionJointInterface + 1 + + + + + + diff --git a/gazebo_demo1/urdf/gazebo_demo2.csv b/gazebo_demo1/urdf/gazebo_demo2.csv new file mode 100644 index 0000000..f920f52 --- /dev/null +++ b/gazebo_demo1/urdf/gazebo_demo2.csv @@ -0,0 +1,6 @@ +Link Name,Center of Mass X,Center of Mass Y,Center of Mass Z,Center of Mass Roll,Center of Mass Pitch,Center of Mass Yaw,Mass,Moment Ixx,Moment Ixy,Moment Ixz,Moment Iyy,Moment Iyz,Moment Izz,Visual X,Visual Y,Visual Z,Visual Roll,Visual Pitch,Visual Yaw,Mesh Filename,Color Red,Color Green,Color Blue,Color Alpha,Collision X,Collision Y,Collision Z,Collision Roll,Collision Pitch,Collision Yaw,Collision Mesh Filename,Material Name,SW Components,Coordinate System,Axis Name,Joint Name,Joint Type,Joint Origin X,Joint Origin Y,Joint Origin Z,Joint Origin Roll,Joint Origin Pitch,Joint Origin Yaw,Parent,Joint Axis X,Joint Axis Y,Joint Axis Z,Limit Effort,Limit Velocity,Limit Lower,Limit Upper,Calibration rising,Calibration falling,Dynamics Damping,Dynamics Friction,Safety Soft Upper,Safety Soft Lower,Safety K Position,Safety K Velocity +base_link,-6.0445212263786E-18,1.39257863414922E-18,-2.20581496680807E-19,0,0,0,0.468,0.0001443,-1.53384791846956E-20,-1.37563571644961E-21,0.0003939,-1.29382985829106E-37,0.0005304,0,0,0,0,0,0,package://gazebo_demo2/meshes/base_link.STL,0.529411764705882,0.549019607843137,0.549019607843137,1,0,0,0,0,0,0,package://gazebo_demo2/meshes/base_link.STL,,闆朵欢-1,鍧愭爣绯1,,,,0,0,0,0,0,0,,0,0,0,,,,,,,,,,,, +LF_LINK,0.01,-1.59413400484866E-18,0,0,0,0,0.0108630528372501,1.06775440310417E-07,1.20998908503938E-22,-1.75453282727152E-23,7.38080724035423E-07,8.06501097239194E-25,7.99593444190632E-07,0,0,0,0,0,0,package://gazebo_demo2/meshes/LF_LINK.STL,0.529411764705882,0.549019607843137,0.549019607843137,1,0,0,0,0,0,0,package://gazebo_demo2/meshes/LF_LINK.STL,,tui-1,鍧愭爣绯2,鍩哄噯杞2,LF_JOINT,continuous,0.045,0.0325,0,1.5708,0,0,base_link,0,0,1,1,1,,,,,,,,,, +LB_LINK,0.01,-1.90361538571609E-18,6.93889390390723E-18,0,0,0,0.0108630528372501,1.06775440310417E-07,1.10469815160512E-22,3.53711447230329E-24,7.38080724035424E-07,5.37667398159464E-25,7.99593444190632E-07,0,0,0,0,0,0,package://gazebo_demo2/meshes/LB_LINK.STL,0.529411764705882,0.549019607843137,0.549019607843137,1,0,0,0,0,0,0,package://gazebo_demo2/meshes/LB_LINK.STL,,tui-2,鍧愭爣绯3,鍩哄噯杞3,LB_JOINT,continuous,-0.045,0.0325,0,1.5708,0,0,base_link,0,0,1,1,1,,,,,,,,,, +RF_LINK,0.01,-1.85843759880028E-18,0,0,0,0,0.0108630528372501,1.06775440310417E-07,1.5173510835766E-22,-9.00355753711158E-24,7.38080724035423E-07,-3.49483808803654E-24,7.99593444190632E-07,0,0,0,0,0,0,package://gazebo_demo2/meshes/RF_LINK.STL,0.529411764705882,0.549019607843137,0.549019607843137,1,0,0,0,0,0,0,package://gazebo_demo2/meshes/RF_LINK.STL,,tui-4,鍧愭爣绯4,鍩哄噯杞4,RF_JOINT,continuous,0.045,-0.0325,0,1.5708,0,0,base_link,0,0,1,1,1,,,,,,,,,, +RB_LINK,0.01,-1.6227366665734E-18,0,0,0,0,0.0108630528372501,1.06775440310417E-07,1.36659023251123E-22,1.17764472964423E-23,7.38080724035423E-07,-1.6130021944784E-24,7.99593444190632E-07,0,0,0,0,0,0,package://gazebo_demo2/meshes/RB_LINK.STL,0.529411764705882,0.549019607843137,0.549019607843137,1,0,0,0,0,0,0,package://gazebo_demo2/meshes/RB_LINK.STL,,tui-3,鍧愭爣绯5,鍩哄噯杞5,RB_JOINT,continuous,-0.045,-0.0325,0,1.5708,0,0,base_link,0,0,1,1,1,,,,,,,,,,