diff --git a/.clang-format b/.clang-format new file mode 100644 index 00000000..8d8dc719 --- /dev/null +++ b/.clang-format @@ -0,0 +1,9 @@ +BasedOnStyle: LLVM +IndentWidth: 4 +AccessModifierOffset: -4 +CommentPragmas: 'NOLINT' +PackConstructorInitializers: CurrentLine +AlignOperands: AlignAfterOperator +AlignTrailingComments: true +ColumnLimit: 0 +SeparateDefinitionBlocks: Always \ No newline at end of file diff --git a/.clang-tidy b/.clang-tidy new file mode 100644 index 00000000..e9f4e763 --- /dev/null +++ b/.clang-tidy @@ -0,0 +1,10 @@ +Checks: "bugprone-*,performance-*,readability-*,modernize-*,hicpp-*,cppcoreguidelines-*,clang-analyzer-*,-readability-braces-around-statements,-hicpp-braces-around-statements,-cppcoreguidelines-non-private-member-variables-in-classes" +WarningsAsErrors: '' +HeaderFilterRegex: '' +CheckOptions: + - key: readability-magic-numbers.IgnoredIntegerValues + value: '1;' + - key: hicpp-signed-bitwise.IgnorePositiveIntegerLiterals + value: 'true' + - key: readability-function-cognitive-complexity.IgnoreMacros + value: 'true' \ No newline at end of file diff --git a/.clangd b/.clangd new file mode 100644 index 00000000..538f880e --- /dev/null +++ b/.clangd @@ -0,0 +1,2 @@ +Diagnostics: + UnusedIncludes: Strict \ No newline at end of file diff --git a/.vscode/settings.json b/.vscode/settings.json index f7c28a84..772e1688 100644 --- a/.vscode/settings.json +++ b/.vscode/settings.json @@ -88,5 +88,6 @@ "python.analysis.extraPaths": [ "/home/nomorenickels/Documents/WRover_Software/devel/lib/python3/dist-packages", "/opt/ros/noetic/lib/python3/dist-packages" - ] + ], + "cmake.sourceDirectory": "${workspaceFolder}/src" } \ No newline at end of file diff --git a/src/arm_assembly/CMakeLists.txt b/src/arm_assembly/CMakeLists.txt deleted file mode 100644 index 22bc5ed7..00000000 --- a/src/arm_assembly/CMakeLists.txt +++ /dev/null @@ -1,14 +0,0 @@ -cmake_minimum_required(VERSION 2.8.3) - -project(arm_assembly) - -find_package(catkin REQUIRED) - -catkin_package() - -find_package(roslaunch) - -foreach(dir config launch meshes urdf) - install(DIRECTORY ${dir}/ - DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}/${dir}) -endforeach(dir) diff --git a/src/arm_assembly/config/joint_names_arm_assembly.yaml b/src/arm_assembly/config/joint_names_arm_assembly.yaml deleted file mode 100644 index 159fc6fe..00000000 --- a/src/arm_assembly/config/joint_names_arm_assembly.yaml +++ /dev/null @@ -1 +0,0 @@ -controller_joint_names: ['', 'turntable', 'shoulder', 'elbow', 'forearm_roll', 'wrist_pitch', 'wrist_roll', ] diff --git a/src/arm_assembly/export.log b/src/arm_assembly/export.log deleted file mode 100644 index 0f28f844..00000000 --- a/src/arm_assembly/export.log +++ /dev/null @@ -1,566 +0,0 @@ -2022-01-28 23:47:18,488 INFO Logger.cs: 70 - --------------------------------------------------------------------------------- -2022-01-28 23:47:18,508 INFO Logger.cs: 71 - Logging commencing for SW2URDF exporter -2022-01-28 23:47:18,508 INFO Logger.cs: 73 - Commit version 1.6.0-4-g7f85cfe -2022-01-28 23:47:18,509 INFO Logger.cs: 74 - Build version 1.6.7995.38578 -2022-01-28 23:47:18,510 INFO SwAddin.cs: 192 - Attempting to connect to SW -2022-01-28 23:47:18,511 INFO SwAddin.cs: 197 - Setting up callbacks -2022-01-28 23:47:18,511 INFO SwAddin.cs: 201 - Setting up command manager -2022-01-28 23:47:18,512 INFO SwAddin.cs: 204 - Adding command manager -2022-01-28 23:47:18,517 INFO SwAddin.cs: 263 - Adding Assembly export to file menu -2022-01-28 23:47:18,517 INFO SwAddin.cs: 272 - Adding Part export to file menu -2022-01-28 23:47:18,518 INFO SwAddin.cs: 210 - Adding event handlers -2022-01-28 23:47:18,520 INFO SwAddin.cs: 217 - Connecting plugin to SolidWorks -2022-01-29 04:01:04,989 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM -2022-01-29 04:01:07,687 INFO SwAddin.cs: 313 - Saving assembly -2022-01-29 04:01:07,864 INFO SwAddin.cs: 316 - Opening property manager -2022-01-29 04:01:07,891 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:01:07,894 INFO ExportHelperExtension.cs: 1136 - Found 44 in ArmAssembly.SLDASM -2022-01-29 04:01:07,894 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:01:07,895 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:07,895 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:07,930 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:01:07,930 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:07,931 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:01:07,931 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:01:07,931 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:07,932 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:01:07,932 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:01:07,932 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:07,933 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:01:07,933 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:01:07,934 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:07,934 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:01:07,934 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:07,936 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:01:07,936 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:01:07,936 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:07,937 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:01:07,937 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1136 - Found 44 in ArmAssembly.SLDASM -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:07,939 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:01:07,939 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:07,939 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:01:07,940 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:01:07,940 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:07,940 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:01:07,942 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:07,942 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:01:07,942 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:01:07,943 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:07,943 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:01:07,943 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:01:07,944 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:07,944 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:01:07,944 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:01:07,945 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:07,945 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:01:08,306 INFO SwAddin.cs: 339 - Loading config tree -2022-01-29 04:01:08,309 INFO ExportPropertyManagerExtension.cs: 520 - Starting new configuration -2022-01-29 04:01:08,315 INFO SwAddin.cs: 344 - Showing property manager -2022-01-29 04:01:36,796 INFO ExportPropertyManager.cs: 422 - Configuration saved -2022-01-29 04:01:38,889 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:01:38,895 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:38,895 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:01:38,895 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:38,896 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:38,896 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:01:38,896 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:38,897 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:01:38,897 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:01:38,897 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:38,898 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:01:38,898 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:01:38,899 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:38,899 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:01:38,899 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:01:38,900 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:38,900 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:01:38,900 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:01:38,901 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:38,901 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:01:38,902 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:01:38,902 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:38,902 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:01:38,903 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:01:38,903 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:38,903 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:01:38,904 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:01:38,904 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:38,904 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:01:38,905 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:38,905 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:38,905 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:01:38,906 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:38,906 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:01:38,906 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:38,908 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:01:38,908 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:01:38,908 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:38,909 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:01:38,909 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:01:38,909 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:38,910 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:01:38,910 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:01:38,910 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:38,911 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:01:38,911 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:01:38,911 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:38,912 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:01:38,958 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:01:48,808 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM -2022-01-29 04:01:48,808 INFO SwAddin.cs: 299 - Save is required -2022-01-29 04:01:48,809 INFO SwAddin.cs: 313 - Saving assembly -2022-01-29 04:01:49,233 INFO SwAddin.cs: 316 - Opening property manager -2022-01-29 04:01:49,234 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:01:49,235 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:49,235 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:01:49,235 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:49,236 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:49,236 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:01:49,236 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:49,237 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:01:49,237 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:01:49,237 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:49,238 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:01:49,238 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:01:49,238 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:49,239 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:01:49,239 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:01:49,240 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:49,240 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:01:49,240 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:01:49,241 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:49,241 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:01:49,241 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:01:49,242 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:49,248 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:01:49,248 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:01:49,279 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:49,279 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:49,281 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:49,281 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:01:49,282 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:49,282 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:01:49,282 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:01:49,283 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:49,283 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:01:49,283 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:01:49,284 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:49,284 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:01:49,285 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:01:49,285 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:49,285 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:01:49,286 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:01:49,286 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:01:49,288 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:01:49,288 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:49,288 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:01:49,398 INFO SwAddin.cs: 339 - Loading config tree -2022-01-29 04:01:49,400 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:01:49,445 INFO LinkNode.cs: 35 - Building node base_link -2022-01-29 04:01:49,446 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM -2022-01-29 04:01:49,447 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly -2022-01-29 04:01:49,448 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\Tests\URDF_Assembly\base.SLDPRT -2022-01-29 04:01:49,449 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link -2022-01-29 04:01:49,471 INFO SwAddin.cs: 344 - Showing property manager -2022-01-29 04:02:15,278 INFO ExportPropertyManager.cs: 422 - Configuration saved -2022-01-29 04:02:15,279 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:02:15,425 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:02:15,426 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:02:15,426 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:02:15,427 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:02:15,427 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:02:15,427 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:02:15,428 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:02:15,428 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:02:15,428 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:02:15,429 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:02:15,429 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:02:15,429 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:02:15,431 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:02:15,431 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:02:15,431 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:02:15,432 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:02:15,432 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:02:15,432 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:02:15,433 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:02:15,433 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:02:15,433 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:02:15,434 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:02:15,434 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:02:15,434 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:02:15,435 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:02:15,435 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:02:15,435 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:02:15,436 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:02:15,436 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:02:15,436 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:02:15,437 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:02:15,437 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:02:15,437 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:02:15,438 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:02:15,438 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:02:15,438 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:02:15,439 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:02:15,439 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:02:15,439 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:02:15,440 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:02:15,440 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:02:15,442 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:02:15,442 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:02:15,443 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:02:15,488 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:03:44,437 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:03:50,608 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM -2022-01-29 04:03:50,608 INFO SwAddin.cs: 299 - Save is required -2022-01-29 04:03:50,608 INFO SwAddin.cs: 313 - Saving assembly -2022-01-29 04:03:50,733 INFO SwAddin.cs: 316 - Opening property manager -2022-01-29 04:03:50,733 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:03:50,734 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:03:50,734 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:03:50,734 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:03:50,735 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:03:50,735 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:03:50,736 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:03:50,736 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:03:50,736 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:03:50,737 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:03:50,737 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:03:50,738 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:03:50,738 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:03:50,739 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:03:50,739 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:03:50,740 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:03:50,740 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:03:50,740 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:03:50,741 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:03:50,741 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:03:50,741 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:03:50,742 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:03:50,743 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:03:50,743 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:03:50,743 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:03:50,744 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:03:50,744 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:03:50,745 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:03:50,745 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:03:50,745 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:03:50,746 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:03:50,746 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:03:50,746 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:03:50,747 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:03:50,747 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:03:50,747 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:03:50,748 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:03:50,748 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:03:50,748 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:03:50,749 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:03:50,749 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:03:50,749 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:03:50,750 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:03:50,750 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:03:50,750 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:03:50,751 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:03:50,751 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:03:50,752 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:03:50,752 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:03:50,752 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:03:50,753 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:03:50,753 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:03:50,802 INFO SwAddin.cs: 339 - Loading config tree -2022-01-29 04:03:50,803 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:03:50,803 INFO LinkNode.cs: 35 - Building node base_link -2022-01-29 04:03:50,804 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM -2022-01-29 04:03:50,804 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly -2022-01-29 04:03:50,804 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\Tests\URDF_Assembly\base.SLDPRT -2022-01-29 04:03:50,805 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link -2022-01-29 04:03:50,813 INFO SwAddin.cs: 344 - Showing property manager -2022-01-29 04:03:55,199 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:04:02,915 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:04:06,718 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:04:08,432 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:07:25,776 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:07:36,624 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:08:34,715 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:09:06,042 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:09:28,401 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:09:33,716 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:10:26,057 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:10:32,832 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:01,760 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:10,262 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:32,320 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:50,721 INFO ExportPropertyManager.cs: 422 - Configuration saved -2022-01-29 04:11:50,723 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:11:50,809 INFO ExportHelperExtension.cs: 347 - Creating joint shoulderBase_link -2022-01-29 04:11:50,815 INFO ExportHelperExtension.cs: 1397 - Fixing components for base_link -2022-01-29 04:11:50,816 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:50,816 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:51,179 INFO : 0 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:51,183 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:51,183 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:51,184 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:53,156 WARN ExportHelperExtension.cs: 351 - Creating joint from parent base_link to child shoulderBase_link failed -2022-01-29 04:11:53,162 INFO ExportHelperExtension.cs: 347 - Creating joint upperArm_link -2022-01-29 04:11:53,163 INFO ExportHelperExtension.cs: 1397 - Fixing components for shoulderBase_link -2022-01-29 04:11:53,163 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:53,163 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:53,164 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:53,382 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:53,383 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:53,383 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:53,383 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:53,384 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:11:55,357 WARN ExportHelperExtension.cs: 351 - Creating joint from parent shoulderBase_link to child upperArm_link failed -2022-01-29 04:11:55,362 INFO ExportHelperExtension.cs: 347 - Creating joint forarm_link -2022-01-29 04:11:55,362 INFO ExportHelperExtension.cs: 1397 - Fixing components for upperArm_link -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:55,607 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:55,607 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:55,607 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:55,608 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:55,608 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:11:55,608 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:11:57,637 WARN ExportHelperExtension.cs: 351 - Creating joint from parent upperArm_link to child forarm_link failed -2022-01-29 04:11:57,644 INFO ExportHelperExtension.cs: 347 - Creating joint wirstBase_link -2022-01-29 04:11:57,644 INFO ExportHelperExtension.cs: 1397 - Fixing components for forarm_link -2022-01-29 04:11:57,645 INFO ExportHelperExtension.cs: 1402 - Fixing 35 -2022-01-29 04:11:57,645 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:11:57,645 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:57,646 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:57,646 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:57,884 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:57,885 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:57,885 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:57,886 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:57,886 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 -2022-01-29 04:11:57,886 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:11:57,887 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:11:59,971 WARN ExportHelperExtension.cs: 351 - Creating joint from parent forarm_link to child wirstBase_link failed -2022-01-29 04:11:59,975 INFO ExportHelperExtension.cs: 347 - Creating joint wrist_link -2022-01-29 04:11:59,975 INFO ExportHelperExtension.cs: 1397 - Fixing components for wirstBase_link -2022-01-29 04:11:59,976 INFO ExportHelperExtension.cs: 1402 - Fixing 40 -2022-01-29 04:11:59,976 INFO ExportHelperExtension.cs: 1402 - Fixing 35 -2022-01-29 04:11:59,976 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:11:59,977 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:59,977 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:59,977 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:12:00,240 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:12:00,241 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:12:00,241 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:12:00,241 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:12:00,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 40 -2022-01-29 04:12:00,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 -2022-01-29 04:12:00,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:12:00,243 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:12:02,368 WARN ExportHelperExtension.cs: 351 - Creating joint from parent wirstBase_link to child wrist_link failed -2022-01-29 04:12:02,372 INFO ExportHelperExtension.cs: 347 - Creating joint manipulator_link -2022-01-29 04:12:02,373 INFO ExportHelperExtension.cs: 1397 - Fixing components for wrist_link -2022-01-29 04:12:02,373 INFO ExportHelperExtension.cs: 1402 - Fixing 39 -2022-01-29 04:12:02,373 INFO ExportHelperExtension.cs: 1402 - Fixing 40 -2022-01-29 04:12:02,374 INFO ExportHelperExtension.cs: 1402 - Fixing 35 -2022-01-29 04:12:02,374 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:12:02,374 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:12:02,375 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:12:02,375 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:12:02,655 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:12:02,655 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:12:02,656 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:12:02,656 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:12:02,698 INFO ExportHelperExtension.cs: 1352 - Unfixing component 39 -2022-01-29 04:12:02,699 INFO ExportHelperExtension.cs: 1352 - Unfixing component 40 -2022-01-29 04:12:02,699 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 -2022-01-29 04:12:02,699 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:12:02,700 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:12:04,927 WARN ExportHelperExtension.cs: 351 - Creating joint from parent wrist_link to child manipulator_link failed -2022-01-29 04:12:05,029 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:12:05,030 INFO ExportHelperExtension.cs: 1136 - Found 59 in ArmAssembly.SLDASM -2022-01-29 04:12:05,031 INFO ExportHelperExtension.cs: 1145 - Found 7 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:12:05,031 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:12:05,031 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:12:05,032 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:12:05,032 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:12:05,032 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:12:05,033 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:12:05,033 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:12:05,033 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:12:05,034 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:12:05,034 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:12:05,035 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:12:05,035 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:12:05,035 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:12:05,036 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:12:05,036 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:12:05,036 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:12:05,037 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:12:05,037 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:12:05,037 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:12:05,038 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:12:05,038 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:12:05,038 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:12:05,039 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:12:05,039 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:12:05,039 INFO ExportHelperExtension.cs: 1136 - Found 59 in ArmAssembly.SLDASM -2022-01-29 04:12:05,040 INFO ExportHelperExtension.cs: 1145 - Found 6 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:12:05,040 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:12:05,040 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:12:05,041 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:12:05,041 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:12:05,041 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:12:05,042 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:12:05,042 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:12:05,042 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:12:05,044 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:12:05,044 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:12:05,044 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:12:05,045 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:12:05,045 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:12:05,045 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:12:05,046 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:12:05,046 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:12:05,046 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:12:05,047 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:12:05,047 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:12:05,103 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:13:17,527 INFO AssemblyExportForm.cs: 253 - Completing URDF export -2022-01-29 04:13:17,529 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruenametrueshoulderBase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueturntabletypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically GeneratelinktruenametrueupperArm_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueshouldertypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueforarm_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueelbowtypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically GeneratelinktruenametruewirstBase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueforearm_rolltypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametruewrist_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_pitchtypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametruemanipulator_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_rolltypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalsefalsesDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==falsefalsefalsesDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==falsefalsefalsesDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAfalsefalsefalsesDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==falsefalsefalsesDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==falsefalsefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:13:41,728 INFO AssemblyExportForm.cs: 309 - Saving URDF package to E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM -2022-01-29 04:13:41,730 INFO ExportHelper.cs: 147 - Beginning the export process -2022-01-29 04:13:41,731 INFO ExportHelper.cs: 153 - Creating package directories with name ArmAssembly.SLDASM and save path E:\Robotics\WR\Tests\URDF_Assembly -2022-01-29 04:13:46,142 ERROR AssemblyExportForm.cs: 126 - Exception encountered in Assembly export form -System.IO.IOException: Cannot create "E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM" because a file or directory with the same name already exists. - at System.IO.__Error.WinIOError(Int32 errorCode, String maybeFullPath) - at System.IO.Directory.InternalCreateDirectory(String fullPath, String path, Object dirSecurityObj, Boolean checkHost) - at System.IO.Directory.InternalCreateDirectoryHelper(String path, Boolean checkHost) - at SW2URDF.URDFExport.URDFPackage.CreateDirectories() in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\URDFExport\URDFPackage.cs:line 78 - at SW2URDF.URDFExport.ExportHelper.ExportRobot(Boolean exportSTL) in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\URDFExport\ExportHelper.cs:line 155 - at SW2URDF.UI.AssemblyExportForm.FinishExport(Boolean exportSTL) in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\UI\AssemblyExportForm.cs:line 310 - at SW2URDF.UI.AssemblyExportForm.ButtonLinksFinishClick(Object sender, EventArgs e) in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\UI\AssemblyExportForm.cs:line 243 - at System.Windows.Forms.Control.OnClick(EventArgs e) - at System.Windows.Forms.Button.OnClick(EventArgs e) - at System.Windows.Forms.Button.OnMouseUp(MouseEventArgs mevent) - at System.Windows.Forms.Control.WmMouseUp(Message& m, MouseButtons button, Int32 clicks) - at System.Windows.Forms.Control.WndProc(Message& m) - at System.Windows.Forms.ButtonBase.WndProc(Message& m) - at System.Windows.Forms.Button.WndProc(Message& m) - at System.Windows.Forms.NativeWindow.Callback(IntPtr hWnd, Int32 msg, IntPtr wparam, IntPtr lparam) -2022-01-29 04:13:53,196 INFO AssemblyExportForm.cs: 253 - Completing URDF export -2022-01-29 04:13:53,197 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue1.035828411313638E-180.0156064900891439571.9357498027169635E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504418ixytrue8.6586155170563642E-21ixztrue-7.3748524136608228E-20iyytrue0.0044229329573873041iyztrue2.2771129801693437E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametrueshoulderBase_linkxyztrue-0.0122586821821900790.1285772495779757-0.0037054435004292684rpytrue000originfalsefalsevaluetrue0.99636680500272734massfalseixxtrue0.0065237009420894719ixytrue0.0010646616036528998ixztrue0.00028312700527736404iyytrue0.0050231810993567032iyztrue6.82113719161566E-05izztrue0.0086334538259584inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueturntabletypetruecontinuousxyztrue000.035865rpytrue1.57080-0.25129originfalsefalselinktruebase_linkparenttruelinktrueshoulderBase_linkchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_turntableOrigin_turntablelinktruenametrueupperArm_linkxyztrue0.014397399905456463-3.2006162568792851E-050.27934838479492807rpytrue000originfalsefalsevaluetrue0.98521034391581119massfalseixxtrue0.023798222473833903ixytrue-8.87977733299251E-07ixztrue-0.0038853285623011904iyytrue0.029359472259760169iyztrue-7.1294436997127461E-06izztrue0.0062503483932010362inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueshouldertypetruecontinuousxyztrue00.180980.043071rpytrue-1.102100originfalsefalselinktrueshoulderBase_linkparenttruelinktrueupperArm_linkchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_shoulderOrigin_shoulderlinktruenametrueforarm_linkxyztrue1.8457457784393227E-150.0550154986611603450.12015280303424725rpytrue000originfalsefalsevaluetrue0.51779610173045887massfalseixxtrue0.00404850874710771ixytrue2.1141942363467336E-18ixztrue-1.5487150407597627E-17iyytrue0.003755483293922739iyztrue-0.00037738536370652919izztrue0.00078832783822656164inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueelbowtypetruecontinuousxyztrue000.46634rpytrue2.493600originfalsefalselinktrueupperArm_linkparenttruelinktrueforarm_linkchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_elbowOrigin_elbowlinktruenametruewirstBase_linkxyztrue-1.9428902930940239E-16-1.6653345369377348E-150.09870348455642336rpytrue000originfalsefalsevaluetrue0.30176308217533721massfalseixxtrue0.0021034428970283731ixytrue-2.7105054312137611E-19ixztrue-2.2497195079074217E-18iyytrue0.003050162507065583iyztrue1.8566962203814263E-18izztrue0.0010760910650178595inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueforearm_rolltypetruecontinuousxyztrue00.044450.2285rpytrue000originfalsefalselinktrueforarm_linkparenttruelinktruewirstBase_linkchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_forearm_rollOrigin_forearm_rolllinktruenametruewrist_linkxyztrue4.3021142204224816E-16-2.7755575615628914E-170rpytrue000originfalsefalsevaluetrue0.44770711794317625massfalseixxtrue0.00036770226690479489ixytrue1.7999450129153882E-19ixztrue-7.453889935837843E-19iyytrue0.00084342708626575322iyztrue-1.3552527156068805E-20izztrue0.00084474612356065992inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_pitchtypetruecontinuousxyztrue000.23716rpytrue-1.33300originfalsefalselinktruewirstBase_linkparenttruelinktruewrist_linkchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_wrist_pitchOrigin_wrist_pitchlinktruenametruemanipulator_linkxyztrue-0.00073032374046050341-0.000899365669252000230.049056009995342265rpytrue000originfalsefalsevaluetrue0.39742022555481077massfalseixxtrue0.0015968430526387824ixytrue-3.0724322789165625E-06ixztrue2.5323557993615128E-05iyytrue0.0016343224414687998iyztrue5.0029229087463509E-05izztrue0.00025632256399428705inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_rolltypetruecontinuousxyztrue000rpytrue000.096862originfalsefalselinktruewrist_linkparenttruelinktruemanipulator_linkchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_wrist_rollOrigin_wrist_rolllinktruefalsesDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalsefalsesDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==falsefalsefalsesDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==falsefalsefalsesDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAfalsefalsefalsesDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==falsefalsefalsesDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==falsefalsefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:14:02,877 INFO AssemblyExportForm.cs: 309 - Saving URDF package to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM -2022-01-29 04:14:02,877 INFO ExportHelper.cs: 147 - Beginning the export process -2022-01-29 04:14:02,877 INFO ExportHelper.cs: 153 - Creating package directories with name ArmAssembly.SLDASM and save path E:\Robotics\WR\Tests\URDF_Assembly\URDF -2022-01-29 04:14:04,383 INFO ExportHelper.cs: 162 - Creating CMakeLists.txt at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\CMakeLists.txt -2022-01-29 04:14:04,384 INFO ExportHelper.cs: 166 - Creating joint names config at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\config\joint_names_ArmAssembly.SLDASM.yaml -2022-01-29 04:14:04,385 INFO ExportHelper.cs: 170 - Creating package.xml at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\package.xml -2022-01-29 04:14:04,385 INFO PackageXMLWriter.cs: 21 - Creating package.xml at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\package.xml -2022-01-29 04:14:04,389 INFO ExportHelper.cs: 177 - Creating RVIZ launch file in E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\launch\ -2022-01-29 04:14:04,391 INFO ExportHelper.cs: 182 - Creating Gazebo launch file in E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\launch\ -2022-01-29 04:14:04,392 INFO ExportHelper.cs: 187 - Saving existing STL preferences -2022-01-29 04:14:04,392 INFO ExportHelper.cs: 450 - Saving users preferences -2022-01-29 04:14:04,393 INFO ExportHelper.cs: 190 - Modifying STL preferences -2022-01-29 04:14:04,394 INFO ExportHelper.cs: 464 - Setting STL preferences -2022-01-29 04:14:04,397 INFO ExportHelper.cs: 196 - Found 0 hidden components -2022-01-29 04:14:04,398 INFO ExportHelper.cs: 197 - Hiding all components -2022-01-29 04:14:04,618 INFO ExportHelper.cs: 204 - Beginning individual files export -2022-01-29 04:14:04,622 INFO ExportHelper.cs: 270 - Exporting link: base_link -2022-01-29 04:14:04,623 INFO ExportHelper.cs: 272 - Link base_link has 1 children -2022-01-29 04:14:04,624 INFO ExportHelper.cs: 270 - Exporting link: shoulderBase_link -2022-01-29 04:14:04,624 INFO ExportHelper.cs: 272 - Link shoulderBase_link has 1 children -2022-01-29 04:14:04,625 INFO ExportHelper.cs: 270 - Exporting link: upperArm_link -2022-01-29 04:14:04,625 INFO ExportHelper.cs: 272 - Link upperArm_link has 1 children -2022-01-29 04:14:04,625 INFO ExportHelper.cs: 270 - Exporting link: forarm_link -2022-01-29 04:14:04,626 INFO ExportHelper.cs: 272 - Link forarm_link has 1 children -2022-01-29 04:14:04,626 INFO ExportHelper.cs: 270 - Exporting link: wirstBase_link -2022-01-29 04:14:04,627 INFO ExportHelper.cs: 272 - Link wirstBase_link has 1 children -2022-01-29 04:14:04,628 INFO ExportHelper.cs: 270 - Exporting link: wrist_link -2022-01-29 04:14:04,628 INFO ExportHelper.cs: 272 - Link wrist_link has 1 children -2022-01-29 04:14:04,629 INFO ExportHelper.cs: 270 - Exporting link: manipulator_link -2022-01-29 04:14:04,629 INFO ExportHelper.cs: 272 - Link manipulator_link has 0 children -2022-01-29 04:14:04,630 INFO ExportHelper.cs: 317 - manipulator_link: Exporting STL with coordinate frame Origin_wrist_roll -2022-01-29 04:14:04,631 INFO ExportHelper.cs: 322 - manipulator_link: Reference geometry name -2022-01-29 04:14:04,669 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\manipulator_link.STL -2022-01-29 04:14:04,785 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,785 INFO ExportHelper.cs: 317 - wrist_link: Exporting STL with coordinate frame Origin_wrist_pitch -2022-01-29 04:14:04,786 INFO ExportHelper.cs: 322 - wrist_link: Reference geometry name -2022-01-29 04:14:04,797 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\wrist_link.STL -2022-01-29 04:14:04,834 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,835 INFO ExportHelper.cs: 317 - wirstBase_link: Exporting STL with coordinate frame Origin_forearm_roll -2022-01-29 04:14:04,835 INFO ExportHelper.cs: 322 - wirstBase_link: Reference geometry name -2022-01-29 04:14:04,846 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\wirstBase_link.STL -2022-01-29 04:14:04,873 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,874 INFO ExportHelper.cs: 317 - forarm_link: Exporting STL with coordinate frame Origin_elbow -2022-01-29 04:14:04,874 INFO ExportHelper.cs: 322 - forarm_link: Reference geometry name -2022-01-29 04:14:04,932 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\forarm_link.STL -2022-01-29 04:14:04,986 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,987 INFO ExportHelper.cs: 317 - upperArm_link: Exporting STL with coordinate frame Origin_shoulder -2022-01-29 04:14:04,987 INFO ExportHelper.cs: 322 - upperArm_link: Reference geometry name -2022-01-29 04:14:05,001 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\upperArm_link.STL -2022-01-29 04:14:05,035 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:05,035 INFO ExportHelper.cs: 317 - shoulderBase_link: Exporting STL with coordinate frame Origin_turntable -2022-01-29 04:14:05,036 INFO ExportHelper.cs: 322 - shoulderBase_link: Reference geometry name -2022-01-29 04:14:05,111 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\shoulderBase_link.STL -2022-01-29 04:14:05,189 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:05,190 INFO ExportHelper.cs: 317 - base_link: Exporting STL with coordinate frame Origin_global -2022-01-29 04:14:05,191 INFO ExportHelper.cs: 322 - base_link: Reference geometry name -2022-01-29 04:14:05,235 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\base_link.STL -2022-01-29 04:14:05,274 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:05,275 INFO ExportHelper.cs: 145 - Showing all components except previously hidden components -2022-01-29 04:14:05,465 INFO ExportHelper.cs: 145 - Resetting STL preferences -2022-01-29 04:14:05,466 INFO ExportHelper.cs: 478 - Returning STL preferences to user preferences -2022-01-29 04:14:05,466 INFO ExportHelper.cs: 228 - Writing URDF file to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\urdf\ArmAssembly.SLDASM.urdf -2022-01-29 04:14:05,470 INFO CSVImportExport.cs: 32 - Writing CSV file E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\urdf\ArmAssembly.SLDASM.csv -2022-01-29 04:14:05,493 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,494 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,495 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,495 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,495 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,496 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,496 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,497 INFO ExportHelper.cs: 234 - Copying log file -2022-01-29 04:14:05,497 INFO ExportHelper.cs: 439 - Copying C:\Users\Payton Jackson\sw2urdf_logs\sw2urdf.log to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\export.log diff --git a/src/arm_assembly/launch/display.launch b/src/arm_assembly/launch/display.launch deleted file mode 100644 index 96a2d12e..00000000 --- a/src/arm_assembly/launch/display.launch +++ /dev/null @@ -1,20 +0,0 @@ - - - - - - - \ No newline at end of file diff --git a/src/arm_assembly/launch/gazebo.launch b/src/arm_assembly/launch/gazebo.launch deleted file mode 100644 index 57481cd1..00000000 --- a/src/arm_assembly/launch/gazebo.launch +++ /dev/null @@ -1,20 +0,0 @@ - - - - - - \ No newline at end of file diff --git a/src/arm_assembly/meshes/forarm_link.STL b/src/arm_assembly/meshes/forarm_link.STL deleted file mode 100644 index fb511b34..00000000 Binary files a/src/arm_assembly/meshes/forarm_link.STL and /dev/null differ diff --git a/src/arm_assembly/meshes/manipulator_link.STL b/src/arm_assembly/meshes/manipulator_link.STL deleted file mode 100644 index 6bbdfa56..00000000 Binary files a/src/arm_assembly/meshes/manipulator_link.STL and /dev/null differ diff --git a/src/arm_assembly/meshes/shoulderBase_link.STL b/src/arm_assembly/meshes/shoulderBase_link.STL deleted file mode 100644 index bad98d04..00000000 Binary files a/src/arm_assembly/meshes/shoulderBase_link.STL and /dev/null differ diff --git a/src/arm_assembly/meshes/upperArm_link.STL b/src/arm_assembly/meshes/upperArm_link.STL deleted file mode 100644 index d111945c..00000000 Binary files a/src/arm_assembly/meshes/upperArm_link.STL and /dev/null differ diff --git a/src/arm_assembly/meshes/wirstBase_link.STL b/src/arm_assembly/meshes/wirstBase_link.STL deleted file mode 100644 index 0e2de135..00000000 Binary files a/src/arm_assembly/meshes/wirstBase_link.STL and /dev/null differ diff --git a/src/arm_assembly/meshes/wrist_link.STL b/src/arm_assembly/meshes/wrist_link.STL deleted file mode 100644 index 0e6b6ab5..00000000 Binary files a/src/arm_assembly/meshes/wrist_link.STL and /dev/null differ diff --git a/src/arm_assembly/package.xml b/src/arm_assembly/package.xml deleted file mode 100644 index b357a057..00000000 --- a/src/arm_assembly/package.xml +++ /dev/null @@ -1,21 +0,0 @@ - - arm_assembly - 1.0.0 - -

URDF Description package for arm_assembly

-

This package contains configuration data, 3D models and launch files -for arm_assembly robot

- - TODO - - BSD - catkin - roslaunch - robot_state_publisher - rviz - joint_state_publisher_gui - gazebo - - - - \ No newline at end of file diff --git a/src/arm_assembly/urdf/arm_assembly.csv b/src/arm_assembly/urdf/arm_assembly.csv deleted file mode 100644 index 06858e24..00000000 --- a/src/arm_assembly/urdf/arm_assembly.csv +++ /dev/null @@ -1,8 +0,0 @@ -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,1.03582841131364E-18,0.015606490089144,1.93574980271696E-18,0,0,0,0.93972387307473,0.00251429022255044,8.65861551705636E-21,-7.37485241366082E-20,0.0044229329573873,2.27711298016934E-20,0.0021336882069818,0,0,0,0,0,0,package://arm_assembly/meshes/base_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/base_link.stl,,base-1,Origin_global,,,,0,0,0,0,0,0,,0,0,0,,,,,,,,,,,, -shoulderBase_link,-0.0122586821821901,0.128577249577976,-0.00370544350042927,0,0,0,0.996366805002727,0.00652370094208947,0.0010646616036529,0.000283127005277364,0.0050231810993567,6.82113719161566E-05,0.0086334538259584,0,0,0,0,0,0,package://arm_assembly/meshes/shoulderBase_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/shoulderBase_link.stl,,Shoulder-1,Origin_turntable,Axis_turntable,turntable,continuous,0,0,0.035865,1.5708,0,-0.25129,base_link,0,1,0,,,,,,,,,,,, -upperArm_link,0.0143973999054565,-3.20061625687929E-05,0.279348384794928,0,0,0,0.985210343915811,0.0237982224738339,-8.87977733299251E-07,-0.00388532856230119,0.0293594722597602,-7.12944369971275E-06,0.00625034839320104,0,0,0,0,0,0,package://arm_assembly/meshes/upperArm_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/upperArm_link.stl,,UpperArm-1,Origin_shoulder,Axis_shoulder,shoulder,continuous,0,0.18098,0.043071,-1.1021,0,0,shoulderBase_link,1,0,0,,,,,,,,,,,, -forarm_link,1.84574577843932E-15,0.0550154986611603,0.120152803034247,0,0,0,0.517796101730459,0.00404850874710771,2.11419423634673E-18,-1.54871504075976E-17,0.00375548329392274,-0.000377385363706529,0.000788327838226562,0,0,0,0,0,0,package://arm_assembly/meshes/forarm_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/forarm_link.stl,,Forarm-1,Origin_elbow,Axis_elbow,elbow,continuous,0,0,0.46634,2.4936,0,0,upperArm_link,1,0,0,,,,,,,,,,,, -wirstBase_link,-1.94289029309402E-16,-1.66533453693773E-15,0.0987034845564234,0,0,0,0.301763082175337,0.00210344289702837,-2.71050543121376E-19,-2.24971950790742E-18,0.00305016250706558,1.85669622038143E-18,0.00107609106501786,0,0,0,0,0,0,package://arm_assembly/meshes/wirstBase_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/wirstBase_link.stl,,WristStructure-1,Origin_forearm_roll,Axis_forearm_roll,forearm_roll,continuous,0,0.04445,0.2285,0,0,0,forarm_link,0,0,1,,,,,,,,,,,, -wrist_link,4.30211422042248E-16,-2.77555756156289E-17,0,0,0,0,0.447707117943176,0.000367702266904795,1.79994501291539E-19,-7.45388993583784E-19,0.000843427086265753,-1.35525271560688E-20,0.00084474612356066,0,0,0,0,0,0,package://arm_assembly/meshes/wrist_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/wrist_link.stl,,Wrist-1,Origin_wrist_pitch,Axis_wrist_pitch,wrist_pitch,continuous,0,0,0.23716,-1.333,0,0,wirstBase_link,1,0,0,,,,,,,,,,,, -manipulator_link,-0.000730323740460503,-0.000899365669252,0.0490560099953423,0,0,0,0.397420225554811,0.00159684305263878,-3.07243227891656E-06,2.53235579936151E-05,0.0016343224414688,5.00292290874635E-05,0.000256322563994287,0,0,0,0,0,0,package://arm_assembly/meshes/manipulator_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://arm_assembly/meshes/manipulator_link.stl,,Manipulator-1,Origin_wrist_roll,Axis_wrist_roll,wrist_roll,continuous,0,0,0,0,0,0.096862,wrist_link,0,0,1,,,,,,,,,,,, diff --git a/src/arm_assembly/urdf/arm_assembly.urdf b/src/arm_assembly/urdf/arm_assembly.urdf deleted file mode 100644 index 7cce560c..00000000 --- a/src/arm_assembly/urdf/arm_assembly.urdf +++ /dev/null @@ -1,282 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - - / - - - \ No newline at end of file diff --git a/src/wr_control_drive_arm/CMakeLists.txt b/src/wr_control_drive_arm/CMakeLists.txt index c9d43c92..a122dafe 100644 --- a/src/wr_control_drive_arm/CMakeLists.txt +++ b/src/wr_control_drive_arm/CMakeLists.txt @@ -1,12 +1,12 @@ cmake_minimum_required(VERSION 3.8) project(wr_control_drive_arm) -## Compile as C++11, supported in ROS Kinetic and newer -# add_compile_options(-std=c++11) +# # Compile as C++11, supported in ROS Kinetic and newer +add_compile_options(-std=c++17) -## Find catkin macros and libraries -## if COMPONENTS list like find_package(catkin REQUIRED COMPONENTS xyz) -## is used, also find other catkin packages +# # Find catkin macros and libraries +# # if COMPONENTS list like find_package(catkin REQUIRED COMPONENTS xyz) +# # is used, also find other catkin packages find_package(catkin REQUIRED COMPONENTS roscpp rospy @@ -15,199 +15,213 @@ find_package(catkin REQUIRED COMPONENTS sensor_msgs ) -## System dependencies are found with CMake's conventions +# # System dependencies are found with CMake's conventions # find_package(Boost REQUIRED COMPONENTS system) - -## Uncomment this if the package has a setup.py. This macro ensures -## modules and global scripts declared therein get installed -## See http://ros.org/doc/api/catkin/html/user_guide/setup_dot_py.html +# # Uncomment this if the package has a setup.py. This macro ensures +# # modules and global scripts declared therein get installed +# # See http://ros.org/doc/api/catkin/html/user_guide/setup_dot_py.html # catkin_python_setup() -################################################ -## Declare ROS messages, services and actions ## -################################################ - -## To declare and build messages, services or actions from within this -## package, follow these steps: -## * Let MSG_DEP_SET be the set of packages whose message types you use in -## your messages/services/actions (e.g. std_msgs, actionlib_msgs, ...). -## * In the file package.xml: -## * add a build_depend tag for "message_generation" -## * add a build_depend and a exec_depend tag for each package in MSG_DEP_SET -## * If MSG_DEP_SET isn't empty the following dependency has been pulled in -## but can be declared for certainty nonetheless: -## * add a exec_depend tag for "message_runtime" -## * In this file (CMakeLists.txt): -## * add "message_generation" and every package in MSG_DEP_SET to -## find_package(catkin REQUIRED COMPONENTS ...) -## * add "message_runtime" and every package in MSG_DEP_SET to -## catkin_package(CATKIN_DEPENDS ...) -## * uncomment the add_*_files sections below as needed -## and list every .msg/.srv/.action file to be processed -## * uncomment the generate_messages entry below -## * add every package in MSG_DEP_SET to generate_messages(DEPENDENCIES ...) - -## Generate messages in the 'msg' folder +# ############################################### +# # Declare ROS messages, services and actions ## +# ############################################### + +# # To declare and build messages, services or actions from within this +# # package, follow these steps: +# # * Let MSG_DEP_SET be the set of packages whose message types you use in +# # your messages/services/actions (e.g. std_msgs, actionlib_msgs, ...). +# # * In the file package.xml: +# # * add a build_depend tag for "message_generation" +# # * add a build_depend and a exec_depend tag for each package in MSG_DEP_SET +# # * If MSG_DEP_SET isn't empty the following dependency has been pulled in +# # but can be declared for certainty nonetheless: +# # * add a exec_depend tag for "message_runtime" +# # * In this file (CMakeLists.txt): +# # * add "message_generation" and every package in MSG_DEP_SET to +# # find_package(catkin REQUIRED COMPONENTS ...) +# # * add "message_runtime" and every package in MSG_DEP_SET to +# # catkin_package(CATKIN_DEPENDS ...) +# # * uncomment the add_*_files sections below as needed +# # and list every .msg/.srv/.action file to be processed +# # * uncomment the generate_messages entry below +# # * add every package in MSG_DEP_SET to generate_messages(DEPENDENCIES ...) + +# # Generate messages in the 'msg' folder # add_message_files( -# FILES -# Message1.msg -# Message2.msg +# FILES +# Message1.msg +# Message2.msg # ) -## Generate services in the 'srv' folder +# # Generate services in the 'srv' folder # add_service_files( -# FILES -# Service1.srv -# Service2.srv +# FILES +# Service1.srv +# Service2.srv # ) -## Generate actions in the 'action' folder +# # Generate actions in the 'action' folder # add_action_files( -# FILES -# Action1.action -# Action2.action +# FILES +# Action1.action +# Action2.action # ) -## Generate added messages and services with any dependencies listed here +# # Generate added messages and services with any dependencies listed here # generate_messages( -# DEPENDENCIES -# std_msgs # Or other packages containing msgs +# DEPENDENCIES +# std_msgs # Or other packages containing msgs # ) -################################################ -## Declare ROS dynamic reconfigure parameters ## -################################################ - -## To declare and build dynamic reconfigure parameters within this -## package, follow these steps: -## * In the file package.xml: -## * add a build_depend and a exec_depend tag for "dynamic_reconfigure" -## * In this file (CMakeLists.txt): -## * add "dynamic_reconfigure" to -## find_package(catkin REQUIRED COMPONENTS ...) -## * uncomment the "generate_dynamic_reconfigure_options" section below -## and list every .cfg file to be processed - -## Generate dynamic reconfigure parameters in the 'cfg' folder +# ############################################### +# # Declare ROS dynamic reconfigure parameters ## +# ############################################### + +# # To declare and build dynamic reconfigure parameters within this +# # package, follow these steps: +# # * In the file package.xml: +# # * add a build_depend and a exec_depend tag for "dynamic_reconfigure" +# # * In this file (CMakeLists.txt): +# # * add "dynamic_reconfigure" to +# # find_package(catkin REQUIRED COMPONENTS ...) +# # * uncomment the "generate_dynamic_reconfigure_options" section below +# # and list every .cfg file to be processed + +# # Generate dynamic reconfigure parameters in the 'cfg' folder # generate_dynamic_reconfigure_options( -# cfg/DynReconf1.cfg -# cfg/DynReconf2.cfg +# cfg/DynReconf1.cfg +# cfg/DynReconf2.cfg # ) -################################### -## catkin specific configuration ## -################################### -## The catkin_package macro generates cmake config files for your package -## Declare things to be passed to dependent projects -## INCLUDE_DIRS: uncomment this if your package contains header files -## LIBRARIES: libraries you create in this project that dependent projects also need -## CATKIN_DEPENDS: catkin_packages dependent projects also need -## DEPENDS: system dependencies of this project that dependent projects also need +# ################################## +# # catkin specific configuration ## +# ################################## +# # The catkin_package macro generates cmake config files for your package +# # Declare things to be passed to dependent projects +# # INCLUDE_DIRS: uncomment this if your package contains header files +# # LIBRARIES: libraries you create in this project that dependent projects also need +# # CATKIN_DEPENDS: catkin_packages dependent projects also need +# # DEPENDS: system dependencies of this project that dependent projects also need catkin_package( -# INCLUDE_DIRS include -# LIBRARIES wr_control_drive_science -# CATKIN_DEPENDS roscpp rospy -# DEPENDS system_lib + + # INCLUDE_DIRS include + # LIBRARIES wr_control_drive_science + # CATKIN_DEPENDS roscpp rospy + # DEPENDS system_lib ) -########### -## Build ## -########### +# ########## +# # Build ## +# ########## -## Specify additional locations of header files -## Your package locations should be listed before other locations +# # Specify additional locations of header files +# # Your package locations should be listed before other locations include_directories( -# include + + # include ${catkin_INCLUDE_DIRS} ) -## Declare a C++ library - add_library( ${PROJECT_NAME} - src/ArmMotor.cpp - src/AbstractJoint.cpp - src/DifferentialJoint.cpp - src/SimpleJoint.cpp - ) - -## Add cmake target dependencies of the library -## as an example, code may need to be generated before libraries -## either from message generation or dynamic reconfigure +# # Declare a C++ library +add_library(${PROJECT_NAME} + src/DifferentialJointToMotorSpeedConverter.cpp + src/DirectJointToMotorSpeedConverter.cpp + src/Joint.cpp + src/MathUtil.cpp + src/Motor.cpp + src/SingleEncoderJointPositionMonitor.cpp +) + +# # Add cmake target dependencies of the library +# # as an example, code may need to be generated before libraries +# # either from message generation or dynamic reconfigure # add_dependencies(${PROJECT_NAME} ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS}) -## Declare a C++ executable -## With catkin_make all packages are built within a single CMake context -## The recommended prefix ensures that target names across packages don't collide +# # Declare a C++ executable +# # With catkin_make all packages are built within a single CMake context +# # The recommended prefix ensures that target names across packages don't collide # add_executable(${PROJECT_NAME}_node src/wr_control_drive_arm_node.cpp) -add_executable(ArmControlSystem src/ArmControlSystem.cpp) -target_link_libraries(ArmControlSystem ${catkin_LIBRARIES} ${PROJECT_NAME}) - -## Rename C++ executable without prefix -## The above recommended prefix causes long target names, the following renames the -## target back to the shorter version for ease of user use -## e.g. "rosrun someones_pkg node" instead of "rosrun someones_pkg someones_pkg_node" +add_executable(ArmControlActionServer src/ArmControlActionServer.cpp) +target_link_libraries(ArmControlActionServer ${catkin_LIBRARIES} ${PROJECT_NAME}) +add_executable(JointStatePublisher src/JointStatePublisher.cpp) +target_link_libraries(JointStatePublisher ${catkin_LIBRARIES} ${PROJECT_NAME}) +add_executable(testDifferential src/testDifferential.cpp) +target_link_libraries(testDifferential ${catkin_LIBRARIES} ${PROJECT_NAME}) + +set_property(TARGET ArmControlActionServer PROPERTY CXX_STANDARD 17) +set_property(TARGET JointStatePublisher PROPERTY CXX_STANDARD 17) +set_property(TARGET ArmControlActionServer PROPERTY CXX_STANDARD_REQUIRED true) +set_property(TARGET JointStatePublisher PROPERTY CXX_STANDARD_REQUIRED true) +set_property(TARGET testDifferential PROPERTY CXX_STANDARD 17) +set_property(TARGET testDifferential PROPERTY CXX_STANDARD_REQUIRED true) + +# # Rename C++ executable without prefix +# # The above recommended prefix causes long target names, the following renames the +# # target back to the shorter version for ease of user use +# # e.g. "rosrun someones_pkg node" instead of "rosrun someones_pkg someones_pkg_node" # set_target_properties(${PROJECT_NAME}_node PROPERTIES OUTPUT_NAME node PREFIX "") -## Add cmake target dependencies of the executable -## same as for the library above +# # Add cmake target dependencies of the executable +# # same as for the library above # add_dependencies(${PROJECT_NAME}_node ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS}) -## Specify libraries to link a library or executable target against +# # Specify libraries to link a library or executable target against # target_link_libraries(${PROJECT_NAME}_node -# ${catkin_LIBRARIES} +# ${catkin_LIBRARIES} # ) -############# -## Install ## -############# +# ############ +# # Install ## +# ############ # all install targets should use catkin DESTINATION variables # See http://ros.org/doc/api/catkin/html/adv_user_guide/variables.html -## Mark executable scripts (Python etc.) for installation -## in contrast to setup.py, you can choose the destination +# # Mark executable scripts (Python etc.) for installation +# # in contrast to setup.py, you can choose the destination # catkin_install_python(PROGRAMS -# scripts/my_python_script -# DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} +# scripts/my_python_script +# DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} # ) -## Mark executables for installation -## See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_executables.html +# # Mark executables for installation +# # See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_executables.html # install(TARGETS ${PROJECT_NAME}_node -# RUNTIME DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} +# RUNTIME DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} # ) -## Mark libraries for installation -## See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_libraries.html +# # Mark libraries for installation +# # See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_libraries.html # install(TARGETS ${PROJECT_NAME} -# ARCHIVE DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} -# LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} -# RUNTIME DESTINATION ${CATKIN_GLOBAL_BIN_DESTINATION} +# ARCHIVE DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} +# LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION} +# RUNTIME DESTINATION ${CATKIN_GLOBAL_BIN_DESTINATION} # ) -## Mark cpp header files for installation +# # Mark cpp header files for installation # install(DIRECTORY include/${PROJECT_NAME}/ -# DESTINATION ${CATKIN_PACKAGE_INCLUDE_DESTINATION} -# FILES_MATCHING PATTERN "*.h" -# PATTERN ".svn" EXCLUDE +# DESTINATION ${CATKIN_PACKAGE_INCLUDE_DESTINATION} +# FILES_MATCHING PATTERN "*.h" +# PATTERN ".svn" EXCLUDE # ) -## Mark other files for installation (e.g. launch and bag files, etc.) +# # Mark other files for installation (e.g. launch and bag files, etc.) # install(FILES -# # myfile1 -# # myfile2 -# DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION} +# # myfile1 +# # myfile2 +# DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION} # ) -############# -## Testing ## -############# +# ############ +# # Testing ## +# ############ -## Add gtest based cpp test target and link libraries +# # Add gtest based cpp test target and link libraries # catkin_add_gtest(${PROJECT_NAME}-test test/test_wr_control_drive_science.cpp) # if(TARGET ${PROJECT_NAME}-test) -# target_link_libraries(${PROJECT_NAME}-test ${PROJECT_NAME}) +# target_link_libraries(${PROJECT_NAME}-test ${PROJECT_NAME}) # endif() -## Add folders to be run by python nosetests +# # Add folders to be run by python nosetests # catkin_add_nosetests(test) diff --git a/src/wr_control_drive_arm/config/arm_motor_PID.yaml b/src/wr_control_drive_arm/config/arm_motor_PID.yaml deleted file mode 100644 index 2ac19e48..00000000 --- a/src/wr_control_drive_arm/config/arm_motor_PID.yaml +++ /dev/null @@ -1,64 +0,0 @@ -rate: 50 -controllers: - - setpointTopic: "/control/arm/00/setpoint" - feedbackTopic: "/control/arm/00/feedback" - outputTopic: "/control/arm/00/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 - - - setpointTopic: "/control/arm/01/setpoint" - feedbackTopic: "/control/arm/01/feedback" - outputTopic: "/control/arm/01/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 - - - setpointTopic: "/control/arm/10/setpoint" - feedbackTopic: "/control/arm/10/feedback" - outputTopic: "/control/arm/10/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 - - - setpointTopic: "/control/arm/11/setpoint" - feedbackTopic: "/control/arm/11/feedback" - outputTopic: "/control/arm/11/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 - - - setpointTopic: "/control/arm/20/setpoint" - feedbackTopic: "/control/arm/20/feedback" - outputTopic: "/control/arm/20/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 - - - setpointTopic: "/control/arm/21/setpoint" - feedbackTopic: "/control/arm/21/feedback" - outputTopic: "/control/arm/21/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 - - - setpointTopic: "/control/arm/3000/setpoint" - feedbackTopic: "/control/arm/3000/feedback" - outputTopic: "/control/arm/3000/output" - P: 3000 - I: 0 - D: 0 - min: -1 - max: 1 \ No newline at end of file diff --git a/src/wr_control_drive_arm/config/arm_motor_PID_mock.yaml b/src/wr_control_drive_arm/config/arm_motor_PID_mock.yaml new file mode 100644 index 00000000..e59fd363 --- /dev/null +++ b/src/wr_control_drive_arm/config/arm_motor_PID_mock.yaml @@ -0,0 +1,55 @@ +rate: 50 +controllers: + - setpointTopic: "/control/arm/pid/turntable/setpoint" + feedbackTopic: "/control/arm/pid/turntable/feedback" + outputTopic: "/control/arm/pid/turntable/output" + P: 5 + I: 0.5 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/shoulder/setpoint" + feedbackTopic: "/control/arm/pid/shoulder/feedback" + outputTopic: "/control/arm/pid/shoulder/output" + P: 5 + I: 0.5 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/elbow/setpoint" + feedbackTopic: "/control/arm/pid/elbow/feedback" + outputTopic: "/control/arm/pid/elbow/output" + P: 5 + I: 0.5 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/forearmRoll/setpoint" + feedbackTopic: "/control/arm/pid/forearmRoll/feedback" + outputTopic: "/control/arm/pid/forearmRoll/output" + P: 5 + I: 0.5 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/wristPitch/setpoint" + feedbackTopic: "/control/arm/pid/wristPitch/feedback" + outputTopic: "/control/arm/pid/wristPitch/output" + P: 5 + I: 0.5 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/wristRoll/setpoint" + feedbackTopic: "/control/arm/pid/wristRoll/feedback" + outputTopic: "/control/arm/pid/wristRoll/output" + P: 5 + I: 0.5 + D: 0 + min: -1 + max: 1 diff --git a/src/wr_control_drive_arm/config/arm_motor_PID_real.yaml b/src/wr_control_drive_arm/config/arm_motor_PID_real.yaml new file mode 100644 index 00000000..a0da7801 --- /dev/null +++ b/src/wr_control_drive_arm/config/arm_motor_PID_real.yaml @@ -0,0 +1,55 @@ +rate: 50 +controllers: + - setpointTopic: "/control/arm/pid/turntable/setpoint" + feedbackTopic: "/control/arm/pid/turntable/feedback" + outputTopic: "/control/arm/pid/turntable/output" + P: 10 + I: 0 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/shoulder/setpoint" + feedbackTopic: "/control/arm/pid/shoulder/feedback" + outputTopic: "/control/arm/pid/shoulder/output" + P: 10 + I: 0 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/elbow/setpoint" + feedbackTopic: "/control/arm/pid/elbow/feedback" + outputTopic: "/control/arm/pid/elbow/output" + P: 10 + I: 0 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/forearmRoll/setpoint" + feedbackTopic: "/control/arm/pid/forearmRoll/feedback" + outputTopic: "/control/arm/pid/forearmRoll/output" + P: 10 + I: 0 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/wristPitch/setpoint" + feedbackTopic: "/control/arm/pid/wristPitch/feedback" + outputTopic: "/control/arm/pid/wristPitch/output" + P: 10 + I: 0 + D: 0 + min: -1 + max: 1 + + - setpointTopic: "/control/arm/pid/wristRoll/setpoint" + feedbackTopic: "/control/arm/pid/wristRoll/feedback" + outputTopic: "/control/arm/pid/wristRoll/output" + P: 10 + I: 0 + D: 0 + min: -1 + max: 1 diff --git a/src/wr_control_drive_arm/config/arm_parameters_mock.yaml b/src/wr_control_drive_arm/config/arm_parameters_mock.yaml new file mode 100644 index 00000000..a8b1e10d --- /dev/null +++ b/src/wr_control_drive_arm/config/arm_parameters_mock.yaml @@ -0,0 +1,37 @@ +arm_parameters: + elbow: + encoder_parameters: + counts_per_rotation: 1000 + offset: 500 + motor_parameters: + gear_ratio: 1 + forearmRoll: + encoder_parameters: + counts_per_rotation: 1000 + offset: 500 + motor_parameters: + gear_ratio: 1 + shoulder: + encoder_parameters: + counts_per_rotation: 1000 + offset: 500 + motor_parameters: + gear_ratio: 1 + turntable: + encoder_parameters: + counts_per_rotation: 1000 + offset: 500 + motor_parameters: + gear_ratio: 1 + wristPitch: + encoder_parameters: + counts_per_rotation: 1000 + offset: 500 + motor_parameters: + gear_ratio: 1 + wristRoll: + encoder_parameters: + counts_per_rotation: 1000 + offset: 500 + motor_parameters: + gear_ratio: 1 diff --git a/src/wr_control_drive_arm/config/arm_parameters_real.yaml b/src/wr_control_drive_arm/config/arm_parameters_real.yaml new file mode 100644 index 00000000..511c0c23 --- /dev/null +++ b/src/wr_control_drive_arm/config/arm_parameters_real.yaml @@ -0,0 +1,37 @@ +arm_parameters: + elbow: + encoder_parameters: + counts_per_rotation: 1850 + offset: 546 + motor_parameters: + gear_ratio: 3 + forearmRoll: + encoder_parameters: + counts_per_rotation: -1850 + offset: 576 + motor_parameters: + gear_ratio: 3 + shoulder: + encoder_parameters: + counts_per_rotation: 5550 + offset: 1281 + motor_parameters: + gear_ratio: 9 + turntable: + encoder_parameters: + counts_per_rotation: 6900 #7200 + offset: 90 + motor_parameters: + gear_ratio: 3 + wristPitch: + encoder_parameters: + counts_per_rotation: -1850 + offset: 886 + motor_parameters: + gear_ratio: 4.875 + wristRoll: + encoder_parameters: + counts_per_rotation: -1850 + offset: 981 + motor_parameters: + gear_ratio: 4.875 diff --git a/src/wr_control_drive_arm/config/encoder_parameters.yaml b/src/wr_control_drive_arm/config/encoder_parameters.yaml deleted file mode 100644 index 1fce6c2e..00000000 --- a/src/wr_control_drive_arm/config/encoder_parameters.yaml +++ /dev/null @@ -1,19 +0,0 @@ -encoder_parameters: -# elbow - - counts_per_rotation: -2048 - offset: 610 -# forearm_roll - - counts_per_rotation: -2048 - offset: 540 -# shoulder - - counts_per_rotation: -6144 - offset: 1129 -# turntable - - counts_per_rotation: 2048 - offset: 985 -# wrist_pitch - - counts_per_rotation: 2048 - offset: 886 -# wrist_roll - - counts_per_rotation: 2048 - offset: 1050 diff --git a/src/wr_control_drive_arm/launch/actionserver.launch b/src/wr_control_drive_arm/launch/actionserver.launch new file mode 100644 index 00000000..a1c5c9e0 --- /dev/null +++ b/src/wr_control_drive_arm/launch/actionserver.launch @@ -0,0 +1,21 @@ + + + + + + + + + + + + \ No newline at end of file diff --git a/src/wr_control_drive_arm/launch/jointstatepublisher.launch b/src/wr_control_drive_arm/launch/jointstatepublisher.launch new file mode 100644 index 00000000..9b662856 --- /dev/null +++ b/src/wr_control_drive_arm/launch/jointstatepublisher.launch @@ -0,0 +1,12 @@ + + + + + + + + + \ No newline at end of file diff --git a/src/wr_control_drive_arm/launch/std.launch b/src/wr_control_drive_arm/launch/std.launch index 12c7e1a3..96c2e726 100644 --- a/src/wr_control_drive_arm/launch/std.launch +++ b/src/wr_control_drive_arm/launch/std.launch @@ -1,10 +1,5 @@ + - - - - - - - - + + diff --git a/src/wr_control_drive_arm/launch/testDifferential.launch b/src/wr_control_drive_arm/launch/testDifferential.launch new file mode 100644 index 00000000..b6632b1a --- /dev/null +++ b/src/wr_control_drive_arm/launch/testDifferential.launch @@ -0,0 +1,3 @@ + + + \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/AbstractJoint.cpp b/src/wr_control_drive_arm/src/AbstractJoint.cpp deleted file mode 100644 index e88e5afa..00000000 --- a/src/wr_control_drive_arm/src/AbstractJoint.cpp +++ /dev/null @@ -1,39 +0,0 @@ -/** - * @file AbstractJoint.cpp - * @author Nichols Underwood - * @brief Implementation of the AbstractJoint class - * @date 2021-10-25 - */ - -#include "AbstractJoint.hpp" - -AbstractJoint::AbstractJoint(ros::NodeHandle &n, int numMotors){ - this->motors.resize(numMotors); -} - -auto AbstractJoint::getDegreesOfFreedom() const -> unsigned int{ - return this->motors.size(); -} - -auto AbstractJoint::getMotor(int motorIndex) const -> const std::unique_ptr&{ - return this->motors.at(motorIndex).motor; -} - -void AbstractJoint::configSetpoint(int degreeIndex, double position, double velocity){ - - this->motors.at(degreeIndex).position = position; - this->motors.at(degreeIndex).velocity = velocity; -} - - -void AbstractJoint::exectute(){ - for(auto &motorHandle : motors){ - motorHandle.motor->runToTarget(motorHandle.position, motorHandle.velocity); - } -} - -void AbstractJoint::stopJoint(){ - for(auto &motorHandle : motors){ - motorHandle.motor->setPower(0.F); - } -} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/AbstractJoint.hpp b/src/wr_control_drive_arm/src/AbstractJoint.hpp deleted file mode 100644 index cf19f069..00000000 --- a/src/wr_control_drive_arm/src/AbstractJoint.hpp +++ /dev/null @@ -1,46 +0,0 @@ -/** - * @file AbstractJoint.hpp - * @author Nichols Underwood - * @brief Header file of the AbstractJoint class - * @date 2021-10-25 - */ - -#ifndef ABSTRACT_JOINT_GUARD -#define ABSTRACT_JOINT_GUARD - -#include "ArmMotor.hpp" -using std::vector; - -class AbstractJoint { -public: - struct MotorHandler{ - std::unique_ptr motor; - double position; - double velocity; - std::string jointTopicName; - std::string motorTopicName; - bool newVelocity; - }; - - AbstractJoint(ros::NodeHandle &n, int numMotors); - - // never used, need to be defined for compiler v-table - virtual auto getMotorPositions(const vector &jointPositions) -> vector = 0; - virtual auto getMotorVelocities(const vector &joinVelocities) -> vector = 0; - virtual auto getJointPositions(const vector &motorPositions) -> vector = 0; - - auto getDegreesOfFreedom() const -> unsigned int; - - auto getMotor(int motorIndex) const -> const std::unique_ptr&; - - void configSetpoint(int degreeIndex, double position, double velocity); - - void exectute(); - - void stopJoint(); - -protected: - vector motors; -}; - -#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/ArmControlActionServer.cpp b/src/wr_control_drive_arm/src/ArmControlActionServer.cpp new file mode 100644 index 00000000..7b3f6ae9 --- /dev/null +++ b/src/wr_control_drive_arm/src/ArmControlActionServer.cpp @@ -0,0 +1,361 @@ +/** + * @file ArmControlActionServer.cpp + * @author Ben Nowotny + * @brief The exeutable file to run the Arm Control Action Server + * @date 2022-12-05 + */ +#include "DifferentialJointToMotorSpeedConverter.hpp" +#include "DirectJointToMotorSpeedConverter.hpp" +#include "Joint.hpp" +#include "Motor.hpp" +#include "RoboclawChannel.hpp" +#include "SingleEncoderJointPositionMonitor.hpp" +#include "XmlRpcValue.h" +#include "ros/init.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +using XmlRpc::XmlRpcValue; + +/** + * @brief Refresh rate of ros::Rate + */ +constexpr float CLOCK_RATE{50}; + +constexpr double IK_WARN_RATE{1.0 / 2}; + +constexpr double JOINT_SAFETY_MAX_SPEED{0.5}; +constexpr double JOINT_SAFETY_HOLD_SPEED{0.3}; + +/** + * @brief Nessage cache size of publisher + */ +constexpr std::uint32_t MESSAGE_CACHE_SIZE{10}; + +/** + * @brief Period between timer callback + */ +constexpr float TIMER_CALLBACK_DURATION{1.0 / 50.0}; + +/** + * @brief Defines space for all Joint references + */ +std::unordered_map> namedJointMap; + +/** + * @brief Defines space for all joint position monitor references + */ +std::unordered_map> namedPositionMonitors; + +/** + * @brief Simplify the SimpleActionServer reference name + */ +using Server = actionlib::SimpleActionServer; + +/** + * @brief The service server for enabling IK + */ +ros::ServiceServer enableServiceServer; +/** + * @brief The status of IK program + */ +std::atomic_bool IKEnabled{true}; +/** + * @brief The service client for disabling IK + */ +ros::ServiceClient enableServiceClient; + +/** + * @brief Perform the given action as interpreted as moving the arm joints to + * specified positions + * + * @param goal The goal state given + * @param as The Action Server this is occuring on + */ +void execute(const control_msgs::FollowJointTrajectoryGoalConstPtr &goal, + Server *server) { + if (!IKEnabled) { + server->setAborted(); + ROS_WARN_THROTTLE( // NOLINT(hicpp-no-array-decay,hicpp,hicpp-vararg,cppcoreguidelines-pro-bounds-array-to-pointer-decay, cppcoreguidelines-pro-type-vararg) + IK_WARN_RATE, + "IK is disabled"); + return; + } + + for (const auto &jointName : goal->trajectory.joint_names) { + std::cout << jointName << "\t"; + } + std::cout << std::endl; + for (const auto &waypoint : goal->trajectory.points) { + for (const auto &jointVal : waypoint.positions) { + std::cout << jointVal << "\t"; + } + std::cout << std::endl; + } + + for (const auto &currTargetPosition : goal->trajectory.points) { + + if (!IKEnabled) { + server->setAborted(); + std::cout << "Over current fault!" << std::endl; + return; + } + + // Copy of the velocities received from MoveIt + std::vector velocityCopies{currTargetPosition.velocities}; + + for (uint32_t i = 0; i < goal->trajectory.joint_names.size(); ++i) { + + // The joint that is currently being scaled + auto currJoint = goal->trajectory.joint_names.at(i); + + // The position monitor whose velocity is currently being scaled + auto& currPosMtr = *namedPositionMonitors.at(currJoint); + + // Scale by counts per rotation and gear ratio + velocityCopies.at(i) *= abs(currPosMtr.getCountsPerRotation()*currPosMtr.getGearRatio()); + } + + // Get the maximum velocity assigned to any joint + const double VELOCITY_MAX = abs(*std::max_element( + velocityCopies.begin(), + velocityCopies.end(), + [](double lhs, double rhs) -> bool { return abs(lhs) < abs(rhs); })); + + for (uint32_t i = 0; i < goal->trajectory.joint_names.size(); ++i) { + // Set joint to hold speed in case the greatest velocity comes through as 0 + auto jointVelocity{JOINT_SAFETY_HOLD_SPEED}; + + // Scale all velocities by the safety max speed with respect to the maximum velocity given by MoveIt + if (VELOCITY_MAX != 0) + jointVelocity = velocityCopies.at(i) / VELOCITY_MAX * JOINT_SAFETY_MAX_SPEED; + + // Set the joint's velocity + namedJointMap.at(goal->trajectory.joint_names.at(i))->setTarget(currTargetPosition.positions.at(i), jointVelocity); + } + } + + auto waypointComplete{false}; + ros::Rate updateRate{CLOCK_RATE}; + + while (!waypointComplete && ros::ok() && !server->isNewGoalAvailable()) { + + if (!IKEnabled) { + server->setAborted(); + std::cout << "Over current fault!" << std::endl; + return; + } + + waypointComplete = true; + for (const auto &[_, joint] : namedJointMap) { + waypointComplete &= joint->hasReachedTarget(); + } + updateRate.sleep(); + } + + // Report preemption if it occurred + if (server->isNewGoalAvailable()) + server->setPreempted(); + // When all positions have been reached, set the current task as succeeded + else + server->setSucceeded(); + std::cout << "Action Complete!" << std::endl; +} + +auto getEncoderConfigFromParams(const XmlRpcValue ¶ms, const std::string &jointName) -> EncoderConfiguration { + return {.countsPerRotation = static_cast(params[jointName]["encoder_parameters"]["counts_per_rotation"]), + .offset = static_cast(params[jointName]["encoder_parameters"]["offset"])}; +} + +auto getMotorConfigFromParams(const XmlRpcValue ¶ms, const std::string &jointName) -> MotorConfiguration { + return {.gearRatio = static_cast(params[jointName]["motor_configurations"]["gear_ratio"])}; +} + +void checkOverCurrentFaults(const std::vector> &motors){ + for(const auto& motor : motors){ + if (motor->isOverCurrent()) { + IKEnabled = false; + std::cout << "Over current fault!" << std::endl; + + for (const auto& joint : namedJointMap) { + joint.second->stop(); + } + } + // TODO: arbitrate control to old arm driver + } +} + +/** + * @brief The main executable method of the node. Starts the ROS node and the + * Action Server for processing Arm Control commands + * + * @param argc The number of program arguments + * @param argv The given program arguments + * @return int The status code on exiting the program + */ +auto main(int argc, char **argv) -> int { + std::cout << "start main" << std::endl; + // Initialize the current node as ArmControlSystem + ros::init(argc, argv, "ArmControlActionServer"); + // Create the NodeHandle to the current ROS node + ros::NodeHandle n; + ros::NodeHandle pn{"~"}; + + XmlRpcValue armParams; + pn.getParam("arm_parameters", armParams); + + // Initialize all motors with their MoveIt name, WRoboclaw initialization, + // and reference to the current node + std::cout << "init motors" << std::endl; + + /** + * @brief The list of motors + */ + std::vector> motors{}; + + using std::literals::string_literals::operator""s; + + const auto turntableMotor{std::make_shared("aux0"s, RoboclawChannel::A, n)}; + const auto shoulderMotor{std::make_shared("aux0"s, RoboclawChannel::B, n)}; + const auto elbowMotor{std::make_shared("aux1"s, RoboclawChannel::A, n)}; + const auto forearmRollMotor{std::make_shared("aux1"s, RoboclawChannel::B, n)}; + const auto wristLeftMotor{std::make_shared("aux2"s, RoboclawChannel::A, n)}; + const auto wristRightMotor{std::make_shared("aux2"s, RoboclawChannel::B, n)}; + + motors.push_back(turntableMotor); + motors.push_back(shoulderMotor); + motors.push_back(elbowMotor); + motors.push_back(forearmRollMotor); + motors.push_back(wristLeftMotor); + motors.push_back(wristRightMotor); + + namedPositionMonitors.insert({"turntable_joint", std::make_shared( + "aux0"s, + RoboclawChannel::A, + getEncoderConfigFromParams(armParams, "turntable"), + getMotorConfigFromParams(armParams, "turntable"), + n)}); + + namedPositionMonitors.insert({"shoulder_joint", std::make_shared( + "aux0"s, + RoboclawChannel::B, + getEncoderConfigFromParams(armParams, "shoulder"), + getMotorConfigFromParams(armParams, "shoulder"), + n)}); + + namedPositionMonitors.insert({"elbowPitch_joint", std::make_shared( + "aux1"s, + RoboclawChannel::A, + getEncoderConfigFromParams(armParams, "elbow"), + getMotorConfigFromParams(armParams, "elbow"), + n)}); + + namedPositionMonitors.insert({"elbowRoll_joint", std::make_shared( + "aux1"s, + RoboclawChannel::B, + getEncoderConfigFromParams(armParams, "forearmRoll"), + getMotorConfigFromParams(armParams, "forearmRoll"), + n)}); + + namedPositionMonitors.insert({"wristPitch_joint", std::make_shared( + "aux2"s, + RoboclawChannel::A, + getEncoderConfigFromParams(armParams, "wristPitch"), + getMotorConfigFromParams(armParams, "wristPitch"), + n)}); + + namedPositionMonitors.insert({"wristRoll_link", std::make_shared( + "aux2"s, + RoboclawChannel::B, + getEncoderConfigFromParams(armParams, "wristRoll"), + getMotorConfigFromParams(armParams, "wristRoll"), + n)}); + + const auto turntableSpeedConverter{std::make_shared(turntableMotor, MotorSpeedDirection::REVERSE)}; + const auto shoulderSpeedConverter{std::make_shared(shoulderMotor, MotorSpeedDirection::REVERSE)}; + const auto elbowSpeedConverter{std::make_shared(elbowMotor, MotorSpeedDirection::REVERSE)}; + const auto forearmRollSpeedConverter{std::make_shared(forearmRollMotor, MotorSpeedDirection::REVERSE)}; + const auto differentialSpeedConverter{std::make_shared(wristLeftMotor, wristRightMotor)}; + + // Initialize all Joints + + std::cout << "init joints" << std::endl; + + namedJointMap.insert({"turntable_joint", std::make_unique( + "turntable"s, + [turntablePositionMonitor=namedPositionMonitors.at("turntable_joint")]() -> double { return (*turntablePositionMonitor)(); }, + [turntableSpeedConverter](double speed) { (*turntableSpeedConverter)(speed); }, + n)}); + namedJointMap.insert({"shoulder_joint", std::make_unique( + "shoulder", + [shoulderPositionMonitor=namedPositionMonitors.at("shoulder_joint")]() -> double { return (*shoulderPositionMonitor)(); }, + [shoulderSpeedConverter](double speed) { (*shoulderSpeedConverter)(speed); }, + n)}); + namedJointMap.insert({"elbowPitch_joint", std::make_unique( + "elbow", + [elbowPositionMonitor=namedPositionMonitors.at("elbowPitch_joint")]() -> double { return (*elbowPositionMonitor)(); }, + [elbowSpeedConverter](double speed) { (*elbowSpeedConverter)(speed); }, + n)}); + namedJointMap.insert({"elbowRoll_joint", std::make_unique( + "forearmRoll", + [forearmRollPositionMonitor=namedPositionMonitors.at("elbowRoll_joint")]() -> double { return (*forearmRollPositionMonitor)(); }, + [forearmRollSpeedConverter](double speed) { (*forearmRollSpeedConverter)(speed); }, + n)}); + namedJointMap.insert({"wristPitch_joint", std::make_unique( + "wristPitch", + [wristPitchPositionMonitor=namedPositionMonitors.at("wristPitch_joint")]() -> double { return (*wristPitchPositionMonitor)(); }, + [converter = differentialSpeedConverter](double speed) { converter->setPitchSpeed(speed); }, + n)}); + namedJointMap.insert({"wristRoll_link", std::make_unique( + "wristRoll", + [wristRollPositionMonitor=namedPositionMonitors.at("wristRoll_link")]() -> double { return (*wristRollPositionMonitor)(); }, + [converter = differentialSpeedConverter](double speed) { converter->setRollSpeed(speed); }, + n)}); + + // Initialize the Action Server + Server server( + n, "/arm_controller/follow_joint_trajectory", + [&server](auto goal) { execute(goal, &server); }, false); + // Start the Action Server + server.start(); + std::cout << "server started" << std::endl; + + enableServiceServer = n.advertiseService( + "start_IK", + static_cast>( + [](std_srvs::Trigger::Request &req, + std_srvs::Trigger::Response &res) -> bool { + IKEnabled = true; + res.message = "Arm IK Enabled"; + res.success = static_cast(true); + return true; + })); + + enableServiceClient = + n.serviceClient("PLACEHOLDER_NAME"); + + ros::Timer currentTimer = n.createTimer(ros::Duration{TIMER_CALLBACK_DURATION}, [&motors](const ros::TimerEvent& event) { checkOverCurrentFaults(motors); }); + + std::cout << "entering ROS spin..." << std::endl; + // ROS spin for communication with other nodes + ros::spin(); + // Return 0 on exit (successful exit) + return 0; +} diff --git a/src/wr_control_drive_arm/src/ArmControlSystem.cpp b/src/wr_control_drive_arm/src/ArmControlSystem.cpp deleted file mode 100644 index 2dc5dbf9..00000000 --- a/src/wr_control_drive_arm/src/ArmControlSystem.cpp +++ /dev/null @@ -1,257 +0,0 @@ -/** - * @file ArmControlSystem.cpp - * @author Ben Nowotny - * @brief The exeutable file to run the Arm Control Action Server - * @date 2021-04-05 - */ -#include "XmlRpcValue.h" - -#include "ros/ros.h" -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include "SimpleJoint.hpp" -#include "DifferentialJoint.hpp" -#include "ros/console.h" - -using XmlRpc::XmlRpcValue; - -/** - * @brief Refresh rate of ros::Rate - */ -constexpr float CLOCK_RATE = 50; - -constexpr double IK_WARN_RATE = 1.0/2; - -constexpr double JOINT_SAFETY_MAX_SPEED = 0.3; -constexpr double JOINT_SAFETY_HOLD_SPEED = 0.15; - -/** - * @brief Nessage cache size of publisher - */ -constexpr std::uint32_t MESSAGE_CACHE_SIZE = 1000; - -/** - * @brief Period between timer callback - */ -constexpr float TIMER_CALLBACK_DURATION = 1.0 / 50.0; - -/** - * @brief Defines space for all Joint references - */ -constexpr int NUM_JOINTS = 5; -std::array, NUM_JOINTS> joints; -// AbstractJoint *joints[numJoints]; -/** - * @brief The Joint State Publisher for MoveIt - */ -ros::Publisher jointStatePublisher; -/** - * @brief Simplify the SimpleActionServer reference name - */ -typedef actionlib::SimpleActionServer Server; -/** - * @brief The service server for enabling IK - */ -ros::ServiceServer enableServiceServer; -/** - * @brief The status of IK program - */ -std::atomic_bool IKEnabled{true}; -/** - * @brief The service client for disabling IK - */ -ros::ServiceClient enableServiceClient; - -/** - * @brief Perform the given action as interpreted as moving the arm joints to specified positions - * - * @param goal The goal state given - * @param as The Action Server this is occuring on - */ -void execute(const control_msgs::FollowJointTrajectoryGoalConstPtr& goal, Server* as) { - if (!IKEnabled) { - as->setAborted(); - ROS_WARN_THROTTLE(IK_WARN_RATE, "IK is disabled"); // NOLINT(hicpp-no-array-decay,hicpp,hicpp-vararg,cppcoreguidelines-pro-bounds-array-to-pointer-decay, cppcoreguidelines-pro-type-vararg) - return; - } - - int currPoint = 1; - - std::cout << "start exec: " << goal->trajectory.points.size() << std::endl; - // For each point in the trajectory execution sequence... - for(const auto &currTargetPosition : goal->trajectory.points){ - for(double pos : currTargetPosition.positions){ - std::cout << std::round(pos*100)/100 << " "; - } - std::cout << std::endl; - } - for(const auto &currTargetPosition : goal->trajectory.points){ - // Track whether or not the current position is done - bool hasPositionFinished = false; - // Keep max loop rate at 50 Hz - ros::Rate loop{CLOCK_RATE}; - - const double VELOCITY_MAX = abs(*std::max_element( - currTargetPosition.velocities.begin(), - currTargetPosition.velocities.end(), - [](double a, double b) -> bool{ return abs(a)trajectory.points.size() << std::endl; - currPoint++; - for(const auto &joint : joints){ - for(int i = 0; i < joint->getDegreesOfFreedom(); i++){ - double velocity = VELOCITY_MAX == 0.F ? JOINT_SAFETY_HOLD_SPEED : currTargetPosition.velocities[currItr]/VELOCITY_MAX; - std::cout << "config setpoint: " << currTargetPosition.positions[currItr] << ":" << velocity << std::endl; - joint->configSetpoint(i, currTargetPosition.positions[currItr], velocity); - currItr++; - } - joint->exectute(); - } - - // While the current position is not complete yet... - while(!hasPositionFinished){ - // Assume the current action is done until proven otherwise - hasPositionFinished = true; - // Create the Joint State message for the current update cycle - - // For each joint specified in the currTargetPosition... - for(const auto &joint : joints){ - - // joint->exectute(); - - for(int k = 0; k < joint->getDegreesOfFreedom(); k++){ - - if (joint->getMotor(k)->getMotorState() == MotorState::STALLING) { - IKEnabled = false; - std_srvs::Trigger srv; - if (enableServiceClient.call(srv)) { - ROS_WARN("%s", (std::string{"PLACEHOLDER_NAME: "} + srv.response.message).data()); // NOLINT(cppcoreguidelines-pro-bounds-array-to-pointer-decay, cppcoreguidelines-pro-type-vararg) - } else { - ROS_WARN("Error: failed to call service PLACEHOLDER_NAME"); // NOLINT(cppcoreguidelines-pro-bounds-array-to-pointer-decay, cppcoreguidelines-pro-type-vararg) - } - } else { - hasPositionFinished &= joint->getMotor(k)->getMotorState() == MotorState::STOP; - } - // DEBUGGING OUTPUT: Print each motor's name, radian position, encoder position, and power - // std::cout<getEncoderCounts()<exectute()) { - // IKEnabled = false; - // std_srvs::Trigger srv; - // if (enableServiceClient.call(srv)) { - // ROS_WARN("%s", (std::string{"PLACEHOLDER_NAME: "} + srv.response.message).data()); // NOLINT(cppcoreguidelines-pro-bounds-array-to-pointer-decay, cppcoreguidelines-pro-type-vararg) - // } else { - // ROS_WARN("Error: failed to call service PLACEHOLDER_NAME"); // NOLINT(cppcoreguidelines-pro-bounds-array-to-pointer-decay, cppcoreguidelines-pro-type-vararg) - // } - // return; - // } - } - // Sleep until the next update cycle - loop.sleep(); - } - } - - //When all positions have been reached, set the current task as succeeded - - as->setSucceeded(); -} - -/** - * @brief publishes the arm's position - */ -void publishJointStates(const ros::TimerEvent &event){ - std::vector names; - std::vector positions; - sensor_msgs::JointState js_msg; - - for(const auto &joint : joints){ - for(int i = 0; i < joint->getDegreesOfFreedom(); i++){ - names.push_back(joint->getMotor(i)->getMotorName()); - positions.push_back(joint->getMotor(i)->getRads()); - } - } - - js_msg.name = names; - js_msg.position = positions; - // Publish the Joint State message - jointStatePublisher.publish(js_msg); -} - -/** - * @brief The main executable method of the node. Starts the ROS node and the Action Server for processing Arm Control commands - * - * @param argc The number of program arguments - * @param argv The given program arguments - * @return int The status code on exiting the program - */ -auto main(int argc, char** argv) ->int -{ - std::cout << "start main" << std::endl; - // Initialize the current node as ArmControlSystem - ros::init(argc, argv, "ArmControlSystem"); - // Create the NodeHandle to the current ROS node - ros::NodeHandle n; - ros::NodeHandle pn{"~"}; - - XmlRpcValue encParams; - pn.getParam("encoder_parameters", encParams); - - // Initialize all motors with their MoveIt name, WRoboclaw initialization, and reference to the current node - auto elbow = std::make_unique("elbow", 1, 0, static_cast(encParams[0]["counts_per_rotation"]), static_cast(encParams[0]["offset"]), n); - auto forearmRoll = std::make_unique("forearm_roll", 1, 1, static_cast(encParams[1]["counts_per_rotation"]), static_cast(encParams[1]["offset"]), n); - auto shoulder = std::make_unique("shoulder", 0, 1, static_cast(encParams[2]["counts_per_rotation"]), static_cast(encParams[2]["offset"]), n); - auto turntable = std::make_unique("turntable", 0, 0, static_cast(encParams[3]["counts_per_rotation"]), static_cast(encParams[3]["offset"]), n); - auto wristLeft = std::make_unique("wrist_pitch", 2, 0, static_cast(encParams[4]["counts_per_rotation"]), static_cast(encParams[4]["offset"]), n); - auto wristRight = std::make_unique("wrist_roll", 2, 1, static_cast(encParams[5]["counts_per_rotation"]), static_cast(encParams[5]["offset"]), n); - std::cout << "init motors" << std::endl; - - // Initialize all Joints - joints.at(0) = std::make_unique(std::move(elbow), n); - joints.at(1) = std::make_unique(std::move(forearmRoll), n); - joints.at(2) = std::make_unique(std::move(shoulder), n); - joints.at(3) = std::make_unique(std::move(turntable), n); - joints.at(4) = std::make_unique(std::move(wristLeft), std::move(wristRight), n, "/control/arm/5/pitch", "/control/arm/5/roll", "/control/arm/20/", "/control/arm/21/"); - std::cout << "init joints" << std::endl; - - // Initialize the Joint State Data Publisher - jointStatePublisher = n.advertise("/control/arm_joint_states", MESSAGE_CACHE_SIZE); - - // Initialize the Action Server - Server server(n, "/arm_controller/follow_joint_trajectory", boost::bind(&execute, _1, &server), false); - // Start the Action Server - server.start(); - std::cout << "server started" << std::endl; - - ros::Timer timer = n.createTimer(ros::Duration(TIMER_CALLBACK_DURATION), publishJointStates); - - enableServiceServer = n.advertiseService("start_IK", - static_cast>( - [](std_srvs::Trigger::Request &req, std_srvs::Trigger::Response &res)->bool{ - IKEnabled = true; - res.message = "Arm IK Enabled"; - res.success = static_cast(true); - return true; - } - )); - - enableServiceClient = n.serviceClient("PLACEHOLDER_NAME"); - - std::cout << "entering ROS spin..." << std::endl; - // ROS spin for communication with other nodes - ros::spin(); - // Return 0 on exit (successful exit) - return 0; -} diff --git a/src/wr_control_drive_arm/src/ArmMotor.cpp b/src/wr_control_drive_arm/src/ArmMotor.cpp deleted file mode 100644 index 60220e71..00000000 --- a/src/wr_control_drive_arm/src/ArmMotor.cpp +++ /dev/null @@ -1,202 +0,0 @@ -/** - * @file ArmMotor.cpp - * @author Ben Nowotny - * @brief The implementation of the ArmMotor class - * @date 2021-04-05 - */ -#include "ArmMotor.hpp" -#include -#include - -/// Allow for referencing the UInt32 message type easier -using Std_UInt32 = std_msgs::UInt32::ConstPtr; -using Std_Float64 = std_msgs::Float64::ConstPtr; -using Std_Bool = std_msgs::Bool::ConstPtr; - -auto ArmMotor::corrMod(double i, double j) -> double { - // Stem i%j by j, which in modular arithmetic is the same as adding 0. - return std::fmod(std::fmod(std::abs(j)*i/j,std::abs(j))+j,std::abs(j)); -} - -/// Currently consistent with the rad->enc equation as specified here. -auto ArmMotor::radToEnc(double rads) const -> uint32_t{ - return this->COUNTS_PER_ROTATION * ArmMotor::corrMod(rads, 2 * M_PI)/(2 * M_PI) + this->ENCODER_OFFSET; -} - -auto ArmMotor::encToRad(uint32_t enc) const -> double{ - return ArmMotor::corrMod(static_cast(enc - this->ENCODER_OFFSET) / static_cast(this->COUNTS_PER_ROTATION) * 2 * M_PI + M_PI, 2 * M_PI) - M_PI; -} - -/// Currently consistent with the enc->rad equation as specified here. -auto ArmMotor::getRads() const -> double{ - return ArmMotor::encToRad(this->getEncoderCounts()); -} - -void ArmMotor::storeEncoderVals(const Std_UInt32 &msg){ - // Store the message value in this ArmMotor's encoderVal variable - this->encoderVal = msg->data; - - // Send feedback - std_msgs::Float64 feedbackMsg; - feedbackMsg.data = ArmMotor::encToRad(msg->data); - this->feedbackPub.publish(feedbackMsg); - - if(this->currState == MotorState::RUN_TO_TARGET){ - std::cout << "[2] " << (hasReachedTarget(this->target) ? "at target " : "not at target ") << this->target << ":" << this->encoderVal << std::endl; - if(hasReachedTarget(this->target)){ - std::cout << "[1] stop motor" << std::endl; - this->setPower(0.F, MotorState::STOP); - } - } -} - -void ArmMotor::redirectPowerOutput(const Std_Float64 &msg){ - // Set the speed to be the contained data - if(this->getMotorState() == MotorState::RUN_TO_TARGET) this->setPower(static_cast(msg->data) * this->maxPower, MotorState::RUN_TO_TARGET); -} - -void ArmMotor::storeStallStatus(const Std_Bool &msg) { - if (static_cast(msg->data)) { - if ((ros::Time::now() - beginStallTime).toSec() >= STALL_THRESHOLD_TIME) { - this->setPower(0.0F, MotorState::STALLING); - } - } else { - beginStallTime = ros::Time::now(); - } -} - -/// controllerID is constrained between [0,3] -/// motorID is constrained between [0,1] -ArmMotor::ArmMotor( - std::string motor_name, - unsigned int controllerID, - unsigned int motorID, - int64_t countsPerRotation, - int64_t offset, - ros::NodeHandle &n -) : COUNTS_PER_ROTATION{countsPerRotation}, - ENCODER_BOUNDS{0, std::abs(countsPerRotation)}, - ENCODER_OFFSET{offset}, - motorName{std::move(motor_name)}, - controllerID{controllerID}, - motorID{motorID}, - currState{MotorState::STOP}, - power{0.F}, - maxPower{0.F}, - encoderVal{static_cast(offset)} { - - // Check validity of WRoboclaw and motor IDs - if(controllerID > 3) throw std::invalid_argument{std::string{"Controller ID "} + std::to_string(controllerID) + "is only valid on [0,3]"}; - if(motorID > 1) throw std::invalid_argument{std::string{"Motor ID "} + std::to_string(motorID) + " is only valid on [0,1]"}; - - // Create the topic string prefix for WRoboclaw controllers - std::string tpString = std::string{"/hsi/roboclaw/aux"} + std::to_string(controllerID); - std::string controlString = "/control/arm/" + std::to_string(controllerID) + std::to_string(motorID); - - // Create the appropriate encoder-reading and speed-publishing subscribers and advertisers, respectfully - this->encRead = n.subscribe(tpString + "/enc/" + (motorID == 0 ? "left" : "right"), ArmMotor::MESSAGE_CACHE_SIZE, &ArmMotor::storeEncoderVals, this); - this->speedPub = n.advertise(tpString + "/cmd/" + (motorID == 0 ? "left" : "right"), ArmMotor::MESSAGE_CACHE_SIZE); - this->targetPub = n.advertise(controlString + "/setpoint", ArmMotor::MESSAGE_CACHE_SIZE); - this->feedbackPub = n.advertise(controlString + "/feedback", ArmMotor::MESSAGE_CACHE_SIZE); - this->outputRead = n.subscribe(controlString + "/output", ArmMotor::MESSAGE_CACHE_SIZE, &ArmMotor::redirectPowerOutput, this); - this->stallRead = n.subscribe(tpString + "/curr/over_lim/" + (motorID == 0 ? "left" : "right"), ArmMotor::MESSAGE_CACHE_SIZE, &ArmMotor::storeStallStatus, this); - - std::cout << this->motorName << ": " << this->COUNTS_PER_ROTATION << std::endl; -} - -auto ArmMotor::getEncoderCounts() const -> uint32_t{ - return this->encoderVal; -} - -void ArmMotor::runToTarget(uint32_t targetCounts, float power){ - std::cout << "run to enc: " << targetCounts << std::endl; - this->runToTarget(targetCounts, power, false); -} - -auto ArmMotor::hasReachedTarget(uint32_t targetCounts, uint32_t tolerance) const -> bool{ - // Compute the upper and lower bounds in the finite encoder space - uint32_t lBound = ArmMotor::corrMod(static_cast(targetCounts - tolerance), static_cast(ArmMotor::ENCODER_BOUNDS[1])); - uint32_t uBound = ArmMotor::corrMod(static_cast(targetCounts + tolerance), static_cast(ArmMotor::ENCODER_BOUNDS[1])); - // If the computed lower bound is lower than the upper bound, perform the computation normally - if(lBound < uBound) - return this->getEncoderCounts() <= uBound && this->getEncoderCounts() >=lBound; - // Otherwise, check if the value is outside either bound and negate the response - return this->getEncoderCounts() <= uBound || this->getEncoderCounts() >= lBound; -} - -/// Current tolerance is ±0.1 degree w.r.t. the current number of counts per rotation -auto ArmMotor::hasReachedTarget(uint32_t targetCounts) const -> bool{ - return ArmMotor::hasReachedTarget(targetCounts, ArmMotor::TOLERANCE_RATIO * static_cast(std::abs(this->COUNTS_PER_ROTATION))); -} - -auto ArmMotor::getMotorState() const -> MotorState{ - return this->currState; -} - -void ArmMotor::setPower(float power){ - this->setPower(power, power == 0.F ? MotorState::STOP : MotorState::MOVING); -} - -/// This method auto-publishes the speed command to the WRoboclaws -void ArmMotor::setPower(float power, MotorState state){ - // Check the bounds of the parameter - if(abs(power) > 1) throw std::invalid_argument{std::string{"Power "} + std::to_string(power) + " is not on the interval [-1, 1]"}; - - // Set up and send the speed message - this->power = power; - this->powerMsg.data = power * INT16_MAX; - this->speedPub.publish(this->powerMsg); - // Update the cur.nt motor state based on the power command input - this->currState = state; -} - -void ArmMotor::runToTarget(uint32_t targetCounts, float power, bool block){ - this->target = targetCounts; - this->maxPower = power; - // If we are not at our target... - if(!this->hasReachedTarget(targetCounts)){ - // std::cout << "has not reached target" << std::endl; - // Set the power in the correct direction and continue running to the target - this->currState = MotorState::RUN_TO_TARGET; - std_msgs::Float64 setpointMsg; - setpointMsg.data = ArmMotor::encToRad(targetCounts); - this->targetPub.publish(setpointMsg); - - // long int direction = targetCounts - this->getEncoderCounts(); - // power = abs(power) * (corrMod(direction, ((long int)this->COUNTS_PER_ROTATION)) < corrMod(-direction, ((long int)this->COUNTS_PER_ROTATION)) ? 1 : -1); - this->setPower(power, MotorState::RUN_TO_TARGET); - - // Otherwise, stop the motor - } else { - // std::cout << "has reached target" << std::endl; - this->setPower(0.F, MotorState::STOP); - } - // If this is a blocking call... - if(block){ - // Wait until the motor has reached the target, then stop - while(!this->hasReachedTarget(targetCounts)); - this->setPower(0.F, MotorState::RUN_TO_TARGET); - } -} - -void ArmMotor::runToTarget(double rads, float power){ - // std::cout << "run to target: " << rads << ":" << this->radToEnc(rads) << ":" << this->getEncoderCounts() << std::endl; - - runToTarget(this->radToEnc(rads), power, false); -} - -auto ArmMotor::getMotorName() const -> std::string{ - return this->motorName; -} - -auto ArmMotor::getMotorID() const -> unsigned int{ - return this->motorID; -} - -auto ArmMotor::getControllerID() const -> unsigned int{ - return this->controllerID; -} - -auto ArmMotor::getPower() const -> float{ - return this->power; -} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/ArmMotor.hpp b/src/wr_control_drive_arm/src/ArmMotor.hpp deleted file mode 100644 index ba4d2120..00000000 --- a/src/wr_control_drive_arm/src/ArmMotor.hpp +++ /dev/null @@ -1,242 +0,0 @@ -/** - * @file ArmMotor.hpp - * @author Ben Nowotny - * @brief Header file of the ArmMotor class - * @date 2021-04-05 - */ - -#include -#include "ros/ros.h" -#include "std_msgs/UInt32.h" -#include "std_msgs/Int16.h" -#include "std_msgs/Float64.h" -#include "std_msgs/Bool.h" -#include -#include - -/** - * @brief An enumeration of states for a motor to be in. - */ -enum class MotorState{ - /// A Motor is stopped (not moving, 0 power command) - STOP, - /// A Motor is moving (non-0 power command) - MOVING, - /// A Motor is running to a given target - RUN_TO_TARGET, - /// A Motor is stalling (over safety current limit) - STALLING -}; -/** - * @brief A way to control arm motors with WRoboclaw - */ -class ArmMotor{ - private: - /// Time tolerance of over-current detection before a stall fault is triggered - static constexpr float STALL_THRESHOLD_TIME = 0.5; - /// Tolerance ratio w.r.t the counts per rotation for encoder run-to-position motion - static constexpr double TOLERANCE_RATIO = 0.1/360; - /// Size of ROS Topic message caches - static constexpr uint32_t MESSAGE_CACHE_SIZE = 10; - /// The number of encoder counts per rotation - int64_t const COUNTS_PER_ROTATION; - /// The upper and lower bounds of encoder rotation for absolute encoders (index 0 is lower, index 1 is upper) - std::array const ENCODER_BOUNDS; - /// zero position of motor - int64_t const ENCODER_OFFSET; - /// The current state of the motor - std::atomic currState; - /// The joint name of the current motor - std::string motorName; - /// The ID of the WRoboclaw controller - unsigned int controllerID; - /// The ID of the motor within the WRoboclaw controller - unsigned int motorID; - /// The current encoder value - uint32_t encoderVal; - /// Target encoder counts for run to target - uint32_t target; - /// The ROS Subscriber that reads the encoders - ros::Subscriber encRead; - /// The ROS Publisher that sets the encoder targets - ros::Publisher targetPub; - /// The ROS Publisher that sets encoder feedback data - ros::Publisher feedbackPub; - /// The ROS Subscriber that reads controlled output data - ros::Subscriber outputRead; - /// The ROS Publisher that publishes motor speed commands - ros::Publisher speedPub; - /// The most recent power message sent - std_msgs::Int16 powerMsg; - /// The ROS Subscriber that reads stall status data - ros::Subscriber stallRead; - /// The time when the motor began stalling - ros::Time beginStallTime; - /// Motor power - float power; - /// Maximum absolute motor power in RUN_TO_POSITION mode. - std::atomic maxPower; - - /** - * @brief A static conversion from radians to encoder counts - * - * @param rad The input number of radians - * @return uint32_t The corresponding encoder count bounded by ENCODER_BOUNDS - */ - auto radToEnc(double rad) const -> uint32_t; - - /** - * @brief A static conversion from encoder counts to radians - * - * @param enc The input number of encoder counts - * @return double The corresponding radian measure - */ - auto encToRad(uint32_t enc) const -> double; - - /** - * @brief Subscriber callback for encRead, captures the encoder value of the current motor - * - * @param msg The encoder value message as captured by encRead - */ - void storeEncoderVals(const std_msgs::UInt32::ConstPtr& msg); - - /** - * @brief Subscriber callback for outputRead, captures the PID output and sets the speed directly - * - * @param msg The PID output as captured by outputRead - */ - void redirectPowerOutput(const std_msgs::Float64::ConstPtr& msg); - - /** - * @brief Subscriber callback for stallRead, captures the stall status of the current motor - * - * @param msg The stall status of the current motor - */ - void storeStallStatus(const std_msgs::Bool::ConstPtr& msg); - - void setPower(float power, MotorState state); - - /** - * @brief Performs Euclidean correct modulus between two inputs of the same type - * - * @param i The dividend of the modulus - * @param j The divisor of the modulus - * @return double The Euclidean-correct remainder bounded on [0, j) - */ - static auto corrMod(double i, double j) -> double; - - public: - /** - * @brief Constructs a new ArmMotor - * - * @param motorName The joint name of the motor - * @param controllerID The WRoboclaw controller ID for this motor - * @param motorID The motor ID within its WRoboclaw controller - * @param n A NodeHandle reference to the constructing Node - */ - ArmMotor(std::string motorName, unsigned int controllerID, unsigned int motorID, int64_t countsPerRotation, int64_t offset, ros::NodeHandle &n); - - /** - * @brief Gets the encoder value of the motor - * - * @return uint32_t The current encoder value of the motor - */ - auto getEncoderCounts() const -> uint32_t; - - /** - * @brief Sends the motor to run to a target encoder value at a given power without blocking - * - * @param targetCounts The target encoder value for the motor - * @param power The power to move the motor at (Bounded between [-1, 1]) - */ - void runToTarget(uint32_t targetCounts, float power); - - /** - * @brief Sends the motor to run to a target encoder value at a given power - * - * @param targetCounts The target encoder value for the motor - * @param power The power to move the motor at (Bounded between [-1, 1]) - * @param block Specifies whether or not this action should block until it is complete - * @return True if the motor had stalled, and false otherwise - */ - void runToTarget(uint32_t targetCounts, float power, bool block); - - /** - * @brief Sends the motor to run to a specified position at a given power - * - * @param rads The position to send the motor to (specified in radians) - * @param power The power to move the motor at (Bounded between [-1, 1]) - * @return True if the motor had stalled, and false otherwise - */ - void runToTarget(double rads, float power); - - /** - * @brief Get the current state of the ArmMotor - * - * @return MotorState The current state of the ArmMotor - */ - auto getMotorState() const -> MotorState; - - /** - * @brief Set the motor power - * - * @param power The power to set the motor at (Bounded between [-1, 1]) - */ - void setPower(float power); - - /** - * @brief Get the radian measure of the current motor - * - * @return double The radian measure of the current motor's position - */ - auto getRads() const -> double; - - /** - * @brief Get the name of the ArmMotor - * - * @return std::string The name of the ArmMotor - */ - auto getMotorName() const -> std::string; - - /** - * @brief Get the name of the ArmMotor - * - * @return std::string The controller ID of the ArmMotor - */ - auto getControllerID() const -> unsigned int; - - /** - * @brief Get the name of the ArmMotor - * - * @return std::string The motor ID of the ArmMotor - */ - auto getMotorID() const -> unsigned int; - - - /** - * @brief Checks if the motor is currently within a pre-specified tolerance of a target - * - * @param targetCounts The target to test against - * @return true The motor was within the target tolerance - * @return false The motor was outside of the target tolerance - */ - auto hasReachedTarget(uint32_t targetCounts) const -> bool; - - /** - * @brief Checks if the motor is currently within a given tolerance of a target - * - * @param targetCounts The target to test against - * @param tolerance The tolerance to give when testing the target - * @return true The motor was within the target tolerance - * @return false The motor was outside the target tolerance - */ - auto hasReachedTarget(uint32_t targetCounts, uint32_t tolerance) const -> bool; - - /** - * @brief Get the most recently set motor power - * - * @return float Last motor power setting - */ - auto getPower() const -> float; -}; - diff --git a/src/wr_control_drive_arm/src/DifferentialJoint.cpp b/src/wr_control_drive_arm/src/DifferentialJoint.cpp deleted file mode 100644 index 85c3c1c7..00000000 --- a/src/wr_control_drive_arm/src/DifferentialJoint.cpp +++ /dev/null @@ -1,128 +0,0 @@ -/** - * @file DifferentialJoint.cpp - * @author Nicholas Underwood - * @brief Header file of the DifferentialJoint class - * @date 2021-10-25 - */ - -#include "DifferentialJoint.hpp" -#include -using std::vector; - -constexpr std::array, 2> DifferentialJoint::MOTOR_TO_JOINT_MATRIX; -constexpr std::array, 2> DifferentialJoint::JOINT_TO_MOTOR_MATRIX; - -DifferentialJoint::DifferentialJoint(std::unique_ptr leftMotor, std::unique_ptr rightMotor, ros::NodeHandle &n, - const std::string &pitchTopicName, const std::string &rollTopicName, - const std::string &leftTopicName, const std::string &rightTopicName) - : AbstractJoint(n, DEGREES_OF_FREEDOM) { - this->motors.at(0) = {std::move(leftMotor), 0, 0, "", "", false}; - this->motors.at(1) = {std::move(rightMotor), 0, 0, "", "", false}; - - this->pitchOutputSubscriber = n.subscribe(pitchTopicName + "/output", MESSAGE_CACHE_SIZE, &DifferentialJoint::handoffPitchOutput, this); - this->rollOutputSubscriber = n.subscribe(rollTopicName + "/output", MESSAGE_CACHE_SIZE, &DifferentialJoint::handoffRollOutput, this); - this->leftOutputPublisher = n.advertise(leftTopicName + "/output", MESSAGE_CACHE_SIZE); - this->rightOutputPublisher = n.advertise(rightTopicName + "/output", MESSAGE_CACHE_SIZE); - this->leftFeedbackSubscriber = n.subscribe(leftTopicName + "/feeback", MESSAGE_CACHE_SIZE, &DifferentialJoint::handoffLeftFeedback, this); - this->rightFeedbackSubscriber = n.subscribe(rightTopicName + "/feeback", MESSAGE_CACHE_SIZE, &DifferentialJoint::handoffRightFeedback, this); - this->pitchFeedbackPublisher = n.advertise(pitchTopicName + "/feedback", MESSAGE_CACHE_SIZE); - this->rollFeedbackPublisher = n.advertise(rollTopicName + "/feedback", MESSAGE_CACHE_SIZE); -} - -auto DifferentialJoint::getJointPositions(const vector &motorPositions) -> vector{ - // vector positions; - // target->reserve(2); - - double pitch = motorPositions.at(0) * MOTOR_TO_JOINT_MATRIX.at(0).at(0) + motorPositions.at(1) * MOTOR_TO_JOINT_MATRIX.at(0).at(1); - double roll = motorPositions.at(0) * MOTOR_TO_JOINT_MATRIX.at(1).at(0) + motorPositions.at(1) * MOTOR_TO_JOINT_MATRIX.at(1).at(1); - - //TODO: Why not return a new vector? Wouldn't this constant resizing be more inefficient than just making/returning a new vector via copy ellision? - return {pitch, roll}; - - // return positions; -} - -auto DifferentialJoint::getMotorPositions(const vector &jointPositions) -> vector{ - - // std::unique_ptr> positions = std::make_unique>(2); - // target->reserve(2); - - double left = jointPositions.at(0) * JOINT_TO_MOTOR_MATRIX.at(0).at(0) + jointPositions.at(1) * JOINT_TO_MOTOR_MATRIX.at(0).at(1); - double right = jointPositions.at(0) * JOINT_TO_MOTOR_MATRIX.at(1).at(0) + jointPositions.at(1) * JOINT_TO_MOTOR_MATRIX.at(1).at(1); - - return {left, right}; - - // return std::move(positions); -} - -auto DifferentialJoint::getMotorVelocities(const vector &jointPositions) -> vector{ - return getMotorPositions(jointPositions); //deritivate of linear transformation is itself -} - -void DifferentialJoint::handoffPitchOutput(const std_msgs::Float64::ConstPtr &msg){ - this->cachedPitchOutput = msg->data; - this->hasNewPitchOutput = true; - handOffAllOutput(); -} -void DifferentialJoint::handoffRollOutput(const std_msgs::Float64::ConstPtr &msg){ - this->cachedRollOutput = msg->data; - this->hasNewRollOutput = true; - handOffAllOutput(); -} - -// TODO: Do these ouputs need to be synced? We're just referring to the motors individually, maybe we can transform and send the data right away -void DifferentialJoint::handOffAllOutput(){ - if(!this->hasNewPitchOutput || !this->hasNewRollOutput){ return; } - - vector outputs; - outputs.resize(2); - outputs.at(0) = this->cachedPitchOutput; - outputs.at(1) = this->cachedRollOutput; - //TODO: Still confused as to the purpose of this family of functions - outputs = getMotorVelocities(outputs); - - std_msgs::Float64 msg1; - std_msgs::Float64 msg2; - msg1.data = outputs.at(0); - msg2.data = outputs.at(1); - pitchFeedbackPublisher.publish(msg1); - rollFeedbackPublisher.publish(msg2); - - leftOutputPublisher.publish(msg1); - rightOutputPublisher.publish(msg2); - - this->hasNewPitchOutput = false; - this->hasNewRollOutput = false; - -} - -void DifferentialJoint::handoffRightFeedback(const std_msgs::Float64::ConstPtr &msg){ - this->cachedRightFeedback = msg->data; - this->hasNewRightFeedback = true; - handOffAllFeedback(); -} -void DifferentialJoint::handoffLeftFeedback(const std_msgs::Float64::ConstPtr &msg){ - this->cachedLeftFeedback = msg->data; - this->hasNewLeftFeedback = true; - handOffAllFeedback(); -} - -void DifferentialJoint::handOffAllFeedback(){ - if(!this->hasNewLeftFeedback || !this->hasNewRightFeedback){ return; } - - vector outputs; - outputs.at(0) = this->cachedLeftFeedback; - outputs.at(1) = this->cachedRightFeedback; - outputs = getMotorVelocities(outputs); - - std_msgs::Float64 msg1; - std_msgs::Float64 msg2; - msg1.data = outputs.at(0); - msg2.data = outputs.at(1); - pitchFeedbackPublisher.publish(msg1); - rollFeedbackPublisher.publish(msg2); - - this->hasNewLeftFeedback = false; - this->hasNewRightFeedback = false; - -} diff --git a/src/wr_control_drive_arm/src/DifferentialJoint.hpp b/src/wr_control_drive_arm/src/DifferentialJoint.hpp deleted file mode 100644 index 7bfaec4f..00000000 --- a/src/wr_control_drive_arm/src/DifferentialJoint.hpp +++ /dev/null @@ -1,56 +0,0 @@ -/** - * @file DifferentialJoint.hpp - * @author Nichols Underwood - * @brief Header file of the DifferentialJoint class - * @date 2021-10-25 - */ - -#include "AbstractJoint.hpp" - -class DifferentialJoint : public AbstractJoint { - public: - DifferentialJoint(std::unique_ptr leftMotor, std::unique_ptr rightMotor, ros::NodeHandle &n, - const std::string &pitchTopicName, const std::string &rollTopicName, - const std::string &leftTopicName, const std::string &rightTopicName); - - auto getMotorPositions(const vector &jointPositions) -> vector override; - auto getMotorVelocities(const vector &jointVelocities) -> vector override; - auto getJointPositions(const vector &motorPositions) -> vector override; - - private: - static constexpr uint32_t DEGREES_OF_FREEDOM = 2; - static constexpr uint32_t MESSAGE_CACHE_SIZE = 10; - // linear transformations works for position and velocity - // [0.5 0.5] [left motor ] [pitch] - // [ -1 1 ] * [right motor] = [roll ] - // double motorToJointMatrix[2][2] = {{0.5, 0.5}, {-1, 1}}; - static constexpr std::array, 2> MOTOR_TO_JOINT_MATRIX{{{1, 0}, {0, 1}}}; - // [1 -0.5] [pitch] [left motor ] - // [1 0.5] * [roll ] = [right motor] - // double jointToMotorMatrix[2][2] = {{1, 0.5}, {1, -0.5}}; - static constexpr std::array, 2> JOINT_TO_MOTOR_MATRIX{{{1, 0}, {0, 1}}}; - - void handoffPitchOutput(const std_msgs::Float64::ConstPtr&); - void handoffRollOutput(const std_msgs::Float64::ConstPtr&); - void handOffAllOutput(); - ros::Subscriber pitchOutputSubscriber; - ros::Subscriber rollOutputSubscriber; - ros::Publisher leftOutputPublisher; - ros::Publisher rightOutputPublisher; - float cachedPitchOutput = 0.0; - float cachedRollOutput = 0.0; - bool hasNewPitchOutput = false; - bool hasNewRollOutput = false; - - void handoffLeftFeedback(const std_msgs::Float64::ConstPtr&); - void handoffRightFeedback(const std_msgs::Float64::ConstPtr&); - void handOffAllFeedback(); - ros::Subscriber leftFeedbackSubscriber; - ros::Subscriber rightFeedbackSubscriber; - ros::Publisher pitchFeedbackPublisher; - ros::Publisher rollFeedbackPublisher; - float cachedLeftFeedback = 0.0; - float cachedRightFeedback = 0.0; - bool hasNewLeftFeedback = false; - bool hasNewRightFeedback = false; -}; \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/DifferentialJointToMotorSpeedConverter.cpp b/src/wr_control_drive_arm/src/DifferentialJointToMotorSpeedConverter.cpp new file mode 100644 index 00000000..dfe28450 --- /dev/null +++ b/src/wr_control_drive_arm/src/DifferentialJointToMotorSpeedConverter.cpp @@ -0,0 +1,43 @@ +#include "DifferentialJointToMotorSpeedConverter.hpp" +#include + +DifferentialJointToMotorSpeedConverter::DifferentialJointToMotorSpeedConverter( + std::shared_ptr leftMotor, + std::shared_ptr rightMotor) + : cachedPitchSpeed{0}, + cachedRollSpeed{0}, + leftMotor{std::move(leftMotor)}, + rightMotor{std::move(rightMotor)} {} + +DifferentialJointToMotorSpeedConverter::DifferentialJointToMotorSpeedConverter( + const DifferentialJointToMotorSpeedConverter &other) + : cachedPitchSpeed{other.cachedPitchSpeed.load()}, + cachedRollSpeed{other.cachedRollSpeed.load()}, + leftMotor{other.leftMotor}, + rightMotor{other.rightMotor} {} + +DifferentialJointToMotorSpeedConverter::DifferentialJointToMotorSpeedConverter( + DifferentialJointToMotorSpeedConverter &&other) noexcept + : cachedPitchSpeed{other.cachedPitchSpeed.load()}, + cachedRollSpeed{other.cachedRollSpeed.load()}, + leftMotor{other.leftMotor}, + rightMotor{other.rightMotor} {} + +void DifferentialJointToMotorSpeedConverter::setPitchSpeed(double speed) { + cachedPitchSpeed = speed; + dispatchDifferentialSpeed(); +} + +void DifferentialJointToMotorSpeedConverter::setRollSpeed(double speed) { + cachedRollSpeed = speed; + dispatchDifferentialSpeed(); +} + +void DifferentialJointToMotorSpeedConverter::dispatchDifferentialSpeed() { + // const std::lock_guard guard{mutex}; + auto m1Speed{-cachedPitchSpeed + (cachedRollSpeed * AVERAGE_SCALING_FACTOR)}; + auto m2Speed{-cachedPitchSpeed - (cachedRollSpeed * AVERAGE_SCALING_FACTOR)}; + leftMotor->setSpeed(m1Speed); + rightMotor->setSpeed(m2Speed); + // std::cout << "ptch: " << cachedPitchSpeed.load() << "\troll: " << cachedRollSpeed.load() << "\tlspd: " << m1Speed << "\trspd: " << m2Speed << std::endl; +} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/DifferentialJointToMotorSpeedConverter.hpp b/src/wr_control_drive_arm/src/DifferentialJointToMotorSpeedConverter.hpp new file mode 100644 index 00000000..5d096add --- /dev/null +++ b/src/wr_control_drive_arm/src/DifferentialJointToMotorSpeedConverter.hpp @@ -0,0 +1,31 @@ +#ifndef DIFFERENTIAL_JOINT_TO_MOTOR_SPEED_CONVERTER_H +#define DIFFERENTIAL_JOINT_TO_MOTOR_SPEED_CONVERTER_H + +#include "Motor.hpp" + +class DifferentialJointToMotorSpeedConverter { +public: + DifferentialJointToMotorSpeedConverter(std::shared_ptr leftMotor, std::shared_ptr rightMotor); + void setPitchSpeed(double speed); + void setRollSpeed(double speed); + + DifferentialJointToMotorSpeedConverter(const DifferentialJointToMotorSpeedConverter &); + auto operator=(const DifferentialJointToMotorSpeedConverter &) -> DifferentialJointToMotorSpeedConverter & = delete; + DifferentialJointToMotorSpeedConverter(DifferentialJointToMotorSpeedConverter &&) noexcept; + auto operator=(DifferentialJointToMotorSpeedConverter &&) -> DifferentialJointToMotorSpeedConverter & = delete; + ~DifferentialJointToMotorSpeedConverter() = default; + +private: + std::atomic cachedPitchSpeed; + std::atomic cachedRollSpeed; + std::recursive_mutex mutex; + + const std::shared_ptr leftMotor; + const std::shared_ptr rightMotor; + + static constexpr double AVERAGE_SCALING_FACTOR{1}; + + void dispatchDifferentialSpeed(); +}; + +#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/DirectJointToMotorSpeedConverter.cpp b/src/wr_control_drive_arm/src/DirectJointToMotorSpeedConverter.cpp new file mode 100644 index 00000000..67fd0568 --- /dev/null +++ b/src/wr_control_drive_arm/src/DirectJointToMotorSpeedConverter.cpp @@ -0,0 +1,18 @@ +#include "DirectJointToMotorSpeedConverter.hpp" + +DirectJointToMotorSpeedConverter::DirectJointToMotorSpeedConverter(std::shared_ptr outputMotor, MotorSpeedDirection direction) + : outputMotor{std::move(outputMotor)}, + direction{direction} {} + +void DirectJointToMotorSpeedConverter::operator()(double speed) { + double actualSpeed{0}; // In event of enum error, stop the motor + switch (direction) { + case MotorSpeedDirection::FORWARD: + actualSpeed = speed; + break; + case MotorSpeedDirection::REVERSE: + actualSpeed = -speed; + break; + } + outputMotor->setSpeed(actualSpeed); +} diff --git a/src/wr_control_drive_arm/src/DirectJointToMotorSpeedConverter.hpp b/src/wr_control_drive_arm/src/DirectJointToMotorSpeedConverter.hpp new file mode 100644 index 00000000..6a117435 --- /dev/null +++ b/src/wr_control_drive_arm/src/DirectJointToMotorSpeedConverter.hpp @@ -0,0 +1,28 @@ +#ifndef DIRECT_JOINT_TO_MOTOR_SPEED_CONVERTER_H +#define DIRECT_JOINT_TO_MOTOR_SPEED_CONVERTER_H + +#include "Motor.hpp" +#include + +enum class MotorSpeedDirection { + FORWARD, + REVERSE +}; + +class DirectJointToMotorSpeedConverter { +public: + DirectJointToMotorSpeedConverter(std::shared_ptr outputMotor, MotorSpeedDirection direction); + void operator()(double speed); + + DirectJointToMotorSpeedConverter(const DirectJointToMotorSpeedConverter &) = default; + auto operator=(const DirectJointToMotorSpeedConverter &) -> DirectJointToMotorSpeedConverter & = delete; + DirectJointToMotorSpeedConverter(DirectJointToMotorSpeedConverter &&) = default; + auto operator=(DirectJointToMotorSpeedConverter &&) -> DirectJointToMotorSpeedConverter & = delete; + ~DirectJointToMotorSpeedConverter() = default; + +private: + const MotorSpeedDirection direction; + const std::shared_ptr outputMotor; +}; + +#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/Joint.cpp b/src/wr_control_drive_arm/src/Joint.cpp new file mode 100644 index 00000000..08b7c8a3 --- /dev/null +++ b/src/wr_control_drive_arm/src/Joint.cpp @@ -0,0 +1,72 @@ +#include "Joint.hpp" +#include "MathUtil.hpp" +#include +#include + +using std::literals::string_literals::operator""s; +using MathUtil::RADIANS_PER_ROTATION; + +Joint::Joint(std::string name, + std::function positionMonitor, + std::function motorSpeedDispatcher, + ros::NodeHandle node) + : name{std::move(name)}, + positionMonitor{std::move(positionMonitor)}, + motorSpeedDispatcher{std::move(motorSpeedDispatcher)}, + executeMotion{false}, + controlLoopUpdateTimer{node.createTimer(ros::Rate{FEEDBACK_UPDATE_FREQUENCY_HZ}, &Joint::onFeedbackUpdateEvent, this, false, false)}, + controlLoopOutputSubscriber{node.subscribe("/control/arm/pid/"s + this->name + "/output", 1, &Joint::onControlLoopOutput, this)}, + controlLoopSetpointPublisher{node.advertise("/control/arm/pid/"s + this->name + "/setpoint", 1)}, + controlLoopFeedbackPublisher{node.advertise("/control/arm/pid/"s + this->name + "/feedback", 1)} {} + +void Joint::setTarget(double target, double maxSpeed) { + this->target = target; + this->maxSpeed = maxSpeed; + executeMotion = true; + controlLoopUpdateTimer.start(); +} + +auto Joint::hasReachedTarget() const -> bool { + // Copy-on-read to avoid inconsistencies on asynchronous change + auto currentTarget = target.load(); + + // Compute the upper and lower bounds in the finite encoder space + auto lBound = MathUtil::corrMod(currentTarget - JOINT_TOLERANCE_RADIANS, RADIANS_PER_ROTATION); + auto uBound = MathUtil::corrMod(currentTarget + JOINT_TOLERANCE_RADIANS, RADIANS_PER_ROTATION); + auto position = MathUtil::corrMod(positionMonitor(), RADIANS_PER_ROTATION); + // If the computed lower bound is lower than the upper bound, perform the computation normally + if (lBound < uBound) + return position <= uBound && position >= lBound; + // Otherwise, check if the value is outside either bound and negate the response + return position <= uBound || position >= lBound; +} + +auto Joint::getName() const -> std::string { + return name; +} + +void Joint::stop() { + executeMotion = false; + controlLoopUpdateTimer.stop(); + motorSpeedDispatcher(0); +} + +void Joint::onControlLoopOutput(const std_msgs::Float64::ConstPtr &msg) { + auto cappedPowerUnsigned{std::min(std::abs(msg->data), std::abs(maxSpeed))}; + double cappedPower{0}; + if (msg->data != 0) + cappedPower = (std::abs(msg->data) / msg->data) * cappedPowerUnsigned; + motorSpeedDispatcher(executeMotion ? cappedPower : 0); +} + +void Joint::onFeedbackUpdateEvent(const ros::TimerEvent &event) { + // Setpoint + std_msgs::Float64 setpointMsg; + setpointMsg.data = target; + controlLoopSetpointPublisher.publish(setpointMsg); + + // Feedback + std_msgs::Float64 feedbackMsg; + feedbackMsg.data = positionMonitor(); + controlLoopFeedbackPublisher.publish(feedbackMsg); +} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/Joint.hpp b/src/wr_control_drive_arm/src/Joint.hpp new file mode 100644 index 00000000..659a4f98 --- /dev/null +++ b/src/wr_control_drive_arm/src/Joint.hpp @@ -0,0 +1,39 @@ +#ifndef JOINT_H +#define JOINT_H + +#include "ros/publisher.h" +#include "ros/subscriber.h" +#include "ros/timer.h" +#include "std_msgs/Float64.h" +#include +#include + +class Joint { +public: + explicit Joint(std::string name, std::function positionMonitor, std::function motorSpeedDispatcher, ros::NodeHandle node); + void setTarget(double target, double maxSpeed); + [[nodiscard]] auto hasReachedTarget() const -> bool; + [[nodiscard]] auto getName() const -> std::string; + void stop(); + +private: + static constexpr double FEEDBACK_UPDATE_FREQUENCY_HZ{50}; + static constexpr double JOINT_TOLERANCE_RADIANS{3 * M_PI / 180}; + + const std::string name; + const std::function positionMonitor; + const std::function motorSpeedDispatcher; + + void onControlLoopOutput(const std_msgs::Float64::ConstPtr &msg); + void onFeedbackUpdateEvent(const ros::TimerEvent &event); + + std::atomic target; + std::atomic maxSpeed; + std::atomic executeMotion; + ros::Timer controlLoopUpdateTimer; + ros::Subscriber controlLoopOutputSubscriber; + ros::Publisher controlLoopSetpointPublisher; + ros::Publisher controlLoopFeedbackPublisher; +}; + +#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/JointStatePublisher.cpp b/src/wr_control_drive_arm/src/JointStatePublisher.cpp new file mode 100644 index 00000000..3a602563 --- /dev/null +++ b/src/wr_control_drive_arm/src/JointStatePublisher.cpp @@ -0,0 +1,140 @@ +/** + * @file JointStatePublisher.cpp + * @author Ben Nowotny + * @author Jack Zautner + * @brief The executable file to run the joint state publisher + * @date 2022-12-05 + */ + +#include "SingleEncoderJointPositionMonitor.hpp" +#include "XmlRpcValue.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +using XmlRpc::XmlRpcValue; + +/** + * @brief Nessage cache size of publisher + */ +constexpr std::uint32_t MESSAGE_CACHE_SIZE = 1; + +/** + * @brief Period between timer callback + */ +constexpr float TIMER_CALLBACK_DURATION = 1.0 / 50.0; + +/** + * @brief The joint state publisher for MoveIt + */ +ros::Publisher jointStatePublisher; + +std::map namedJointPositionMonitors; + +void publishJointStates(const ros::TimerEvent &event) { + std::vector names; + std::vector positions; + sensor_msgs::JointState js_msg; + + for (auto &[name, monitor] : namedJointPositionMonitors) { + names.push_back(name); + positions.push_back(monitor()); + } + + js_msg.name = names; + js_msg.position = positions; + js_msg.header.stamp = ros::Time::now(); + // Publish the Joint State message + jointStatePublisher.publish(js_msg); +} + +auto getEncoderConfigFromParams(const XmlRpcValue ¶ms, const std::string &jointName) -> EncoderConfiguration { + return {.countsPerRotation = static_cast(params[jointName]["encoder_parameters"]["counts_per_rotation"]), + .offset = static_cast(params[jointName]["encoder_parameters"]["offset"])}; +} + +auto getMotorConfigFromParams(const XmlRpcValue ¶ms, const std::string &jointName) -> MotorConfiguration { + return {.gearRatio = static_cast(params[jointName]["motor_configurations"]["gear_ratio"])}; +} + +/** + * @brief The main executable method of the node. Starts the ROS node + * + * @param argc The number of program arguments + * @param argv The given program arguments + * @return int The status code on exiting the program + */ +auto main(int argc, char **argv) -> int { + + std::cout << "start main" << std::endl; + // // Initialize the current node as JointStatePublisherApplication + ros::init(argc, argv, "JointStatePublisher"); + // // Create the NodeHandle to the current ROS node + ros::NodeHandle n; + ros::NodeHandle pn{"~"}; + + XmlRpcValue armParams; + pn.getParam("arm_parameters", armParams); + + namedJointPositionMonitors.try_emplace("elbowPitch_joint", + + "aux1", + RoboclawChannel::A, + getEncoderConfigFromParams(armParams, "elbow"), + getMotorConfigFromParams(armParams, "elbow"), + n); + namedJointPositionMonitors.try_emplace("elbowRoll_joint", + + "aux1", + RoboclawChannel::B, + getEncoderConfigFromParams(armParams, "forearmRoll"), + getMotorConfigFromParams(armParams, "forearmRoll"), + n); + namedJointPositionMonitors.try_emplace("shoulder_joint", + + "aux0", + RoboclawChannel::B, + getEncoderConfigFromParams(armParams, "shoulder"), + getMotorConfigFromParams(armParams, "shoulder"), + n); + namedJointPositionMonitors.try_emplace("turntable_joint", + + "aux0", + RoboclawChannel::A, + getEncoderConfigFromParams(armParams, "turntable"), + getMotorConfigFromParams(armParams, "turntable"), + n); + namedJointPositionMonitors.try_emplace("wristPitch_joint", + + "aux2", + RoboclawChannel::A, + getEncoderConfigFromParams(armParams, "wristPitch"), + getMotorConfigFromParams(armParams, "wristPitch"), + n); + namedJointPositionMonitors.try_emplace("wristRoll_link", + "aux2", + RoboclawChannel::B, + getEncoderConfigFromParams(armParams, "wristRoll"), + getMotorConfigFromParams(armParams, "wristRoll"), + n); + + // Initialize the Joint State Data Publisher + jointStatePublisher = n.advertise("/joint_states", MESSAGE_CACHE_SIZE); + + // Timer that will call publishJointStates periodically + ros::Timer timer = n.createTimer(ros::Duration(TIMER_CALLBACK_DURATION), publishJointStates); + + // Enter ROS spin + ros::spin(); + + return 0; +} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/MathUtil.cpp b/src/wr_control_drive_arm/src/MathUtil.cpp new file mode 100644 index 00000000..682b0bad --- /dev/null +++ b/src/wr_control_drive_arm/src/MathUtil.cpp @@ -0,0 +1,8 @@ +#include "MathUtil.hpp" +#include + +namespace MathUtil { +auto corrMod(double dividend, double divisor) -> double { + return std::fmod(std::fmod(dividend, divisor) + divisor, std::abs(divisor)); +} +} // namespace MathUtil \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/MathUtil.hpp b/src/wr_control_drive_arm/src/MathUtil.hpp new file mode 100644 index 00000000..07e7b0d0 --- /dev/null +++ b/src/wr_control_drive_arm/src/MathUtil.hpp @@ -0,0 +1,11 @@ +#ifndef MATH_UTIL_H +#define MATH_UTIL_H + +#include + +namespace MathUtil { +auto corrMod(double dividend, double divisor) -> double; +static constexpr double RADIANS_PER_ROTATION{2 * M_PI}; +} // namespace MathUtil + +#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/Motor.cpp b/src/wr_control_drive_arm/src/Motor.cpp new file mode 100644 index 00000000..bc96cd0f --- /dev/null +++ b/src/wr_control_drive_arm/src/Motor.cpp @@ -0,0 +1,45 @@ +#include "Motor.hpp" +#include "RoboclawChannel.hpp" +#include "ros/node_handle.h" +#include "ros/time.h" +#include "std_msgs/Int16.h" +#include +#include +#include +#include + +using std::literals::string_literals::operator""s; + +Motor::Motor(const std::string &controllerName, RoboclawChannel channel, ros::NodeHandle node) + : motorSpeedPublisher{ + node.advertise( + "/hsi/roboclaw/"s + controllerName + "/cmd/"s + (channel == RoboclawChannel::A ? "left" : "right"), + 1)}, + currentOverLimitSubscriber{ + node.subscribe("/hsi/roboclaw/"s + controllerName + "/curr/over_lim/" + (channel == RoboclawChannel::A ? "left" : "right"), + OVER_CURRENT_QUEUE_SIZE, &Motor::setCurrentStatus, this)} {} + +void Motor::setSpeed(double speed) { + if (abs(speed) > 1) + throw std::invalid_argument("speed must be between -1 and 1"); + + std_msgs::Int16 powerMsg{}; + powerMsg.data = static_cast(speed * INT16_MAX); + motorSpeedPublisher.publish(powerMsg); +} + +void Motor::setCurrentStatus(const std_msgs::Bool::ConstPtr &msg) { + bool overCurrent = static_cast(msg->data); + if (overCurrent && !this->beginStallTime.has_value()) { + this->beginStallTime = ros::Time::now(); + } else if (!overCurrent && this->beginStallTime.has_value()) { + this->beginStallTime = std::nullopt; + } +} + +auto Motor::isOverCurrent() const -> bool { + if (this->beginStallTime.has_value()) { + return static_cast((ros::Time::now() - this->beginStallTime.value()).toSec() >= STALL_THRESHOLD_TIME); + } + return false; +} diff --git a/src/wr_control_drive_arm/src/Motor.hpp b/src/wr_control_drive_arm/src/Motor.hpp new file mode 100644 index 00000000..ff3a6174 --- /dev/null +++ b/src/wr_control_drive_arm/src/Motor.hpp @@ -0,0 +1,30 @@ +#ifndef MOTOR_H +#define MOTOR_H + +#include "RoboclawChannel.hpp" +#include "ros/publisher.h" +#include "ros/subscriber.h" +#include "std_msgs/Bool.h" +#include +#include + +class Motor { +public: + Motor(const std::string &controllerName, RoboclawChannel channel, ros::NodeHandle node); + void setSpeed(double speed); + auto isOverCurrent() const -> bool; + +private: + + static constexpr float STALL_THRESHOLD_TIME{0.5F}; + static constexpr int OVER_CURRENT_QUEUE_SIZE{25}; + + + void setCurrentStatus(const std_msgs::Bool::ConstPtr &msg); + + ros::Publisher motorSpeedPublisher; + ros::Subscriber currentOverLimitSubscriber; + std::optional beginStallTime; +}; + +#endif diff --git a/src/wr_control_drive_arm/src/RoboclawChannel.hpp b/src/wr_control_drive_arm/src/RoboclawChannel.hpp new file mode 100644 index 00000000..fbf7de00 --- /dev/null +++ b/src/wr_control_drive_arm/src/RoboclawChannel.hpp @@ -0,0 +1,6 @@ +#ifndef ROBOCLAW_CHANNEL_H +#define ROBOCLAW_CHANNEL_H + +enum class RoboclawChannel { A, B }; + +#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/SimpleJoint.cpp b/src/wr_control_drive_arm/src/SimpleJoint.cpp deleted file mode 100644 index d7ca2ee2..00000000 --- a/src/wr_control_drive_arm/src/SimpleJoint.cpp +++ /dev/null @@ -1,24 +0,0 @@ -/** - * @file SimpleJoint.cpp - * @author Nichols Underwood - * @brief Implementation of the SimpleJoint class - * @date 2021-10-25 - */ - -#include "SimpleJoint.hpp" - -SimpleJoint::SimpleJoint(std::unique_ptr motor, ros::NodeHandle &n) : AbstractJoint(n, 1) { - this->motors.at(0) = MotorHandler{std::move(motor), 0, 0, "", "", false}; -} - -auto SimpleJoint::getMotorPositions(const vector &jointPositions) -> vector { - return {jointPositions[0]}; -} - -auto SimpleJoint::getMotorVelocities(const vector &jointVelocities) -> vector { - return {jointVelocities[0]}; -} - -auto SimpleJoint::getJointPositions(const vector &jointPositions) -> vector { - return {jointPositions[0]}; -} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/SimpleJoint.hpp b/src/wr_control_drive_arm/src/SimpleJoint.hpp deleted file mode 100644 index 2c1bf76b..00000000 --- a/src/wr_control_drive_arm/src/SimpleJoint.hpp +++ /dev/null @@ -1,18 +0,0 @@ -/** - * @file SimpleJoint.hpp - * @author Nichols Underwood - * @brief Header file of the SimpleJoint class - * @date 2021-10-25 - */ - -#include "AbstractJoint.hpp" - -using std::vector; - -class SimpleJoint : public AbstractJoint { - public: - SimpleJoint(std::unique_ptr motor, ros::NodeHandle& n); - auto getMotorPositions(const vector &jointPositions) -> vector override; - auto getMotorVelocities(const vector &joinVelocities) -> vector override; - auto getJointPositions(const vector &motorPositions) -> vector override; -}; diff --git a/src/wr_control_drive_arm/src/SingleEncoderJointPositionMonitor.cpp b/src/wr_control_drive_arm/src/SingleEncoderJointPositionMonitor.cpp new file mode 100644 index 00000000..d657f1c8 --- /dev/null +++ b/src/wr_control_drive_arm/src/SingleEncoderJointPositionMonitor.cpp @@ -0,0 +1,59 @@ +#include "SingleEncoderJointPositionMonitor.hpp" +#include "MathUtil.hpp" +#include "RoboclawChannel.hpp" +#include "ros/node_handle.h" +#include + +using std::literals::string_literals::operator""s; +using MathUtil::RADIANS_PER_ROTATION; + +SingleEncoderJointPositionMonitor::SingleEncoderJointPositionMonitor( + const std::string &controllerName, + RoboclawChannel channel, + EncoderConfiguration eConfig, + MotorConfiguration mConfig, + ros::NodeHandle node) + : countsPerRotation{eConfig.countsPerRotation}, + offset{eConfig.offset}, + gearRatio{mConfig.gearRatio}, + position{0}, + encoderSubscriber{ + std::make_shared(node.subscribe( + "/hsi/roboclaw/"s + controllerName + "/enc/" + (channel == RoboclawChannel::A ? "left" : "right"), + 1, + &SingleEncoderJointPositionMonitor::onEncoderReceived, + this))} {} + +SingleEncoderJointPositionMonitor::SingleEncoderJointPositionMonitor( + const SingleEncoderJointPositionMonitor &other) + : countsPerRotation(other.countsPerRotation), + offset(other.offset), + gearRatio{other.getGearRatio()}, + encoderSubscriber{other.encoderSubscriber}, + position{other.position.load()} {} + +SingleEncoderJointPositionMonitor::SingleEncoderJointPositionMonitor( + SingleEncoderJointPositionMonitor &&other) noexcept + : countsPerRotation(other.countsPerRotation), + offset(other.offset), + gearRatio(other.getGearRatio()), + encoderSubscriber{std::move(other.encoderSubscriber)}, + position{other.position.load()} {} + +auto SingleEncoderJointPositionMonitor::operator()() -> double { + return position; +} + +void SingleEncoderJointPositionMonitor::onEncoderReceived(const std_msgs::UInt32::ConstPtr &msg) { + auto enc = static_cast(msg->data); + auto rotations = MathUtil::corrMod(enc - offset, countsPerRotation) / countsPerRotation; + position = MathUtil::corrMod(rotations * RADIANS_PER_ROTATION + M_PI, RADIANS_PER_ROTATION) - M_PI; +} + +auto SingleEncoderJointPositionMonitor::getCountsPerRotation() const -> int32_t { + return this->countsPerRotation; +} + +auto SingleEncoderJointPositionMonitor::getGearRatio() const -> double { + return this->gearRatio; +} \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/SingleEncoderJointPositionMonitor.hpp b/src/wr_control_drive_arm/src/SingleEncoderJointPositionMonitor.hpp new file mode 100644 index 00000000..e57437b1 --- /dev/null +++ b/src/wr_control_drive_arm/src/SingleEncoderJointPositionMonitor.hpp @@ -0,0 +1,44 @@ +#ifndef SINGLE_ENCODER_JOINT_POSITION_MONITOR_H +#define SINGLE_ENCODER_JOINT_POSITION_MONITOR_H + +#include "RoboclawChannel.hpp" +#include +#include +#include +#include +#include + +struct EncoderConfiguration { + int32_t countsPerRotation; + int32_t offset; +}; + +struct MotorConfiguration { + double gearRatio; +}; + +class SingleEncoderJointPositionMonitor { +public: + SingleEncoderJointPositionMonitor(const std::string &controllerName, RoboclawChannel channel, EncoderConfiguration eConfig, MotorConfiguration mConfig, ros::NodeHandle node); + auto operator()() -> double; + + SingleEncoderJointPositionMonitor(const SingleEncoderJointPositionMonitor &); + auto operator=(const SingleEncoderJointPositionMonitor &) -> SingleEncoderJointPositionMonitor & = delete; + SingleEncoderJointPositionMonitor(SingleEncoderJointPositionMonitor &&) noexcept; + auto operator=(SingleEncoderJointPositionMonitor &&) -> SingleEncoderJointPositionMonitor & = delete; + ~SingleEncoderJointPositionMonitor() = default; + + [[nodiscard]] auto getCountsPerRotation() const -> int32_t; + [[nodiscard]] auto getGearRatio() const -> double; + +private: + void onEncoderReceived(const std_msgs::UInt32::ConstPtr &msg); + + std::atomic position; + std::shared_ptr encoderSubscriber; + const int32_t countsPerRotation; + const int32_t offset; + const double gearRatio; +}; + +#endif \ No newline at end of file diff --git a/src/wr_control_drive_arm/src/testDifferential.cpp b/src/wr_control_drive_arm/src/testDifferential.cpp new file mode 100644 index 00000000..5b2d31a6 --- /dev/null +++ b/src/wr_control_drive_arm/src/testDifferential.cpp @@ -0,0 +1,26 @@ +#include +#include "Motor.hpp" +#include "DifferentialJointToMotorSpeedConverter.hpp" +#include "ros/init.h" +#include + +auto main(int32_t argc, char** argv) -> int32_t{ + ros::init(argc, argv, "testNode"); + + ros::NodeHandle n{}; + using std::literals::string_literals::operator""s; + + const auto wristLeftMotor{std::make_shared("aux2"s, RoboclawChannel::A, n)}; + const auto wristRightMotor{std::make_shared("aux2"s, RoboclawChannel::B, n)}; + + const auto differentialSpeedConverter{std::make_shared(wristLeftMotor, wristRightMotor)}; + + ros::Rate loopRate{50}; + while(ros::ok()){ + differentialSpeedConverter->setPitchSpeed(0.3); + differentialSpeedConverter->setRollSpeed(0); + loopRate.sleep(); + } + + return 0; +} \ No newline at end of file diff --git a/src/wr_control_drive_arm/structure.wsd b/src/wr_control_drive_arm/structure.wsd new file mode 100755 index 00000000..ef4f1a40 --- /dev/null +++ b/src/wr_control_drive_arm/structure.wsd @@ -0,0 +1,99 @@ +@startuml Structure +enum RoboclawChannel{ + + A + + B +} + +note right of RoboclawChannel::A + Analogous to 'LEFT' +end note + +note right of RoboclawChannel::B + Analogous to 'RIGHT' +end note + +class Motor{ + - powerPublisher : ros::Publisher + + + Motor(string controllerName, RoboclawChannel channel) + + void setPower(double power) + + bool getOverCurrentStatus() +} + +Motor --> RoboclawChannel + +class EncoderJointPositionMonitor { + - encoderSubscriber : ros::Subscriber + - countsPerRotation : const int + - offset : const int + + + EncoderJointPositionMonitor(string controllerName, RoboclawChannel channel, int countsPerRotation, int offset) + - void encoderCallback(std_msgs::Int32) +} + +EncoderJointPositionMonitor --> RoboclawChannel + +class DirectJointToMotorSpeedConverter { + + DirectJointToMotorSpeedConverter(Motor motor) + + void operator()(double) +} + +DirectJointToMotorSpeedConverter "1" --> "1" Motor + +class DifferentialJointToMotorSpeedConverter { + + void setPitchSpeed(double) + + void setRollSpeed(double) +} + +DifferentialJointToMotorSpeedConverter "1" --> "2" Motor + +class Joint{ + + Joint(String name) + + void setTarget(double target) + + bool hasReachedTarget() + + void stop() +} + +Joint --> EncoderJointPositionMonitor : via function parameter +<> speedConversion +Joint --> speedConversion : via function parameter +speedConversion --> DirectJointToMotorSpeedConverter : as functor +speedConversion --> DifferentialJointToMotorSpeedConverter::setPitchSpeed : as function pointer +speedConversion --> DifferentialJointToMotorSpeedConverter::setRollSpeed : as function pointer + +@enduml + +@startuml seq + participant ROS + MoveIt -> ActionServer : Sends a motion path + loop For each waypoint in the motion + loop For each joint in the arm + ActionServer -> Joint : Set the next setpoint per joint + Joint -> Joint : Start the execution loop + end + loop While some joint has not reached its setpoint + note over ActionServer : Wait + ROS -> Joint : Kicks off Timer Event + activate Joint + Joint -> "PID Loop" : Feed the setpoint + Joint -> JointPositionMonitor : Ask for the joint position + activate JointPositionMonitor + JointPositionMonitor --> Joint : Sends back joint position + deactivate JointPositionMonitor + Joint -> "PID Loop" : Feed the feedback + deactivate Joint + + note left of Joint : Happens asynchonously + "PID Loop" -> Joint : New output available + activate Joint + Joint -> JointToMotorSpeedConverter : Dispatch new speed + activate JointToMotorSpeedConverter + JointToMotorSpeedConverter -> JointToMotorSpeedConverter : Determine hardware speeds + JointToMotorSpeedConverter -> "Motor(s)" : Dispatch hardware speeds + deactivate JointToMotorSpeedConverter + deactivate Joint + end + end + ActionServer -> MoveIt : Report motion as complete + +@enduml diff --git a/src/wr_entry_point/launch/comp/comp_init.launch b/src/wr_entry_point/launch/comp/comp_init.launch index ea3bb01d..36f80295 100644 --- a/src/wr_entry_point/launch/comp/comp_init.launch +++ b/src/wr_entry_point/launch/comp/comp_init.launch @@ -4,9 +4,9 @@ - + - + diff --git a/src/wr_entry_point/launch/test/mock_arm.launch b/src/wr_entry_point/launch/test/mock_arm.launch index 23eed457..6dfbb8b1 100644 --- a/src/wr_entry_point/launch/test/mock_arm.launch +++ b/src/wr_entry_point/launch/test/mock_arm.launch @@ -1,26 +1,24 @@ - - - + - - - - - + + + + + - - - - + + + + - - - - - + + + + + - + \ No newline at end of file diff --git a/src/wr_hsi_roboclaw/config/roboclaw_enc.yaml b/src/wr_hsi_roboclaw/config/roboclaw_enc.yaml index c263a2c6..03b11c22 100644 --- a/src/wr_hsi_roboclaw/config/roboclaw_enc.yaml +++ b/src/wr_hsi_roboclaw/config/roboclaw_enc.yaml @@ -7,36 +7,44 @@ claws: enc_left: enabled: true max_speed: 100 # TODO probably don't actually need all these encoders + offset: 500 enc_right: enabled: true max_speed: 100 + offset: 500 aux1: # arm elbow/forearm, science ? topic: '/hsi/roboclaw/aux1' address: 0x81 enc_left: enabled: true max_speed: 100 + offset: 500 enc_right: enabled: true max_speed: 100 + offset: 500 aux2: # arm wrist, science ? topic: '/hsi/roboclaw/aux2' address: 0x82 enc_left: enabled: true max_speed: 100 + offset: 500 enc_right: enabled: true max_speed: 100 + offset: 500 aux3: # arm manip, science ? topic: '/hsi/roboclaw/aux3' address: 0x83 enc_left: enabled: true max_speed: 100 + offset: 500 enc_right: enabled: true max_speed: 100 + offset: 500 drive: # drive train topic: '/hsi/roboclaw/drive' address: 0x84 diff --git a/src/wr_logic_teleop_arm/launch/std.launch b/src/wr_logic_teleop_arm/launch/std.launch index 64ff8e42..a5e0beaa 100644 --- a/src/wr_logic_teleop_arm/launch/std.launch +++ b/src/wr_logic_teleop_arm/launch/std.launch @@ -1,6 +1,7 @@ - + + diff --git a/src/wr_logic_teleop_arm/src/ArmTeleopLogic.cpp b/src/wr_logic_teleop_arm/src/ArmTeleopLogic.cpp index 52bfbb9e..9cdbb880 100644 --- a/src/wr_logic_teleop_arm/src/ArmTeleopLogic.cpp +++ b/src/wr_logic_teleop_arm/src/ArmTeleopLogic.cpp @@ -1,3 +1,4 @@ +#include "boost/function.hpp" #include "geometry_msgs/PoseStamped.h" #include "geometry_msgs/Quaternion.h" #include "moveit_msgs/RobotTrajectory.h" @@ -5,25 +6,25 @@ #include "ros/subscriber.h" #include "std_msgs/Bool.h" #include "std_msgs/Float32.h" -#include "boost/function.hpp" #include "tf2/LinearMath/Quaternion.h" #include "tf2/LinearMath/Vector3.h" #include "tf2_geometry_msgs/tf2_geometry_msgs.h" #include +#include #include -#include #include #include +#include #include -using Std_Bool = const std_msgs::BoolConstPtr&; -using Std_Float32 = const std_msgs::Float32ConstPtr&; +using Std_Bool = const std_msgs::BoolConstPtr &; +using Std_Float32 = const std_msgs::Float32ConstPtr &; -std::atomic_bool isNewPath { true }; -const tf2::Quaternion WORLD_OFFSET {0, sin(M_PI/2), 0, cos(M_PI/2)}; +std::atomic_bool isNewPath{true}; +const tf2::Quaternion WORLD_OFFSET{0, sin(M_PI / 2), 0, cos(M_PI / 2)}; -auto updateTarget(float x_pos, float y_pos, float z_pos, tf2::Quaternion orientation, ros::Publisher &pub) -> void{ - geometry_msgs::PoseStamped p {}; +auto updateTarget(float x_pos, float y_pos, float z_pos, tf2::Quaternion orientation, ros::Publisher &pub) -> void { + geometry_msgs::PoseStamped p{}; p.pose.position.x = x_pos; p.pose.position.y = y_pos; p.pose.position.z = z_pos; @@ -33,15 +34,15 @@ auto updateTarget(float x_pos, float y_pos, float z_pos, tf2::Quaternion orienta pub.publish(p); } -auto main(int argc, char** argv) -> int{ +auto main(int argc, char **argv) -> int { ros::init(argc, argv, "ArmTeleopLogic"); ros::AsyncSpinner spin(1); spin.start(); - ros::NodeHandle np("~"); + ros::NodeHandle np("~"); constexpr float PLANNING_TIME = 0.05; constexpr float CLOCK_RATE = 2; - constexpr uint32_t MESSAGE_QUEUE_LENGTH = 1000; + constexpr uint32_t MESSAGE_QUEUE_LENGTH = 1000; constexpr float TRIGGER_PRESSED = 0.5; constexpr float JOYSTICK_DEADBAND = 0.1; constexpr float MINIMUM_PATH_ACCURACY = 0.0; @@ -50,11 +51,10 @@ auto main(int argc, char** argv) -> int{ constexpr float STEP_Y = 0.003; constexpr float STEP_Z = 0.003; - constexpr float HOME_X = -0.7; - constexpr float HOME_Y = 0.0; + constexpr float HOME_X = 0.0; + constexpr float HOME_Y = -0.7; constexpr float HOME_Z = 0.2; - float accel = 1.0; float deaccel = 1.0; float step_mult = 1.0; @@ -62,171 +62,160 @@ auto main(int argc, char** argv) -> int{ float y_pos = HOME_Y; float z_pos = HOME_Z; - tf2::Quaternion orientation {0, sin(-M_PI/4), 0, cos(-M_PI/4)}; + tf2::Quaternion orientation{sin(M_PI / 4), 0, 0, cos(-M_PI / 4)}; orientation = orientation; - const tf2::Quaternion SPIN_X {sin(2*M_PI/1000), 0, 0, cos(2*M_PI/1000)}; - const tf2::Quaternion SPIN_Y {0, sin(2*M_PI/1000), 0, cos(2*M_PI/1000)}; - const tf2::Quaternion SPIN_Z {0, 0, sin(2*M_PI/1000), cos(2*M_PI/1000)}; + const tf2::Quaternion SPIN_X{sin(2 * M_PI / 1000), 0, 0, cos(2 * M_PI / 1000)}; + const tf2::Quaternion SPIN_Y{0, sin(2 * M_PI / 1000), 0, cos(2 * M_PI / 1000)}; + const tf2::Quaternion SPIN_Z{0, 0, sin(2 * M_PI / 1000), cos(2 * M_PI / 1000)}; moveit::planning_interface::MoveGroupInterface move("arm"); // move.setPlannerId("RRTStar"); move.setPlanningTime(PLANNING_TIME); - const moveit::core::JointModelGroup* joint_model_group = move.getCurrentState()->getJointModelGroup("arm"); + const moveit::core::JointModelGroup *joint_model_group = move.getCurrentState()->getJointModelGroup("arm"); robot_state::RobotState start_state(*move.getCurrentState()); moveit_visual_tools::MoveItVisualTools visual_tools("arm"); + ros::Rate loop{CLOCK_RATE}; - ros::Rate loop {CLOCK_RATE}; + ros::Publisher nextTarget = np.advertise("/logic/arm_teleop/next_target", + MESSAGE_QUEUE_LENGTH); - ros::Publisher nextTarget = np.advertise("/logic/arm_teleop/next_target", - MESSAGE_QUEUE_LENGTH); - - ros::Publisher trajectoryPub = np.advertise("/logic/arm_teleop/trajectory", - MESSAGE_QUEUE_LENGTH); - + ros::Publisher trajectoryPub = np.advertise("/logic/arm_teleop/trajectory", + MESSAGE_QUEUE_LENGTH); // y axis - ros::Subscriber yAxis = np.subscribe("/hci/arm/gamepad/axis/stick_left_y", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Float32 msg) -> void { - if(abs(msg->data) >= JOYSTICK_DEADBAND){ - y_pos += msg->data * STEP_Y; - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + ros::Subscriber yAxis = np.subscribe("/hci/arm/gamepad/axis/stick_left_y", + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Float32 msg) -> void { + if (abs(msg->data) >= JOYSTICK_DEADBAND) { + y_pos += msg->data * STEP_Y; + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); // x axis - ros::Subscriber xAxis = np.subscribe("/hci/arm/gamepad/axis/stick_left_x", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Float32 msg) -> void { - if(abs(msg->data) >= JOYSTICK_DEADBAND){ - x_pos += msg->data * STEP_X; - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + ros::Subscriber xAxis = np.subscribe("/hci/arm/gamepad/axis/stick_left_x", + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Float32 msg) -> void { + if (abs(msg->data) >= JOYSTICK_DEADBAND) { + x_pos += msg->data * STEP_X; + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); // y up ros::Subscriber zUp = np.subscribe("/hci/arm/gamepad/button/shoulder_l", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Bool msg) -> void { - if(msg->data){ - z_pos += STEP_Y * step_mult; - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Bool msg) -> void { + if (msg->data) { + z_pos += STEP_Y * step_mult; + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); // y down ros::Subscriber zDown = np.subscribe("/hci/arm/gamepad/button/shoulder_r", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Bool msg) -> void { - if(msg->data){ - z_pos -= STEP_Y * step_mult; - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); - - //roll counter clockwise + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Bool msg) -> void { + if (msg->data) { + z_pos -= STEP_Y * step_mult; + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); + + // roll counter clockwise ros::Subscriber rollUp = np.subscribe("/hci/arm/gamepad/button/y", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Bool msg) -> void { - if(msg->data){ - orientation *= SPIN_Z * step_mult; - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Bool msg) -> void { + if (msg->data) { + orientation *= SPIN_Z * step_mult; + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); // roll clockwise ros::Subscriber rollDown = np.subscribe("/hci/arm/gamepad/button/a", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Bool msg) -> void { - if(msg->data){ - orientation *= SPIN_Z.inverse(); - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Bool msg) -> void { + if (msg->data) { + orientation *= SPIN_Z.inverse(); + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); // pitch ros::Subscriber pitch = np.subscribe("/hci/arm/gamepad/axis/stick_right_y", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Float32 msg) -> void { - if(abs(msg->data) >= 0.5){ - orientation *= (msg->data > 0 ? SPIN_Y : SPIN_Y.inverse()); - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Float32 msg) -> void { + if (abs(msg->data) >= 0.5) { + orientation *= (msg->data > 0 ? SPIN_Y : SPIN_Y.inverse()); + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); // yaw ros::Subscriber yaw = np.subscribe("/hci/arm/gamepad/axis/stick_right_x", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Float32 msg) -> void { - if(abs(msg->data) >= 0.5){ - orientation *= (msg->data > 0 ? SPIN_X : SPIN_X.inverse()); - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - isNewPath.store(true); - - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Float32 msg) -> void { + if (abs(msg->data) >= 0.5) { + orientation *= (msg->data > 0 ? SPIN_X : SPIN_X.inverse()); + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); + } + })); ros::Subscriber speedUp = np.subscribe("/hci/arm/gamepad/axis/trigger_right", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Float32 msg) -> void { - accel = msg->data; - step_mult = std::pow(10,accel-deaccel); - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Float32 msg) -> void { + accel = msg->data; + step_mult = std::pow(10, accel - deaccel); + })); ros::Subscriber speedDown = np.subscribe("/hci/arm/gamepad/axis/trigger_right", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Float32 msg) -> void { - deaccel = msg->data; - step_mult = std::pow(10,accel-deaccel); - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Float32 msg) -> void { + deaccel = msg->data; + step_mult = std::pow(10, accel - deaccel); + })); // override path execution ros::Subscriber execPath = np.subscribe("/hci/arm/gamepad/button/x", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Bool msg) -> void { - if(msg->data){ - isNewPath.store(true); - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Bool msg) -> void { + if (msg->data) { + isNewPath.store(true); + } + })); // reset target/cancel path ros::Subscriber resetPose = np.subscribe("/hci/arm/gamepad/button/start", - MESSAGE_QUEUE_LENGTH, - static_cast>([&](Std_Bool msg) -> void { - if(msg->data){ - - geometry_msgs::Pose pose = move.getCurrentPose().pose; - x_pos = pose.position.x; - y_pos = pose.position.y; - z_pos = pose.position.z; - tf2::convert(pose.orientation, orientation); - updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - - isNewPath.store(true); //override path - } - })); + MESSAGE_QUEUE_LENGTH, + static_cast>([&](Std_Bool msg) -> void { + if (msg->data) { + + geometry_msgs::Pose pose = move.getCurrentPose().pose; + x_pos = pose.position.x; + y_pos = pose.position.y; + z_pos = pose.position.z; + tf2::convert(pose.orientation, orientation); + updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); + isNewPath.store(true); // override path + } + })); - while(ros::ok()){ + while (ros::ok()) { updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - if(!isNewPath.load()){ + if (!isNewPath.load()) { loop.sleep(); continue; } @@ -236,35 +225,35 @@ auto main(int argc, char** argv) -> int{ move.stop(); // configure target pose - geometry_msgs::PoseStamped p {}; + geometry_msgs::PoseStamped p{}; p.pose.position.x = x_pos; p.pose.position.y = y_pos; p.pose.position.z = z_pos; p.pose.orientation = tf2::toMsg(orientation); - p.header.frame_id = "odom_combined"; + p.header.frame_id = "world"; move.setPoseTarget(p); move.setStartStateToCurrentState(); - //plan and execute path + // plan and execute path move.asyncMove(); - while(ros::ok){ + while (ros::ok()) { updateTarget(x_pos, y_pos, z_pos, orientation, nextTarget); - if(move.getMoveGroupClient().getState().isDone()){ + if (move.getMoveGroupClient().getState().isDone()) { std::cout << "[INFO] [" << ros::Time::now() << "]: path finished: " << move.getMoveGroupClient().getState().getText() << std::endl; break; - } - - else if(isNewPath.load()){ + } + + else if (isNewPath.load()) { std::cout << "[INFO] [" << ros::Time::now() << "]: path overridden" << std::endl; move.stop(); break; } loop.sleep(); - } + } } return 0; diff --git a/src/wroboarm_21/.setup_assistant b/src/wroboarm_21/.setup_assistant deleted file mode 100644 index 04da6248..00000000 --- a/src/wroboarm_21/.setup_assistant +++ /dev/null @@ -1,11 +0,0 @@ -moveit_setup_assistant_config: - URDF: - package: wroboarm_21 - relative_path: urdf/wroboarm_21.urdf - xacro_args: "" - SRDF: - relative_path: config/wroboarm_21.srdf - CONFIG: - author_name: me - author_email: me@me.me - generated_timestamp: 1615512414 \ No newline at end of file diff --git a/src/wroboarm_21/config/fake_controllers.yaml b/src/wroboarm_21/config/fake_controllers.yaml deleted file mode 100644 index e296f940..00000000 --- a/src/wroboarm_21/config/fake_controllers.yaml +++ /dev/null @@ -1,13 +0,0 @@ -controller_list: - - name: fake_arm_controller - joints: - - link1_joint - - link2_joint - - link3_joint - - link4_joint - - link5_joint - - link6_joint - - link7_joint -initial: # Define initial robot poses. - - group: arm -# pose: home diff --git a/src/wroboarm_21/config/joint_limits.yaml b/src/wroboarm_21/config/joint_limits.yaml deleted file mode 100644 index be8e07da..00000000 --- a/src/wroboarm_21/config/joint_limits.yaml +++ /dev/null @@ -1,45 +0,0 @@ -# joint_limits.yaml allows the dynamics properties specified in the URDF to be overwritten or augmented as needed - -# For beginners, we downscale velocity and acceleration limits. -# You can always specify higher scaling factors (<= 1.0) in your motion requests. # Increase the values below to 1.0 to always move at maximum speed. -default_velocity_scaling_factor: 0.1 -default_acceleration_scaling_factor: 0.1 - -# Specific joint properties can be changed with the keys [max_position, min_position, max_velocity, max_acceleration] -# Joint limits can be turned off with [has_velocity_limits, has_acceleration_limits] -joint_limits: - link1_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - link2_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - link3_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - link4_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - link5_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - link6_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - link7_joint: - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 diff --git a/src/wroboarm_21/config/joint_names_wroboarm_21.yaml b/src/wroboarm_21/config/joint_names_wroboarm_21.yaml deleted file mode 100644 index fbfbe031..00000000 --- a/src/wroboarm_21/config/joint_names_wroboarm_21.yaml +++ /dev/null @@ -1 +0,0 @@ -controller_joint_names: ['', 'link1_joint', 'link2_joint', 'link3_joint', 'link4_joint', 'link5_joint', 'link6_joint', 'link7_joint', ] diff --git a/src/wroboarm_21/config/ompl_planning.yaml b/src/wroboarm_21/config/ompl_planning.yaml deleted file mode 100644 index ce098a0c..00000000 --- a/src/wroboarm_21/config/ompl_planning.yaml +++ /dev/null @@ -1,156 +0,0 @@ -planner_configs: - AnytimePathShortening: - type: geometric::AnytimePathShortening - shortcut: true # Attempt to shortcut all new solution paths - hybridize: true # Compute hybrid solution trajectories - max_hybrid_paths: 24 # Number of hybrid paths generated per iteration - num_planners: 4 # The number of default planners to use for planning - planners: "" # A comma-separated list of planner types (e.g., "PRM,EST,RRTConnect"Optionally, planner parameters can be passed to change the default:"PRM[max_nearest_neighbors=5],EST[goal_bias=.5],RRT[range=10. goal_bias=.1]" - SBL: - type: geometric::SBL - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - EST: - type: geometric::EST - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0 setup() - goal_bias: 0.05 # When close to goal select goal, with this probability. default: 0.05 - LBKPIECE: - type: geometric::LBKPIECE - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - border_fraction: 0.9 # Fraction of time focused on boarder default: 0.9 - min_valid_path_fraction: 0.5 # Accept partially valid moves above fraction. default: 0.5 - BKPIECE: - type: geometric::BKPIECE - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - border_fraction: 0.9 # Fraction of time focused on boarder default: 0.9 - failed_expansion_score_factor: 0.5 # When extending motion fails, scale score by factor. default: 0.5 - min_valid_path_fraction: 0.5 # Accept partially valid moves above fraction. default: 0.5 - KPIECE: - type: geometric::KPIECE - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability. default: 0.05 - border_fraction: 0.9 # Fraction of time focused on boarder default: 0.9 (0.0,1.] - failed_expansion_score_factor: 0.5 # When extending motion fails, scale score by factor. default: 0.5 - min_valid_path_fraction: 0.5 # Accept partially valid moves above fraction. default: 0.5 - RRT: - type: geometric::RRT - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability? default: 0.05 - RRTConnect: - type: geometric::RRTConnect - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - RRTstar: - type: geometric::RRTstar - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability? default: 0.05 - delay_collision_checking: 1 # Stop collision checking as soon as C-free parent found. default 1 - TRRT: - type: geometric::TRRT - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability? default: 0.05 - max_states_failed: 10 # when to start increasing temp. default: 10 - temp_change_factor: 2.0 # how much to increase or decrease temp. default: 2.0 - min_temperature: 10e-10 # lower limit of temp change. default: 10e-10 - init_temperature: 10e-6 # initial temperature. default: 10e-6 - frountier_threshold: 0.0 # dist new state to nearest neighbor to disqualify as frontier. default: 0.0 set in setup() - frountierNodeRatio: 0.1 # 1/10, or 1 nonfrontier for every 10 frontier. default: 0.1 - k_constant: 0.0 # value used to normalize expresssion. default: 0.0 set in setup() - PRM: - type: geometric::PRM - max_nearest_neighbors: 10 # use k nearest neighbors. default: 10 - PRMstar: - type: geometric::PRMstar - FMT: - type: geometric::FMT - num_samples: 1000 # number of states that the planner should sample. default: 1000 - radius_multiplier: 1.1 # multiplier used for the nearest neighbors search radius. default: 1.1 - nearest_k: 1 # use Knearest strategy. default: 1 - cache_cc: 1 # use collision checking cache. default: 1 - heuristics: 0 # activate cost to go heuristics. default: 0 - extended_fmt: 1 # activate the extended FMT*: adding new samples if planner does not finish successfully. default: 1 - BFMT: - type: geometric::BFMT - num_samples: 1000 # number of states that the planner should sample. default: 1000 - radius_multiplier: 1.0 # multiplier used for the nearest neighbors search radius. default: 1.0 - nearest_k: 1 # use the Knearest strategy. default: 1 - balanced: 0 # exploration strategy: balanced true expands one tree every iteration. False will select the tree with lowest maximum cost to go. default: 1 - optimality: 1 # termination strategy: optimality true finishes when the best possible path is found. Otherwise, the algorithm will finish when the first feasible path is found. default: 1 - heuristics: 1 # activates cost to go heuristics. default: 1 - cache_cc: 1 # use the collision checking cache. default: 1 - extended_fmt: 1 # Activates the extended FMT*: adding new samples if planner does not finish successfully. default: 1 - PDST: - type: geometric::PDST - STRIDE: - type: geometric::STRIDE - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability. default: 0.05 - use_projected_distance: 0 # whether nearest neighbors are computed based on distances in a projection of the state rather distances in the state space itself. default: 0 - degree: 16 # desired degree of a node in the Geometric Near-neightbor Access Tree (GNAT). default: 16 - max_degree: 18 # max degree of a node in the GNAT. default: 12 - min_degree: 12 # min degree of a node in the GNAT. default: 12 - max_pts_per_leaf: 6 # max points per leaf in the GNAT. default: 6 - estimated_dimension: 0.0 # estimated dimension of the free space. default: 0.0 - min_valid_path_fraction: 0.2 # Accept partially valid moves above fraction. default: 0.2 - BiTRRT: - type: geometric::BiTRRT - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - temp_change_factor: 0.1 # how much to increase or decrease temp. default: 0.1 - init_temperature: 100 # initial temperature. default: 100 - frountier_threshold: 0.0 # dist new state to nearest neighbor to disqualify as frontier. default: 0.0 set in setup() - frountier_node_ratio: 0.1 # 1/10, or 1 nonfrontier for every 10 frontier. default: 0.1 - cost_threshold: 1e300 # the cost threshold. Any motion cost that is not better will not be expanded. default: inf - LBTRRT: - type: geometric::LBTRRT - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability. default: 0.05 - epsilon: 0.4 # optimality approximation factor. default: 0.4 - BiEST: - type: geometric::BiEST - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - ProjEST: - type: geometric::ProjEST - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - goal_bias: 0.05 # When close to goal select goal, with this probability. default: 0.05 - LazyPRM: - type: geometric::LazyPRM - range: 0.0 # Max motion added to tree. ==> maxDistance_ default: 0.0, if 0.0, set on setup() - LazyPRMstar: - type: geometric::LazyPRMstar - SPARS: - type: geometric::SPARS - stretch_factor: 3.0 # roadmap spanner stretch factor. multiplicative upper bound on path quality. It does not make sense to make this parameter more than 3. default: 3.0 - sparse_delta_fraction: 0.25 # delta fraction for connection distance. This value represents the visibility range of sparse samples. default: 0.25 - dense_delta_fraction: 0.001 # delta fraction for interface detection. default: 0.001 - max_failures: 1000 # maximum consecutive failure limit. default: 1000 - SPARStwo: - type: geometric::SPARStwo - stretch_factor: 3.0 # roadmap spanner stretch factor. multiplicative upper bound on path quality. It does not make sense to make this parameter more than 3. default: 3.0 - sparse_delta_fraction: 0.25 # delta fraction for connection distance. This value represents the visibility range of sparse samples. default: 0.25 - dense_delta_fraction: 0.001 # delta fraction for interface detection. default: 0.001 - max_failures: 5000 # maximum consecutive failure limit. default: 5000 -arm: - default_planner_config: RRTstar - planner_configs: - - AnytimePathShortening - - SBL - - EST - - LBKPIECE - - BKPIECE - - KPIECE - - RRT - - RRTConnect - - RRTstar - - TRRT - - PRM - - PRMstar - - FMT - - BFMT - - PDST - - STRIDE - - BiTRRT - - LBTRRT - - BiEST - - ProjEST - - LazyPRM - - LazyPRMstar - - SPARS - - SPARStwo \ No newline at end of file diff --git a/src/wroboarm_21/config/ros_controllers.yaml b/src/wroboarm_21/config/ros_controllers.yaml deleted file mode 100644 index ebdad9d2..00000000 --- a/src/wroboarm_21/config/ros_controllers.yaml +++ /dev/null @@ -1,37 +0,0 @@ -# Simulation settings for using moveit_sim_controllers -moveit_sim_hw_interface: - joint_model_group: todo_group_name - joint_model_group_pose: todo_state_name -# Settings for ros_control_boilerplate control loop -generic_hw_control_loop: - loop_hz: 300 - cycle_time_error_threshold: 0.01 -# Settings for ros_control hardware interface -hardware_interface: - joints: - - link1_joint - - link2_joint - - link3_joint - - link4_joint - - link5_joint - - link6_joint - - link7_joint - sim_control_mode: 1 # 0: position, 1: velocity -# Publish all joint states -# Creates the /joint_states topic necessary in ROS -joint_state_controller: - type: joint_state_controller/JointStateController - publish_rate: 50 -controller_list: - - name: arm_controller - action_ns: follow_joint_trajectory - default: True - type: FollowJointTrajectory - joints: - - link1_joint - - link2_joint - - link3_joint - - link4_joint - - link5_joint - - link6_joint - - link7_joint diff --git a/src/wroboarm_21/config/sensors_3d.yaml b/src/wroboarm_21/config/sensors_3d.yaml deleted file mode 100644 index a4bb13e3..00000000 --- a/src/wroboarm_21/config/sensors_3d.yaml +++ /dev/null @@ -1,10 +0,0 @@ -# The name of this file shouldn't be changed, or else the Setup Assistant won't detect it -sensors: - - filtered_cloud_topic: filtered_cloud - max_range: 5.0 - max_update_rate: 1.0 - padding_offset: 0.1 - padding_scale: 1.0 - point_cloud_topic: /head_mount_kinect/depth_registered/points - point_subsample: 1 - sensor_plugin: occupancy_map_monitor/PointCloudOctomapUpdater \ No newline at end of file diff --git a/src/wroboarm_21/config/wroboarm_21.srdf b/src/wroboarm_21/config/wroboarm_21.srdf deleted file mode 100644 index cef5e442..00000000 --- a/src/wroboarm_21/config/wroboarm_21.srdf +++ /dev/null @@ -1,38 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/export.log b/src/wroboarm_21/export.log deleted file mode 100644 index 052f4f98..00000000 --- a/src/wroboarm_21/export.log +++ /dev/null @@ -1,365 +0,0 @@ -2020-12-21 21:22:47,283 INFO Logger.cs: 70 - --------------------------------------------------------------------------------- -2020-12-21 21:22:47,333 INFO Logger.cs: 71 - Logging commencing for SW2URDF exporter -2020-12-21 21:22:47,335 INFO Logger.cs: 73 - Commit version 1.6.0-1-g15f4949 -2020-12-21 21:22:47,336 INFO Logger.cs: 74 - Build version 1.6.7594.29634 -2020-12-21 21:22:47,339 INFO SwAddin.cs: 192 - Attempting to connect to SW -2020-12-21 21:22:47,340 INFO SwAddin.cs: 197 - Setting up callbacks -2020-12-21 21:22:47,341 INFO SwAddin.cs: 201 - Setting up command manager -2020-12-21 21:22:47,343 INFO SwAddin.cs: 204 - Adding command manager -2020-12-21 21:22:47,347 INFO SwAddin.cs: 263 - Adding Assembly export to file menu -2020-12-21 21:22:47,349 INFO SwAddin.cs: 272 - Adding Part export to file menu -2020-12-21 21:22:47,350 INFO SwAddin.cs: 210 - Adding event handlers -2020-12-21 21:22:47,354 INFO SwAddin.cs: 217 - Connecting plugin to SolidWorks -2020-12-21 21:24:27,526 INFO SwAddin.cs: 294 - Assembly export called for file wroboarm_21 -2020-12-21 21:24:29,650 INFO SwAddin.cs: 313 - Saving assembly -2020-12-21 21:24:29,826 INFO SwAddin.cs: 316 - Opening property manager -2020-12-21 21:24:29,876 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from wroboarm_21 -2020-12-21 21:24:29,891 INFO ExportHelperExtension.cs: 1136 - Found 59 in wroboarm_21 -2020-12-21 21:24:29,893 INFO ExportHelperExtension.cs: 1145 - Found 7 features of type [CoordSys] in wroboarm_21 -2020-12-21 21:24:29,894 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2020-12-21 21:24:29,896 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2020-12-21 21:24:29,898 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forearm-1 -2020-12-21 21:24:29,900 INFO ExportHelperExtension.cs: 1136 - Found 31 in Forearm-1 -2020-12-21 21:24:29,901 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forearm-1 -2020-12-21 21:24:29,902 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Elbow-1 -2020-12-21 21:24:29,904 INFO ExportHelperExtension.cs: 1136 - Found 27 in Elbow-1 -2020-12-21 21:24:29,905 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Elbow-1 -2020-12-21 21:24:29,906 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from TurnTable-1 -2020-12-21 21:24:29,907 INFO ExportHelperExtension.cs: 1136 - Found 25 in TurnTable-1 -2020-12-21 21:24:29,908 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in TurnTable-1 -2020-12-21 21:24:29,909 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2020-12-21 21:24:29,910 INFO ExportHelperExtension.cs: 1136 - Found 27 in UpperArm-1 -2020-12-21 21:24:29,912 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2020-12-21 21:24:29,913 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2020-12-21 21:24:29,915 INFO ExportHelperExtension.cs: 1136 - Found 29 in Shoulder-1 -2020-12-21 21:24:29,916 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2020-12-21 21:24:29,917 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2020-12-21 21:24:29,918 INFO ExportHelperExtension.cs: 1136 - Found 27 in Manipulator-1 -2020-12-21 21:24:29,921 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2020-12-21 21:24:29,924 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2020-12-21 21:24:29,925 INFO ExportHelperExtension.cs: 1136 - Found 29 in Wrist-1 -2020-12-21 21:24:29,928 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2020-12-21 21:24:29,930 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from wroboarm_21 -2020-12-21 21:24:29,932 INFO ExportHelperExtension.cs: 1136 - Found 59 in wroboarm_21 -2020-12-21 21:24:29,934 INFO ExportHelperExtension.cs: 1145 - Found 6 features of type [RefAxis] in wroboarm_21 -2020-12-21 21:24:29,935 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2020-12-21 21:24:29,936 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2020-12-21 21:24:29,937 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forearm-1 -2020-12-21 21:24:29,938 INFO ExportHelperExtension.cs: 1136 - Found 31 in Forearm-1 -2020-12-21 21:24:29,940 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forearm-1 -2020-12-21 21:24:29,940 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Elbow-1 -2020-12-21 21:24:29,941 INFO ExportHelperExtension.cs: 1136 - Found 27 in Elbow-1 -2020-12-21 21:24:29,943 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Elbow-1 -2020-12-21 21:24:29,944 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from TurnTable-1 -2020-12-21 21:24:29,945 INFO ExportHelperExtension.cs: 1136 - Found 25 in TurnTable-1 -2020-12-21 21:24:29,946 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in TurnTable-1 -2020-12-21 21:24:29,947 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2020-12-21 21:24:29,949 INFO ExportHelperExtension.cs: 1136 - Found 27 in UpperArm-1 -2020-12-21 21:24:29,950 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2020-12-21 21:24:29,952 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2020-12-21 21:24:29,953 INFO ExportHelperExtension.cs: 1136 - Found 29 in Shoulder-1 -2020-12-21 21:24:29,954 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2020-12-21 21:24:29,962 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2020-12-21 21:24:30,065 INFO ExportHelperExtension.cs: 1136 - Found 27 in Manipulator-1 -2020-12-21 21:24:30,066 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2020-12-21 21:24:30,068 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2020-12-21 21:24:30,070 INFO ExportHelperExtension.cs: 1136 - Found 29 in Wrist-1 -2020-12-21 21:24:30,071 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2020-12-21 21:24:30,351 INFO SwAddin.cs: 339 - Loading config tree -2020-12-21 21:24:30,360 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametrueturntablexyztrue-2.8254193696243868E-170-6.7465241345308752E-18rpytrue000originfalsefalsevaluetrue0.39680623003092352massfalseixxtrue0.00057145415023748434ixytrue0ixztrue2.2383483955223888E-21iyytrue0.0011002410492471767iyztrue0izztrue0.00057145415023748434inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametruegearboxxyztrue-6.8631413935065579E-180.03801532439663572-0.0013892205096921757rpytrue000originfalsefalsevaluetrue0.34120985304638518massfalseixxtrue0.00063726488338474081ixytrue7.0764513023917949E-20ixztrue-2.7252675378665934E-19iyytrue0.00083450439761804886iyztrue1.6294136810805574E-05izztrue0.00088931887892574886inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink1_jointtypetruecontinuousxyztrue000.0127rpytrue1.570800originfalsefalselinktrueturntableparenttruelinktruegearboxchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link1_joint2Origin_link1_joint2linktruenametrueupperarmxyztrue1.4123887173905075E-170.157206632847804122.7755575615628914E-17rpytrue000originfalsefalsevaluetrue1.264124215876306massfalseixxtrue0.013677990391055649ixytrue3.368445392332098E-19ixztrue3.9611983830710858E-20iyytrue0.000964387075304149iyztrue-2.6745670344635044E-18izztrue0.014091749673708917inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink2_jointtypetruecontinuousxyztrue00.072390.03683rpytrue000originfalsefalselinktruegearboxparenttruelinktrueupperarmchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link2_joint2Origin_link2_joint2linktruenametrueelbowxyztrue7.3321042375852733E-180.046279720003911486-0.0099170828579809855rpytrue000originfalsefalsevaluetrue0.625328404239412massfalseixxtrue0.0015093628788121875ixytrue7.2251958937028559E-20ixztrue2.6531119727066055E-20iyytrue0.00077150412582161528iyztrue-1.1346887107722466E-05izztrue0.0010232990551232335inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink3_jointtypetruecontinuousxyztrue00.3810rpytrue-1.570800originfalsefalselinktrueupperarmparenttruelinktrueelbowchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link3_jointOrigin_link3_jointlinktruenametrueforearmxyztrue-1.1893700871757326E-17-1.9081958235744878E-17-0.11306639219877124rpytrue000originfalsefalsevaluetrue0.46063240123192695massfalseixxtrue0.0022362056644483611ixytrue2.8623740668759855E-21ixztrue-6.9238813900453064E-20iyytrue0.0022468403158638628iyztrue-3.0218548775228389E-19izztrue0.00024560226807657237inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink4_jointtypetruecontinuousxyztrue00.044450.04445rpytrue3.141600originfalsefalselinktrueelbowparenttruelinktrueforearmchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link4_jointOrigin_link4_jointlinktruenametruewristxyztrue-7.1276563553462352E-097.8062556418956319E-18-3.4149891803281207E-09rpytrue000originfalsefalsevaluetrue0.064200890136229274massfalseixxtrue3.4980909309943769E-05ixytrue5.2887802729807491E-11ixztrue1.565944720011522E-18iyytrue2.4290927928157113E-05iyztrue-4.3708304367957221E-11izztrue2.8670971509987432E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink5_jointtypetruecontinuousxyztrue00-0.254rpytrue3.141600originfalsefalselinktrueforearmparenttruelinktruewristchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link5_jointOrigin_link5_jointlinktruenametruemanipulatorxyztrue3.4694469519536142E-189.8733856357333089E-18-0.038099999999999912rpytrue000originfalsefalsevaluetrue0.1580336580927709massfalseixxtrue0.00011719996250307502ixytrue2.2033040782480907E-21ixztrue2.5135101783302778E-20iyytrue0.00011719996250307503iyztrue8.5958526221282082E-21izztrue8.1464432723451653E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink6_jointtypetruecontinuousxyztrue000.0254rpytrue3.141601.5708originfalsefalselinktruewristparenttruelinktruemanipulatorchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link6_jointOrigin_link6_jointlinktruefalse4C4AAAUAAAD//v8XTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAA1AAAAfalsefalsefalse4C4AAAUAAAD//v8RVwByAGkAcwB0AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAxAAAAfalsefalsefalse4C4AAAUAAAD//v8TRgBvAHIAZQBhAHIAbQAtADEAQABTAGkAbQBwAGwAZQBBAHIAbQAEAAAAEAAAAAEAAAABAAAAKgAAAA==falsefalsefalse4C4AAAUAAAD//v8RRQBsAGIAbwB3AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAoAAAAfalsefalsefalse4C4AAAUAAAD//v8UVQBwAHAAZQByAEEAcgBtAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAaAAAAfalsefalsefalse4C4AAAUAAAD//v8UUwBoAG8AdQBsAGQAZQByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAYAAAAfalsefalsefalse4C4AAAUAAAD//v8VVAB1AHIAbgBUAGEAYgBsAGUALQAxAEAAUwBpAG0AcABsAGUAQQByAG0ABAAAABAAAAABAAAAAQAAABkAAAA=falsefalse -2020-12-21 21:24:30,482 INFO LinkNode.cs: 35 - Building node turntable -2020-12-21 21:24:30,484 INFO LinkNode.cs: 35 - Building node gearbox -2020-12-21 21:24:30,484 INFO LinkNode.cs: 35 - Building node upperarm -2020-12-21 21:24:30,485 INFO LinkNode.cs: 35 - Building node elbow -2020-12-21 21:24:30,485 INFO LinkNode.cs: 35 - Building node forearm -2020-12-21 21:24:30,486 INFO LinkNode.cs: 35 - Building node wrist -2020-12-21 21:24:30,486 INFO LinkNode.cs: 35 - Building node manipulator -2020-12-21 21:24:30,487 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for turntable from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,489 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???TurnTable-1@SimpleArm -2020-12-21 21:24:30,492 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\TurnTable.SLDPRT -2020-12-21 21:24:30,492 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link turntable -2020-12-21 21:24:30,493 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for gearbox from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,493 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???Shoulder-1@SimpleArm -2020-12-21 21:24:30,494 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Shoulder.SLDPRT -2020-12-21 21:24:30,494 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link gearbox -2020-12-21 21:24:30,494 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for upperarm from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,495 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???UpperArm-1@SimpleArm -2020-12-21 21:24:30,495 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\UpperArm.SLDPRT -2020-12-21 21:24:30,495 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link upperarm -2020-12-21 21:24:30,496 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for elbow from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,496 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???Elbow-1@SimpleArm( -2020-12-21 21:24:30,497 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Elbow.SLDPRT -2020-12-21 21:24:30,497 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link elbow -2020-12-21 21:24:30,497 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for forearm from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,498 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???Forearm-1@SimpleArm* -2020-12-21 21:24:30,498 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Forearm.SLDPRT -2020-12-21 21:24:30,498 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link forearm -2020-12-21 21:24:30,499 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for wrist from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,499 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???Wrist-1@SimpleArm1 -2020-12-21 21:24:30,500 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Wrist.SLDPRT -2020-12-21 21:24:30,500 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link wrist -2020-12-21 21:24:30,500 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for manipulator from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:24:30,501 INFO CommonSwOperations.cs: 245 - Loading component with PID ?.???Manipulator-1@SimpleArm5 -2020-12-21 21:24:30,501 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Manipulator.SLDPRT -2020-12-21 21:24:30,502 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link manipulator -2020-12-21 21:24:30,533 INFO SwAddin.cs: 344 - Showing property manager -2020-12-21 21:24:52,093 INFO ExportPropertyManager.cs: 422 - Configuration saved -2020-12-21 21:24:52,099 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametrueturntablexyztrue-2.8254193696243868E-170-6.7465241345308752E-18rpytrue000originfalsefalsevaluetrue0.39680623003092352massfalseixxtrue0.00057145415023748434ixytrue0ixztrue2.2383483955223888E-21iyytrue0.0011002410492471767iyztrue0izztrue0.00057145415023748434inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametruegearboxxyztrue-6.8631413935065579E-180.03801532439663572-0.0013892205096921757rpytrue000originfalsefalsevaluetrue0.34120985304638518massfalseixxtrue0.00063726488338474081ixytrue7.0764513023917949E-20ixztrue-2.7252675378665934E-19iyytrue0.00083450439761804886iyztrue1.6294136810805574E-05izztrue0.00088931887892574886inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink1_jointtypetruecontinuousxyztrue000.0127rpytrue1.570800originfalsefalselinktrueturntableparenttruelinktruegearboxchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link1_joint2Origin_link1_joint2linktruenametrueupperarmxyztrue1.4123887173905075E-170.157206632847804122.7755575615628914E-17rpytrue000originfalsefalsevaluetrue1.264124215876306massfalseixxtrue0.013677990391055649ixytrue3.368445392332098E-19ixztrue3.9611983830710858E-20iyytrue0.000964387075304149iyztrue-2.6745670344635044E-18izztrue0.014091749673708917inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink2_jointtypetruecontinuousxyztrue00.072390.03683rpytrue000originfalsefalselinktruegearboxparenttruelinktrueupperarmchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link2_joint2Origin_link2_joint2linktruenametrueelbowxyztrue7.3321042375852733E-180.046279720003911486-0.0099170828579809855rpytrue000originfalsefalsevaluetrue0.625328404239412massfalseixxtrue0.0015093628788121875ixytrue7.2251958937028559E-20ixztrue2.6531119727066055E-20iyytrue0.00077150412582161528iyztrue-1.1346887107722466E-05izztrue0.0010232990551232335inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink3_jointtypetruecontinuousxyztrue00.3810rpytrue-1.570800originfalsefalselinktrueupperarmparenttruelinktrueelbowchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link3_jointOrigin_link3_jointlinktruenametrueforearmxyztrue-1.1893700871757326E-17-1.9081958235744878E-17-0.11306639219877124rpytrue000originfalsefalsevaluetrue0.46063240123192695massfalseixxtrue0.0022362056644483611ixytrue2.8623740668759855E-21ixztrue-6.9238813900453064E-20iyytrue0.0022468403158638628iyztrue-3.0218548775228389E-19izztrue0.00024560226807657237inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink4_jointtypetruecontinuousxyztrue00.044450.04445rpytrue3.141600originfalsefalselinktrueelbowparenttruelinktrueforearmchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link4_jointOrigin_link4_jointlinktruenametruewristxyztrue-7.1276563553462352E-097.8062556418956319E-18-3.4149891803281207E-09rpytrue000originfalsefalsevaluetrue0.064200890136229274massfalseixxtrue3.4980909309943769E-05ixytrue5.2887802729807491E-11ixztrue1.565944720011522E-18iyytrue2.4290927928157113E-05iyztrue-4.3708304367957221E-11izztrue2.8670971509987432E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink5_jointtypetruecontinuousxyztrue00-0.254rpytrue3.141600originfalsefalselinktrueforearmparenttruelinktruewristchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link5_jointOrigin_link5_jointlinktruenametruemanipulatorxyztrue3.4694469519536142E-189.8733856357333089E-18-0.038099999999999912rpytrue000originfalsefalsevaluetrue0.1580336580927709massfalseixxtrue0.00011719996250307502ixytrue2.2033040782480907E-21ixztrue2.5135101783302778E-20iyytrue0.00011719996250307503iyztrue8.5958526221282082E-21izztrue8.1464432723451653E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink6_jointtypetruecontinuousxyztrue000.0254rpytrue3.141601.5708originfalsefalselinktruewristparenttruelinktruemanipulatorchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link6_jointOrigin_link6_jointlinktruefalse4C4AAAUAAAD//v8XTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAA1AAAAfalsefalsefalse4C4AAAUAAAD//v8RVwByAGkAcwB0AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAxAAAAfalsefalsefalse4C4AAAUAAAD//v8TRgBvAHIAZQBhAHIAbQAtADEAQABTAGkAbQBwAGwAZQBBAHIAbQAEAAAAEAAAAAEAAAABAAAAKgAAAA==falsefalsefalse4C4AAAUAAAD//v8RRQBsAGIAbwB3AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAoAAAAfalsefalsefalse4C4AAAUAAAD//v8UVQBwAHAAZQByAEEAcgBtAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAaAAAAfalsefalsefalse4C4AAAUAAAD//v8UUwBoAG8AdQBsAGQAZQByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAYAAAAfalsefalsefalse4C4AAAUAAAD//v8VVAB1AHIAbgBUAGEAYgBsAGUALQAxAEAAUwBpAG0AcABsAGUAQQByAG0ABAAAABAAAAABAAAAAQAAABkAAAA=falsefalse -2020-12-21 21:24:52,272 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2020-12-21 21:26:19,586 INFO SwAddin.cs: 294 - Assembly export called for file wroboarm_21 -2020-12-21 21:26:19,586 INFO SwAddin.cs: 299 - Save is required -2020-12-21 21:26:19,587 INFO SwAddin.cs: 313 - Saving assembly -2020-12-21 21:26:20,090 INFO SwAddin.cs: 316 - Opening property manager -2020-12-21 21:26:20,091 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from wroboarm_21 -2020-12-21 21:26:20,092 INFO ExportHelperExtension.cs: 1136 - Found 59 in wroboarm_21 -2020-12-21 21:26:20,093 INFO ExportHelperExtension.cs: 1145 - Found 7 features of type [CoordSys] in wroboarm_21 -2020-12-21 21:26:20,094 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2020-12-21 21:26:20,095 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2020-12-21 21:26:20,096 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forearm-1 -2020-12-21 21:26:20,097 INFO ExportHelperExtension.cs: 1136 - Found 31 in Forearm-1 -2020-12-21 21:26:20,098 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forearm-1 -2020-12-21 21:26:20,099 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Elbow-1 -2020-12-21 21:26:20,100 INFO ExportHelperExtension.cs: 1136 - Found 27 in Elbow-1 -2020-12-21 21:26:20,101 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Elbow-1 -2020-12-21 21:26:20,103 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from TurnTable-1 -2020-12-21 21:26:20,104 INFO ExportHelperExtension.cs: 1136 - Found 25 in TurnTable-1 -2020-12-21 21:26:20,105 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in TurnTable-1 -2020-12-21 21:26:20,106 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2020-12-21 21:26:20,108 INFO ExportHelperExtension.cs: 1136 - Found 27 in UpperArm-1 -2020-12-21 21:26:20,109 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2020-12-21 21:26:20,110 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2020-12-21 21:26:20,111 INFO ExportHelperExtension.cs: 1136 - Found 29 in Shoulder-1 -2020-12-21 21:26:20,113 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2020-12-21 21:26:20,115 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2020-12-21 21:26:20,116 INFO ExportHelperExtension.cs: 1136 - Found 27 in Manipulator-1 -2020-12-21 21:26:20,122 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2020-12-21 21:26:20,123 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2020-12-21 21:26:20,125 INFO ExportHelperExtension.cs: 1136 - Found 29 in Wrist-1 -2020-12-21 21:26:20,127 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2020-12-21 21:26:20,128 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from wroboarm_21 -2020-12-21 21:26:20,129 INFO ExportHelperExtension.cs: 1136 - Found 59 in wroboarm_21 -2020-12-21 21:26:20,130 INFO ExportHelperExtension.cs: 1145 - Found 6 features of type [RefAxis] in wroboarm_21 -2020-12-21 21:26:20,133 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2020-12-21 21:26:20,134 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2020-12-21 21:26:20,135 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forearm-1 -2020-12-21 21:26:20,136 INFO ExportHelperExtension.cs: 1136 - Found 31 in Forearm-1 -2020-12-21 21:26:20,137 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forearm-1 -2020-12-21 21:26:20,138 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Elbow-1 -2020-12-21 21:26:20,139 INFO ExportHelperExtension.cs: 1136 - Found 27 in Elbow-1 -2020-12-21 21:26:20,149 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Elbow-1 -2020-12-21 21:26:20,151 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from TurnTable-1 -2020-12-21 21:26:20,231 INFO ExportHelperExtension.cs: 1136 - Found 25 in TurnTable-1 -2020-12-21 21:26:20,233 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in TurnTable-1 -2020-12-21 21:26:20,234 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2020-12-21 21:26:20,235 INFO ExportHelperExtension.cs: 1136 - Found 27 in UpperArm-1 -2020-12-21 21:26:20,238 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2020-12-21 21:26:20,239 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2020-12-21 21:26:20,240 INFO ExportHelperExtension.cs: 1136 - Found 29 in Shoulder-1 -2020-12-21 21:26:20,241 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2020-12-21 21:26:20,242 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2020-12-21 21:26:20,243 INFO ExportHelperExtension.cs: 1136 - Found 27 in Manipulator-1 -2020-12-21 21:26:20,244 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2020-12-21 21:26:20,244 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2020-12-21 21:26:20,247 INFO ExportHelperExtension.cs: 1136 - Found 29 in Wrist-1 -2020-12-21 21:26:20,248 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2020-12-21 21:26:20,353 INFO SwAddin.cs: 339 - Loading config tree -2020-12-21 21:26:20,357 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametrueturntablexyztrue-2.8254193696243868E-170-6.7465241345308752E-18rpytrue000originfalsefalsevaluetrue0.39680623003092352massfalseixxtrue0.00057145415023748434ixytrue0ixztrue2.2383483955223888E-21iyytrue0.0011002410492471767iyztrue0izztrue0.00057145415023748434inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametruegearboxxyztrue-6.8631413935065579E-180.03801532439663572-0.0013892205096921757rpytrue000originfalsefalsevaluetrue0.34120985304638518massfalseixxtrue0.00063726488338474081ixytrue7.0764513023917949E-20ixztrue-2.7252675378665934E-19iyytrue0.00083450439761804886iyztrue1.6294136810805574E-05izztrue0.00088931887892574886inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink1_jointtypetruecontinuousxyztrue000.0127rpytrue1.570800originfalsefalselinktrueturntableparenttruelinktruegearboxchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueupperarmxyztrue1.4123887173905075E-170.157206632847804122.7755575615628914E-17rpytrue000originfalsefalsevaluetrue1.264124215876306massfalseixxtrue0.013677990391055649ixytrue3.368445392332098E-19ixztrue3.9611983830710858E-20iyytrue0.000964387075304149iyztrue-2.6745670344635044E-18izztrue0.014091749673708917inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink2_jointtypetruecontinuousxyztrue00.072390.03683rpytrue000originfalsefalselinktruegearboxparenttruelinktrueupperarmchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueelbowxyztrue7.3321042375852733E-180.046279720003911486-0.0099170828579809855rpytrue000originfalsefalsevaluetrue0.625328404239412massfalseixxtrue0.0015093628788121875ixytrue7.2251958937028559E-20ixztrue2.6531119727066055E-20iyytrue0.00077150412582161528iyztrue-1.1346887107722466E-05izztrue0.0010232990551232335inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink3_jointtypetruecontinuousxyztrue00.3810rpytrue-1.570800originfalsefalselinktrueupperarmparenttruelinktrueelbowchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link3_jointOrigin_link3_jointlinktruenametrueforearmxyztrue-1.1893700871757326E-17-1.9081958235744878E-17-0.11306639219877124rpytrue000originfalsefalsevaluetrue0.46063240123192695massfalseixxtrue0.0022362056644483611ixytrue2.8623740668759855E-21ixztrue-6.9238813900453064E-20iyytrue0.0022468403158638628iyztrue-3.0218548775228389E-19izztrue0.00024560226807657237inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink4_jointtypetruecontinuousxyztrue00.044450.04445rpytrue3.141600originfalsefalselinktrueelbowparenttruelinktrueforearmchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link4_jointOrigin_link4_jointlinktruenametruewristxyztrue-7.1276563553462352E-097.8062556418956319E-18-3.4149891803281207E-09rpytrue000originfalsefalsevaluetrue0.064200890136229274massfalseixxtrue3.4980909309943769E-05ixytrue5.2887802729807491E-11ixztrue1.565944720011522E-18iyytrue2.4290927928157113E-05iyztrue-4.3708304367957221E-11izztrue2.8670971509987432E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink5_jointtypetruecontinuousxyztrue00-0.254rpytrue3.141600originfalsefalselinktrueforearmparenttruelinktruewristchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link5_jointOrigin_link5_jointlinktruenametruemanipulatorxyztrue3.4694469519536142E-189.8733856357333089E-18-0.038099999999999912rpytrue000originfalsefalsevaluetrue0.1580336580927709massfalseixxtrue0.00011719996250307502ixytrue2.2033040782480907E-21ixztrue2.5135101783302778E-20iyytrue0.00011719996250307503iyztrue8.5958526221282082E-21izztrue8.1464432723451653E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink6_jointtypetruecontinuousxyztrue000.0254rpytrue3.141601.5708originfalsefalselinktruewristparenttruelinktruemanipulatorchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link6_jointOrigin_link6_jointlinktruefalseyDIAAAUAAAD//v8XTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAA1AAAAfalsefalsefalseyDIAAAUAAAD//v8RVwByAGkAcwB0AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAxAAAAfalsefalsefalseyDIAAAUAAAD//v8TRgBvAHIAZQBhAHIAbQAtADEAQABTAGkAbQBwAGwAZQBBAHIAbQAEAAAAEAAAAAEAAAABAAAAKgAAAA==falsefalsefalseyDIAAAUAAAD//v8RRQBsAGIAbwB3AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAoAAAAfalsefalsefalseyDIAAAUAAAD//v8UVQBwAHAAZQByAEEAcgBtAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAaAAAAfalsefalsefalseyDIAAAUAAAD//v8UUwBoAG8AdQBsAGQAZQByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAYAAAAfalsefalsefalseyDIAAAUAAAD//v8VVAB1AHIAbgBUAGEAYgBsAGUALQAxAEAAUwBpAG0AcABsAGUAQQByAG0ABAAAABAAAAABAAAAAQAAABkAAAA=falsefalse -2020-12-21 21:26:20,365 INFO LinkNode.cs: 35 - Building node turntable -2020-12-21 21:26:20,366 INFO LinkNode.cs: 35 - Building node gearbox -2020-12-21 21:26:20,366 INFO LinkNode.cs: 35 - Building node upperarm -2020-12-21 21:26:20,367 INFO LinkNode.cs: 35 - Building node elbow -2020-12-21 21:26:20,368 INFO LinkNode.cs: 35 - Building node forearm -2020-12-21 21:26:20,369 INFO LinkNode.cs: 35 - Building node wrist -2020-12-21 21:26:20,369 INFO LinkNode.cs: 35 - Building node manipulator -2020-12-21 21:26:20,370 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for turntable from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,371 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???TurnTable-1@SimpleArm -2020-12-21 21:26:20,372 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\TurnTable.SLDPRT -2020-12-21 21:26:20,373 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link turntable -2020-12-21 21:26:20,374 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for gearbox from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,374 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???Shoulder-1@SimpleArm -2020-12-21 21:26:20,376 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Shoulder.SLDPRT -2020-12-21 21:26:20,376 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link gearbox -2020-12-21 21:26:20,377 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for upperarm from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,378 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???UpperArm-1@SimpleArm -2020-12-21 21:26:20,380 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\UpperArm.SLDPRT -2020-12-21 21:26:20,381 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link upperarm -2020-12-21 21:26:20,381 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for elbow from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,382 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???Elbow-1@SimpleArm( -2020-12-21 21:26:20,383 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Elbow.SLDPRT -2020-12-21 21:26:20,384 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link elbow -2020-12-21 21:26:20,385 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for forearm from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,386 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???Forearm-1@SimpleArm* -2020-12-21 21:26:20,387 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Forearm.SLDPRT -2020-12-21 21:26:20,388 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link forearm -2020-12-21 21:26:20,390 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for wrist from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,391 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???Wrist-1@SimpleArm1 -2020-12-21 21:26:20,392 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Wrist.SLDPRT -2020-12-21 21:26:20,393 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link wrist -2020-12-21 21:26:20,395 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for manipulator from C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\wroboarm_21.SLDASM -2020-12-21 21:26:20,395 INFO CommonSwOperations.cs: 245 - Loading component with PID ?2???Manipulator-1@SimpleArm5 -2020-12-21 21:26:20,397 INFO CommonSwOperations.cs: 254 - Successfully loaded component C:\Users\ustuner\Desktop\GrabCAD\WRover20\am_system\am_resources\IK Model\Manipulator.SLDPRT -2020-12-21 21:26:20,398 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link manipulator -2020-12-21 21:26:20,427 INFO SwAddin.cs: 344 - Showing property manager -2020-12-21 21:26:35,601 INFO ExportPropertyManager.cs: 422 - Configuration saved -2020-12-21 21:26:35,603 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametrueturntablexyztrue-2.8254193696243868E-170-6.7465241345308752E-18rpytrue000originfalsefalsevaluetrue0.39680623003092352massfalseixxtrue0.00057145415023748434ixytrue0ixztrue2.2383483955223888E-21iyytrue0.0011002410492471767iyztrue0izztrue0.00057145415023748434inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametruegearboxxyztrue-6.8631413935065579E-180.03801532439663572-0.0013892205096921757rpytrue000originfalsefalsevaluetrue0.34120985304638518massfalseixxtrue0.00063726488338474081ixytrue7.0764513023917949E-20ixztrue-2.7252675378665934E-19iyytrue0.00083450439761804886iyztrue1.6294136810805574E-05izztrue0.00088931887892574886inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink1_jointtypetruecontinuousxyztrue000.0127rpytrue1.570800originfalsefalselinktrueturntableparenttruelinktruegearboxchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueupperarmxyztrue1.4123887173905075E-170.157206632847804122.7755575615628914E-17rpytrue000originfalsefalsevaluetrue1.264124215876306massfalseixxtrue0.013677990391055649ixytrue3.368445392332098E-19ixztrue3.9611983830710858E-20iyytrue0.000964387075304149iyztrue-2.6745670344635044E-18izztrue0.014091749673708917inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink2_jointtypetruecontinuousxyztrue00.072390.03683rpytrue000originfalsefalselinktruegearboxparenttruelinktrueupperarmchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueelbowxyztrue7.3321042375852733E-180.046279720003911486-0.0099170828579809855rpytrue000originfalsefalsevaluetrue0.625328404239412massfalseixxtrue0.0015093628788121875ixytrue7.2251958937028559E-20ixztrue2.6531119727066055E-20iyytrue0.00077150412582161528iyztrue-1.1346887107722466E-05izztrue0.0010232990551232335inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink3_jointtypetruecontinuousxyztrue00.3810rpytrue-1.570800originfalsefalselinktrueupperarmparenttruelinktrueelbowchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link3_jointOrigin_link3_jointlinktruenametrueforearmxyztrue-1.1893700871757326E-17-1.9081958235744878E-17-0.11306639219877124rpytrue000originfalsefalsevaluetrue0.46063240123192695massfalseixxtrue0.0022362056644483611ixytrue2.8623740668759855E-21ixztrue-6.9238813900453064E-20iyytrue0.0022468403158638628iyztrue-3.0218548775228389E-19izztrue0.00024560226807657237inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink4_jointtypetruecontinuousxyztrue00.044450.04445rpytrue3.141600originfalsefalselinktrueelbowparenttruelinktrueforearmchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link4_jointOrigin_link4_jointlinktruenametruewristxyztrue-7.1276563553462352E-097.8062556418956319E-18-3.4149891803281207E-09rpytrue000originfalsefalsevaluetrue0.064200890136229274massfalseixxtrue3.4980909309943769E-05ixytrue5.2887802729807491E-11ixztrue1.565944720011522E-18iyytrue2.4290927928157113E-05iyztrue-4.3708304367957221E-11izztrue2.8670971509987432E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink5_jointtypetruecontinuousxyztrue00-0.254rpytrue3.141600originfalsefalselinktrueforearmparenttruelinktruewristchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link5_jointOrigin_link5_jointlinktruenametruemanipulatorxyztrue3.4694469519536142E-189.8733856357333089E-18-0.038099999999999912rpytrue000originfalsefalsevaluetrue0.1580336580927709massfalseixxtrue0.00011719996250307502ixytrue2.2033040782480907E-21ixztrue2.5135101783302778E-20iyytrue0.00011719996250307503iyztrue8.5958526221282082E-21izztrue8.1464432723451653E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink6_jointtypetruecontinuousxyztrue000.0254rpytrue3.141601.5708originfalsefalselinktruewristparenttruelinktruemanipulatorchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link6_jointOrigin_link6_jointlinktruefalseyDIAAAUAAAD//v8XTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAA1AAAAfalsefalsefalseyDIAAAUAAAD//v8RVwByAGkAcwB0AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAxAAAAfalsefalsefalseyDIAAAUAAAD//v8TRgBvAHIAZQBhAHIAbQAtADEAQABTAGkAbQBwAGwAZQBBAHIAbQAEAAAAEAAAAAEAAAABAAAAKgAAAA==falsefalsefalseyDIAAAUAAAD//v8RRQBsAGIAbwB3AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAoAAAAfalsefalsefalseyDIAAAUAAAD//v8UVQBwAHAAZQByAEEAcgBtAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAaAAAAfalsefalsefalseyDIAAAUAAAD//v8UUwBoAG8AdQBsAGQAZQByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAYAAAAfalsefalsefalseyDIAAAUAAAD//v8VVAB1AHIAbgBUAGEAYgBsAGUALQAxAEAAUwBpAG0AcABsAGUAQQByAG0ABAAAABAAAAABAAAAAQAAABkAAAA=falsefalse -2020-12-21 21:26:35,744 INFO ExportHelperExtension.cs: 347 - Creating joint gearbox -2020-12-21 21:26:35,753 INFO ExportHelperExtension.cs: 1397 - Fixing components for turntable -2020-12-21 21:26:35,754 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2020-12-21 21:26:36,153 INFO : 0 - R1: 1, System.__ComObject, 1, System.Double[] -2020-12-21 21:26:36,158 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2020-12-21 21:26:36,158 INFO ExportHelperExtension.cs: 849 - L1: 0 -2020-12-21 21:26:36,159 INFO ExportHelperExtension.cs: 857 - L2: 0 -2020-12-21 21:26:36,298 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2020-12-21 21:26:39,178 WARN ExportHelperExtension.cs: 351 - Creating joint from parent turntable to child gearbox failed -2020-12-21 21:26:39,185 INFO ExportHelperExtension.cs: 347 - Creating joint upperarm -2020-12-21 21:26:39,186 INFO ExportHelperExtension.cs: 1397 - Fixing components for gearbox -2020-12-21 21:26:39,186 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2020-12-21 21:26:39,186 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2020-12-21 21:26:39,481 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2020-12-21 21:26:39,482 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2020-12-21 21:26:39,483 INFO ExportHelperExtension.cs: 849 - L1: 0 -2020-12-21 21:26:39,483 INFO ExportHelperExtension.cs: 857 - L2: 0 -2020-12-21 21:26:39,484 INFO ExportHelperExtension.cs: 1352 - Unfixing component 24 -2020-12-21 21:26:39,484 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2020-12-21 21:26:42,112 WARN ExportHelperExtension.cs: 351 - Creating joint from parent gearbox to child upperarm failed -2020-12-21 21:26:42,118 INFO ExportHelperExtension.cs: 347 - Creating joint elbow -2020-12-21 21:26:42,166 WARN ExportHelperExtension.cs: 351 - Creating joint from parent upperarm to child elbow failed -2020-12-21 21:26:42,172 INFO ExportHelperExtension.cs: 347 - Creating joint forearm -2020-12-21 21:26:42,224 WARN ExportHelperExtension.cs: 351 - Creating joint from parent elbow to child forearm failed -2020-12-21 21:26:42,231 INFO ExportHelperExtension.cs: 347 - Creating joint wrist -2020-12-21 21:26:42,283 WARN ExportHelperExtension.cs: 351 - Creating joint from parent forearm to child wrist failed -2020-12-21 21:26:42,290 INFO ExportHelperExtension.cs: 347 - Creating joint manipulator -2020-12-21 21:26:42,346 WARN ExportHelperExtension.cs: 351 - Creating joint from parent wrist to child manipulator failed -2020-12-21 21:26:42,543 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from wroboarm_21 -2020-12-21 21:26:42,552 INFO ExportHelperExtension.cs: 1136 - Found 63 in wroboarm_21 -2020-12-21 21:26:42,553 INFO ExportHelperExtension.cs: 1145 - Found 9 features of type [CoordSys] in wroboarm_21 -2020-12-21 21:26:42,554 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2020-12-21 21:26:42,554 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2020-12-21 21:26:42,554 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forearm-1 -2020-12-21 21:26:42,555 INFO ExportHelperExtension.cs: 1136 - Found 31 in Forearm-1 -2020-12-21 21:26:42,555 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forearm-1 -2020-12-21 21:26:42,556 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Elbow-1 -2020-12-21 21:26:42,556 INFO ExportHelperExtension.cs: 1136 - Found 27 in Elbow-1 -2020-12-21 21:26:42,557 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Elbow-1 -2020-12-21 21:26:42,557 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from TurnTable-1 -2020-12-21 21:26:42,558 INFO ExportHelperExtension.cs: 1136 - Found 25 in TurnTable-1 -2020-12-21 21:26:42,558 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in TurnTable-1 -2020-12-21 21:26:42,559 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2020-12-21 21:26:42,560 INFO ExportHelperExtension.cs: 1136 - Found 27 in UpperArm-1 -2020-12-21 21:26:42,560 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2020-12-21 21:26:42,561 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2020-12-21 21:26:42,561 INFO ExportHelperExtension.cs: 1136 - Found 29 in Shoulder-1 -2020-12-21 21:26:42,562 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2020-12-21 21:26:42,562 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2020-12-21 21:26:42,563 INFO ExportHelperExtension.cs: 1136 - Found 27 in Manipulator-1 -2020-12-21 21:26:42,563 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2020-12-21 21:26:42,563 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2020-12-21 21:26:42,564 INFO ExportHelperExtension.cs: 1136 - Found 29 in Wrist-1 -2020-12-21 21:26:42,564 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2020-12-21 21:26:42,565 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from wroboarm_21 -2020-12-21 21:26:42,565 INFO ExportHelperExtension.cs: 1136 - Found 63 in wroboarm_21 -2020-12-21 21:26:42,566 INFO ExportHelperExtension.cs: 1145 - Found 8 features of type [RefAxis] in wroboarm_21 -2020-12-21 21:26:42,566 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2020-12-21 21:26:42,569 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2020-12-21 21:26:42,570 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forearm-1 -2020-12-21 21:26:42,598 INFO ExportHelperExtension.cs: 1136 - Found 31 in Forearm-1 -2020-12-21 21:26:42,599 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forearm-1 -2020-12-21 21:26:42,599 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Elbow-1 -2020-12-21 21:26:42,599 INFO ExportHelperExtension.cs: 1136 - Found 27 in Elbow-1 -2020-12-21 21:26:42,599 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Elbow-1 -2020-12-21 21:26:42,600 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from TurnTable-1 -2020-12-21 21:26:42,600 INFO ExportHelperExtension.cs: 1136 - Found 25 in TurnTable-1 -2020-12-21 21:26:42,601 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in TurnTable-1 -2020-12-21 21:26:42,601 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2020-12-21 21:26:42,602 INFO ExportHelperExtension.cs: 1136 - Found 27 in UpperArm-1 -2020-12-21 21:26:42,602 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2020-12-21 21:26:42,603 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2020-12-21 21:26:42,603 INFO ExportHelperExtension.cs: 1136 - Found 29 in Shoulder-1 -2020-12-21 21:26:42,604 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2020-12-21 21:26:42,604 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2020-12-21 21:26:42,605 INFO ExportHelperExtension.cs: 1136 - Found 27 in Manipulator-1 -2020-12-21 21:26:42,605 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2020-12-21 21:26:42,606 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2020-12-21 21:26:42,608 INFO ExportHelperExtension.cs: 1136 - Found 29 in Wrist-1 -2020-12-21 21:26:42,609 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2020-12-21 21:26:42,695 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2020-12-21 21:27:18,266 INFO AssemblyExportForm.cs: 253 - Completing URDF export -2020-12-21 21:27:18,273 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametrueturntablexyztrue-2.8254193696243868E-170-6.7465241345308752E-18rpytrue000originfalsefalsevaluetrue0.39680623003092352massfalseixxtrue0.00057145415023748434ixytrue0ixztrue2.2383483955223888E-21iyytrue0.0011002410492471767iyztrue0izztrue0.00057145415023748434inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametruegearboxxyztrue-6.8631413935065579E-180.03801532439663572-0.0013892205096921757rpytrue000originfalsefalsevaluetrue0.34120985304638518massfalseixxtrue0.00063726488338474081ixytrue7.0764513023917949E-20ixztrue-2.7252675378665934E-19iyytrue0.00083450439761804886iyztrue1.6294136810805574E-05izztrue0.00088931887892574886inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink1_jointtypetruecontinuousxyztrue000.0127rpytrue1.570800originfalsefalselinktrueturntableparenttruelinktruegearboxchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueupperarmxyztrue1.4123887173905075E-170.157206632847804122.7755575615628914E-17rpytrue000originfalsefalsevaluetrue1.264124215876306massfalseixxtrue0.013677990391055649ixytrue3.368445392332098E-19ixztrue3.9611983830710858E-20iyytrue0.000964387075304149iyztrue-2.6745670344635044E-18izztrue0.014091749673708917inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink2_jointtypetruecontinuousxyztrue00.072390.03683rpytrue000originfalsefalselinktruegearboxparenttruelinktrueupperarmchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueelbowxyztrue7.3321042375852733E-180.046279720003911486-0.0099170828579809855rpytrue000originfalsefalsevaluetrue0.625328404239412massfalseixxtrue0.0015093628788121875ixytrue7.2251958937028559E-20ixztrue2.6531119727066055E-20iyytrue0.00077150412582161528iyztrue-1.1346887107722466E-05izztrue0.0010232990551232335inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink3_jointtypetruecontinuousxyztrue00.3810rpytrue-1.570800originfalsefalselinktrueupperarmparenttruelinktrueelbowchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link3_jointOrigin_link3_jointlinktruenametrueforearmxyztrue-1.1893700871757326E-17-1.9081958235744878E-17-0.11306639219877124rpytrue000originfalsefalsevaluetrue0.46063240123192695massfalseixxtrue0.0022362056644483611ixytrue2.8623740668759855E-21ixztrue-6.9238813900453064E-20iyytrue0.0022468403158638628iyztrue-3.0218548775228389E-19izztrue0.00024560226807657237inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink4_jointtypetruecontinuousxyztrue00.044450.04445rpytrue3.141600originfalsefalselinktrueelbowparenttruelinktrueforearmchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link4_jointOrigin_link4_jointlinktruenametruewristxyztrue-7.1276563553462352E-097.8062556418956319E-18-3.4149891803281207E-09rpytrue000originfalsefalsevaluetrue0.064200890136229274massfalseixxtrue3.4980909309943769E-05ixytrue5.2887802729807491E-11ixztrue1.565944720011522E-18iyytrue2.4290927928157113E-05iyztrue-4.3708304367957221E-11izztrue2.8670971509987432E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink5_jointtypetruecontinuousxyztrue00-0.254rpytrue3.141600originfalsefalselinktrueforearmparenttruelinktruewristchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link5_jointOrigin_link5_jointlinktruenametruemanipulatorxyztrue3.4694469519536142E-189.8733856357333089E-18-0.038099999999999912rpytrue000originfalsefalsevaluetrue0.1580336580927709massfalseixxtrue0.00011719996250307502ixytrue2.2033040782480907E-21ixztrue2.5135101783302778E-20iyytrue0.00011719996250307503iyztrue8.5958526221282082E-21izztrue8.1464432723451653E-05inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruelink6_jointtypetruecontinuousxyztrue000.0254rpytrue3.141601.5708originfalsefalselinktruewristparenttruelinktruemanipulatorchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upperfalsesoft_lowerfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_link6_jointOrigin_link6_jointlinktruefalseyDIAAAUAAAD//v8XTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAA1AAAAfalsefalsefalseyDIAAAUAAAD//v8RVwByAGkAcwB0AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAxAAAAfalsefalsefalseyDIAAAUAAAD//v8TRgBvAHIAZQBhAHIAbQAtADEAQABTAGkAbQBwAGwAZQBBAHIAbQAEAAAAEAAAAAEAAAABAAAAKgAAAA==falsefalsefalseyDIAAAUAAAD//v8RRQBsAGIAbwB3AC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAoAAAAfalsefalsefalseyDIAAAUAAAD//v8UVQBwAHAAZQByAEEAcgBtAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAaAAAAfalsefalsefalseyDIAAAUAAAD//v8UUwBoAG8AdQBsAGQAZQByAC0AMQBAAFMAaQBtAHAAbABlAEEAcgBtAAQAAAAQAAAAAQAAAAEAAAAYAAAAfalsefalsefalseyDIAAAUAAAD//v8VVAB1AHIAbgBUAGEAYgBsAGUALQAxAEAAUwBpAG0AcABsAGUAQQByAG0ABAAAABAAAAABAAAAAQAAABkAAAA=falsefalse -2020-12-21 21:27:31,234 INFO AssemblyExportForm.cs: 309 - Saving URDF package to C:\Users\ustuner\Desktop\wroboarm_21 -2020-12-21 21:27:31,236 INFO ExportHelper.cs: 147 - Beginning the export process -2020-12-21 21:27:31,238 INFO ExportHelper.cs: 153 - Creating package directories with name wroboarm_21 and save path C:\Users\ustuner\Desktop -2020-12-21 21:27:32,837 INFO ExportHelper.cs: 162 - Creating CMakeLists.txt at C:\Users\ustuner\Desktop\wroboarm_21\CMakeLists.txt -2020-12-21 21:27:32,845 INFO ExportHelper.cs: 166 - Creating joint names config at C:\Users\ustuner\Desktop\wroboarm_21\config\joint_names_wroboarm_21.yaml -2020-12-21 21:27:32,853 INFO ExportHelper.cs: 170 - Creating package.xml at C:\Users\ustuner\Desktop\wroboarm_21\package.xml -2020-12-21 21:27:32,854 INFO PackageXMLWriter.cs: 21 - Creating package.xml at C:\Users\ustuner\Desktop\wroboarm_21\package.xml -2020-12-21 21:27:32,867 INFO ExportHelper.cs: 177 - Creating RVIZ launch file in C:\Users\ustuner\Desktop\wroboarm_21\launch\ -2020-12-21 21:27:32,876 INFO ExportHelper.cs: 182 - Creating Gazebo launch file in C:\Users\ustuner\Desktop\wroboarm_21\launch\ -2020-12-21 21:27:32,883 INFO ExportHelper.cs: 187 - Saving existing STL preferences -2020-12-21 21:27:32,884 INFO ExportHelper.cs: 450 - Saving users preferences -2020-12-21 21:27:32,886 INFO ExportHelper.cs: 190 - Modifying STL preferences -2020-12-21 21:27:32,886 INFO ExportHelper.cs: 464 - Setting STL preferences -2020-12-21 21:27:32,891 INFO ExportHelper.cs: 196 - Found 0 hidden components -2020-12-21 21:27:32,892 INFO ExportHelper.cs: 197 - Hiding all components -2020-12-21 21:27:33,029 INFO ExportHelper.cs: 204 - Beginning individual files export -2020-12-21 21:27:33,036 INFO ExportHelper.cs: 270 - Exporting link: turntable -2020-12-21 21:27:33,038 INFO ExportHelper.cs: 272 - Link turntable has 1 children -2020-12-21 21:27:33,040 INFO ExportHelper.cs: 270 - Exporting link: gearbox -2020-12-21 21:27:33,041 INFO ExportHelper.cs: 272 - Link gearbox has 1 children -2020-12-21 21:27:33,044 INFO ExportHelper.cs: 270 - Exporting link: upperarm -2020-12-21 21:27:33,044 INFO ExportHelper.cs: 272 - Link upperarm has 1 children -2020-12-21 21:27:33,046 INFO ExportHelper.cs: 270 - Exporting link: elbow -2020-12-21 21:27:33,047 INFO ExportHelper.cs: 272 - Link elbow has 1 children -2020-12-21 21:27:33,049 INFO ExportHelper.cs: 270 - Exporting link: forearm -2020-12-21 21:27:33,050 INFO ExportHelper.cs: 272 - Link forearm has 1 children -2020-12-21 21:27:33,053 INFO ExportHelper.cs: 270 - Exporting link: wrist -2020-12-21 21:27:33,053 INFO ExportHelper.cs: 272 - Link wrist has 1 children -2020-12-21 21:27:33,062 INFO ExportHelper.cs: 270 - Exporting link: manipulator -2020-12-21 21:27:33,063 INFO ExportHelper.cs: 272 - Link manipulator has 0 children -2020-12-21 21:27:33,064 INFO ExportHelper.cs: 317 - manipulator: Exporting STL with coordinate frame Origin_link6_joint -2020-12-21 21:27:33,065 INFO ExportHelper.cs: 322 - manipulator: Reference geometry name -2020-12-21 21:27:33,151 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\manipulator.STL -2020-12-21 21:27:33,492 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:33,500 INFO ExportHelper.cs: 317 - wrist: Exporting STL with coordinate frame Origin_link5_joint -2020-12-21 21:27:33,501 INFO ExportHelper.cs: 322 - wrist: Reference geometry name -2020-12-21 21:27:33,526 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\wrist.STL -2020-12-21 21:27:33,599 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:33,610 INFO ExportHelper.cs: 317 - forearm: Exporting STL with coordinate frame Origin_link4_joint -2020-12-21 21:27:33,611 INFO ExportHelper.cs: 322 - forearm: Reference geometry name -2020-12-21 21:27:33,629 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\forearm.STL -2020-12-21 21:27:33,722 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:33,748 INFO ExportHelper.cs: 317 - elbow: Exporting STL with coordinate frame Origin_link3_joint -2020-12-21 21:27:33,748 INFO ExportHelper.cs: 322 - elbow: Reference geometry name -2020-12-21 21:27:33,766 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\elbow.STL -2020-12-21 21:27:33,831 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:33,841 INFO ExportHelper.cs: 317 - upperarm: Exporting STL with coordinate frame Origin_link2_joint2 -2020-12-21 21:27:33,842 INFO ExportHelper.cs: 322 - upperarm: Reference geometry name -2020-12-21 21:27:33,862 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\upperarm.STL -2020-12-21 21:27:33,946 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:33,954 INFO ExportHelper.cs: 317 - gearbox: Exporting STL with coordinate frame Origin_link1_joint2 -2020-12-21 21:27:33,954 INFO ExportHelper.cs: 322 - gearbox: Reference geometry name -2020-12-21 21:27:33,978 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\gearbox.STL -2020-12-21 21:27:34,045 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:34,052 INFO ExportHelper.cs: 317 - turntable: Exporting STL with coordinate frame Origin_global -2020-12-21 21:27:34,052 INFO ExportHelper.cs: 322 - turntable: Reference geometry name -2020-12-21 21:27:34,070 INFO ExportHelper.cs: 330 - Saving STL to C:\Users\ustuner\Desktop\wroboarm_21\meshes\turntable.STL -2020-12-21 21:27:34,126 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2020-12-21 21:27:34,132 INFO ExportHelper.cs: 145 - Showing all components except previously hidden components -2020-12-21 21:27:34,218 INFO ExportHelper.cs: 145 - Resetting STL preferences -2020-12-21 21:27:34,219 INFO ExportHelper.cs: 478 - Returning STL preferences to user preferences -2020-12-21 21:27:34,220 INFO ExportHelper.cs: 228 - Writing URDF file to C:\Users\ustuner\Desktop\wroboarm_21\urdf\wroboarm_21.urdf -2020-12-21 21:27:34,314 INFO CSVImportExport.cs: 32 - Writing CSV file C:\Users\ustuner\Desktop\wroboarm_21\urdf\wroboarm_21.csv -2020-12-21 21:27:34,356 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,357 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,357 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,358 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,358 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,359 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,360 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2020-12-21 21:27:34,368 INFO ExportHelper.cs: 234 - Copying log file -2020-12-21 21:27:34,373 INFO ExportHelper.cs: 439 - Copying C:\Users\ustuner\sw2urdf_logs\sw2urdf.log to C:\Users\ustuner\Desktop\wroboarm_21\export.log diff --git a/src/wroboarm_21/launch/chomp_planning_pipeline.launch.xml b/src/wroboarm_21/launch/chomp_planning_pipeline.launch.xml deleted file mode 100644 index ca38555e..00000000 --- a/src/wroboarm_21/launch/chomp_planning_pipeline.launch.xml +++ /dev/null @@ -1,21 +0,0 @@ - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/demo.launch b/src/wroboarm_21/launch/demo.launch deleted file mode 100644 index 54b5b132..00000000 --- a/src/wroboarm_21/launch/demo.launch +++ /dev/null @@ -1,64 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - [move_group/fake_controller_joint_states] - - - [move_group/fake_controller_joint_states] - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/demo_gazebo.launch b/src/wroboarm_21/launch/demo_gazebo.launch deleted file mode 100644 index eb59236f..00000000 --- a/src/wroboarm_21/launch/demo_gazebo.launch +++ /dev/null @@ -1,74 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - [move_group/fake_controller_joint_states] - [/joint_states] - - - [move_group/fake_controller_joint_states] - [/joint_states] - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/demo_test.launch b/src/wroboarm_21/launch/demo_test.launch deleted file mode 100644 index d722f59d..00000000 --- a/src/wroboarm_21/launch/demo_test.launch +++ /dev/null @@ -1,66 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - [control/arm_joint_states] - - - [control/arm_joint_states] - - - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/display.launch b/src/wroboarm_21/launch/display.launch deleted file mode 100644 index 5b8e9435..00000000 --- a/src/wroboarm_21/launch/display.launch +++ /dev/null @@ -1,20 +0,0 @@ - - - - - - - \ No newline at end of file diff --git a/src/wroboarm_21/launch/fake_moveit_controller_manager.launch.xml b/src/wroboarm_21/launch/fake_moveit_controller_manager.launch.xml deleted file mode 100644 index f6c0f465..00000000 --- a/src/wroboarm_21/launch/fake_moveit_controller_manager.launch.xml +++ /dev/null @@ -1,9 +0,0 @@ - - - - - - - - - diff --git a/src/wroboarm_21/launch/gazebo.launch b/src/wroboarm_21/launch/gazebo.launch deleted file mode 100644 index 6e80529e..00000000 --- a/src/wroboarm_21/launch/gazebo.launch +++ /dev/null @@ -1,23 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/move_group.launch b/src/wroboarm_21/launch/move_group.launch deleted file mode 100644 index 1910c99f..00000000 --- a/src/wroboarm_21/launch/move_group.launch +++ /dev/null @@ -1,82 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/moveit_rviz.launch b/src/wroboarm_21/launch/moveit_rviz.launch deleted file mode 100644 index 615b2f12..00000000 --- a/src/wroboarm_21/launch/moveit_rviz.launch +++ /dev/null @@ -1,15 +0,0 @@ - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/ompl_planning_pipeline.launch.xml b/src/wroboarm_21/launch/ompl_planning_pipeline.launch.xml deleted file mode 100644 index 8ae6467c..00000000 --- a/src/wroboarm_21/launch/ompl_planning_pipeline.launch.xml +++ /dev/null @@ -1,25 +0,0 @@ - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml b/src/wroboarm_21/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml deleted file mode 100644 index 9478782e..00000000 --- a/src/wroboarm_21/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml +++ /dev/null @@ -1,19 +0,0 @@ - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/planning_context.launch b/src/wroboarm_21/launch/planning_context.launch deleted file mode 100644 index d57c692d..00000000 --- a/src/wroboarm_21/launch/planning_context.launch +++ /dev/null @@ -1,25 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/planning_pipeline.launch.xml b/src/wroboarm_21/launch/planning_pipeline.launch.xml deleted file mode 100644 index c64f6d61..00000000 --- a/src/wroboarm_21/launch/planning_pipeline.launch.xml +++ /dev/null @@ -1,10 +0,0 @@ - - - - - - - - - diff --git a/src/wroboarm_21/launch/setup_assistant.launch b/src/wroboarm_21/launch/setup_assistant.launch deleted file mode 100644 index 05acb517..00000000 --- a/src/wroboarm_21/launch/setup_assistant.launch +++ /dev/null @@ -1,15 +0,0 @@ - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/warehouse.launch b/src/wroboarm_21/launch/warehouse.launch deleted file mode 100644 index a19014e8..00000000 --- a/src/wroboarm_21/launch/warehouse.launch +++ /dev/null @@ -1,15 +0,0 @@ - - - - - - - - - - - - - - - diff --git a/src/wroboarm_21/launch/wroboarm_21_moveit_controller_manager.launch.xml b/src/wroboarm_21/launch/wroboarm_21_moveit_controller_manager.launch.xml deleted file mode 100644 index cd0d7e3d..00000000 --- a/src/wroboarm_21/launch/wroboarm_21_moveit_controller_manager.launch.xml +++ /dev/null @@ -1,10 +0,0 @@ - - - - - - - - - diff --git a/src/wroboarm_21/meshes/elbow.STL b/src/wroboarm_21/meshes/elbow.STL deleted file mode 100644 index 5b1cbba5..00000000 Binary files a/src/wroboarm_21/meshes/elbow.STL and /dev/null differ diff --git a/src/wroboarm_21/meshes/forearm.STL b/src/wroboarm_21/meshes/forearm.STL deleted file mode 100644 index 63094c85..00000000 Binary files a/src/wroboarm_21/meshes/forearm.STL and /dev/null differ diff --git a/src/wroboarm_21/meshes/gearbox.STL b/src/wroboarm_21/meshes/gearbox.STL deleted file mode 100644 index d6aa4344..00000000 Binary files a/src/wroboarm_21/meshes/gearbox.STL and /dev/null differ diff --git a/src/wroboarm_21/meshes/manipulator.STL b/src/wroboarm_21/meshes/manipulator.STL deleted file mode 100644 index 99e3aec0..00000000 Binary files a/src/wroboarm_21/meshes/manipulator.STL and /dev/null differ diff --git a/src/wroboarm_21/meshes/turntable.STL b/src/wroboarm_21/meshes/turntable.STL deleted file mode 100644 index 1f41c827..00000000 Binary files a/src/wroboarm_21/meshes/turntable.STL and /dev/null differ diff --git a/src/wroboarm_21/meshes/upperarm.STL b/src/wroboarm_21/meshes/upperarm.STL deleted file mode 100644 index 86c3f225..00000000 Binary files a/src/wroboarm_21/meshes/upperarm.STL and /dev/null differ diff --git a/src/wroboarm_21/meshes/wrist.STL b/src/wroboarm_21/meshes/wrist.STL deleted file mode 100644 index 76da8c35..00000000 Binary files a/src/wroboarm_21/meshes/wrist.STL and /dev/null differ diff --git a/src/wroboarm_21/package.xml b/src/wroboarm_21/package.xml deleted file mode 100644 index 6d699a80..00000000 --- a/src/wroboarm_21/package.xml +++ /dev/null @@ -1,35 +0,0 @@ - - - wroboarm_21 - 0.3.0 - - An automatically generated package with all the configuration and launch files for using the wroboarm_21 with the MoveIt Motion Planning Framework - - me - me - - BSD - - http://moveit.ros.org/ - https://github.com/ros-planning/moveit/issues - https://github.com/ros-planning/moveit - - catkin - - moveit_ros_move_group - moveit_fake_controller_manager - moveit_kinematics - moveit_planners_ompl - moveit_ros_visualization - moveit_setup_assistant - joint_state_publisher - joint_state_publisher_gui - robot_state_publisher - tf2_ros - xacro - - - - - - diff --git a/src/wroboarm_21/urdf/wroboarm_21.csv b/src/wroboarm_21/urdf/wroboarm_21.csv deleted file mode 100644 index a9b9bbac..00000000 --- a/src/wroboarm_21/urdf/wroboarm_21.csv +++ /dev/null @@ -1,8 +0,0 @@ -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 -turntable,-2.82541936962439E-17,6.93889390390723E-18,-4.24870678161208E-34,0,0,0,0.396806230030924,0.000571454150237484,-2.23834839552239E-21,1.37054783361242E-37,0.000571454150237484,3.23777898172651E-20,0.00110024104924718,0,0,0,0,0,0,package://wroboarm_21/meshes/turntable.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/turntable.stl,,TurnTable-1,Origin_global,,,,0,0,0,0,0,0,,0,0,0,,,,,,,,,,,, -gearbox,-5.70181409604587E-18,0.0380153243966357,-0.00138922050969218,0,0,0,0.341209853046385,0.000637264883384741,6.24923664103596E-20,-2.71681384497167E-19,0.000834504397618049,1.62941368108056E-05,0.000889318878925749,0,0,0,0,0,0,package://wroboarm_21/meshes/gearbox.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/gearbox.stl,,Shoulder-1,Origin_link1_joint2,Axis_link1_joint2,link1_joint,continuous,0,0,0.0127,1.5708,0,0,turntable,0,1,0,,,,,,,,,,,, -upperarm,1.49614561175028E-17,0.157206632847804,2.77555756156289E-17,0,0,0,1.26412421587631,0.0136779903910557,3.22448390771324E-19,3.96119838307109E-20,0.000964387075304149,-2.67429553724681E-18,0.0140917496737089,0,0,0,0,0,0,package://wroboarm_21/meshes/upperarm.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/upperarm.stl,,UpperArm-1,Origin_link2_joint2,Axis_link2_joint2,link2_joint,continuous,0,0.07239,0.03683,0,0,0,gearbox,1,0,0,,,,,,,,,,,, -elbow,7.33210423758527E-18,0.0462797200039115,-0.00991708285798099,0,0,0,0.625328404239412,0.00150936287881219,7.22519589370286E-20,2.65311197270661E-20,0.000771504125821615,-1.13468871077225E-05,0.00102329905512323,0,0,0,0,0,0,package://wroboarm_21/meshes/elbow.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/elbow.stl,,Elbow-1,Origin_link3_joint,Axis_link3_joint,link3_joint,continuous,0,0.381,0,-1.5708,0,0,upperarm,1,0,0,,,,,,,,,,,, -forearm,-1.32860243738577E-17,-1.90819582357449E-17,-0.113066392198771,0,0,0,0.460632401231927,0.00223620566444836,2.86239968572403E-21,-5.06454254732662E-20,0.00224684031586386,-3.05817065058502E-19,0.000245602268076572,0,0,0,0,0,0,package://wroboarm_21/meshes/forearm.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/forearm.stl,,Forearm-1,Origin_link4_joint,Axis_link4_joint,link4_joint,continuous,0,0.04445,0.04445,3.1416,0,0,elbow,0,0,1,,,,,,,,,,,, -wrist,-7.1276563552947E-09,7.80625564189563E-18,-3.41498918032812E-09,0,0,0,0.0642008901362293,3.49809093099438E-05,5.28878027298075E-11,1.56594471999825E-18,2.42909279281571E-05,-4.37083043679572E-11,2.86709715099874E-05,0,0,0,0,0,0,package://wroboarm_21/meshes/wrist.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/wrist.stl,,Wrist-1,Origin_link5_joint,Axis_link5_joint,link5_joint,continuous,0,0,-0.254,3.1416,0,0,forearm,1,0,0,,,,,,,,,,,, -manipulator,5.8113236445223E-17,1.74020910368395E-17,-0.05715,0,0,0,0.237050487139156,0.000319176967769642,-3.08271195529153E-21,3.16873566981017E-20,0.000319176967769642,7.05373762522642E-20,0.000122196649085178,0,0,0,0,0,0,package://wroboarm_21/meshes/manipulator.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_21/meshes/manipulator.stl,,Manipulator-1,Origin_link6_joint,Axis_link6_joint,link6_joint,continuous,0,0,0.0254,3.1416,0,1.5708,wrist,0,0,1,,,,,,,,,,,, diff --git a/src/wroboarm_21/urdf/wroboarm_21.urdf b/src/wroboarm_21/urdf/wroboarm_21.urdf deleted file mode 100644 index d5cdc0f7..00000000 --- a/src/wroboarm_21/urdf/wroboarm_21.urdf +++ /dev/null @@ -1,306 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/DifferentialTransmission - - actuator1 - hardware_interface/EffortJointInterface - 1 - - - actuator2 - hardware_interface/EffortJointInterface - 1 - - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - - - - - - / - - - \ No newline at end of file diff --git a/src/wroboarm_22/.setup_assistant b/src/wroboarm_22/.setup_assistant deleted file mode 100644 index 85e8ffb2..00000000 --- a/src/wroboarm_22/.setup_assistant +++ /dev/null @@ -1,11 +0,0 @@ -moveit_setup_assistant_config: - URDF: - package: wroboarm_22 - relative_path: urdf/wroboarm_22.urdf - xacro_args: "" - SRDF: - relative_path: config/wroboarm_22.srdf - CONFIG: - author_name: Nicholas Underwood - author_email: ndunderwood@wisc.edu - generated_timestamp: 1643850775 \ No newline at end of file diff --git a/src/wroboarm_22/CMakeLists.txt b/src/wroboarm_22/CMakeLists.txt deleted file mode 100644 index 0d3118b1..00000000 --- a/src/wroboarm_22/CMakeLists.txt +++ /dev/null @@ -1,14 +0,0 @@ -cmake_minimum_required(VERSION 2.8.3) - -project(wroboarm_22) - -find_package(catkin REQUIRED) - -catkin_package() - -find_package(roslaunch) - -foreach(dir config launch meshes urdf) - install(DIRECTORY ${dir}/ - DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}/${dir}) -endforeach(dir) diff --git a/src/wroboarm_22/config/arm_assembly.srdf b/src/wroboarm_22/config/arm_assembly.srdf deleted file mode 100644 index f9dfd6b0..00000000 --- a/src/wroboarm_22/config/arm_assembly.srdf +++ /dev/null @@ -1,43 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/config/cartesian_limits.yaml b/src/wroboarm_22/config/cartesian_limits.yaml deleted file mode 100644 index 7df72f69..00000000 --- a/src/wroboarm_22/config/cartesian_limits.yaml +++ /dev/null @@ -1,5 +0,0 @@ -cartesian_limits: - max_trans_vel: 1 - max_trans_acc: 2.25 - max_trans_dec: -5 - max_rot_vel: 1.57 diff --git a/src/wroboarm_22/config/chomp_planning.yaml b/src/wroboarm_22/config/chomp_planning.yaml deleted file mode 100644 index 75258e53..00000000 --- a/src/wroboarm_22/config/chomp_planning.yaml +++ /dev/null @@ -1,18 +0,0 @@ -planning_time_limit: 10.0 -max_iterations: 200 -max_iterations_after_collision_free: 5 -smoothness_cost_weight: 0.1 -obstacle_cost_weight: 1.0 -learning_rate: 0.01 -smoothness_cost_velocity: 0.0 -smoothness_cost_acceleration: 1.0 -smoothness_cost_jerk: 0.0 -ridge_factor: 0.01 -use_pseudo_inverse: false -pseudo_inverse_ridge_factor: 1e-4 -joint_update_limit: 0.1 -collision_clearence: 0.2 -collision_threshold: 0.07 -use_stochastic_descent: true -enable_failure_recovery: true -max_recovery_attempts: 5 \ No newline at end of file diff --git a/src/wroboarm_22/config/fake_controllers.yaml b/src/wroboarm_22/config/fake_controllers.yaml deleted file mode 100644 index 0ceba3e3..00000000 --- a/src/wroboarm_22/config/fake_controllers.yaml +++ /dev/null @@ -1,15 +0,0 @@ -controller_list: - - name: fake_arm_controller - type: $(arg execution_type) - joints: - - turntable - - shoulder - - elbow - - forearm_roll - - wrist_pitch - - wrist_roll -initial: # Define initial robot poses. -# - group: arm -# pose: home - - [] \ No newline at end of file diff --git a/src/wroboarm_22/config/joint_limits.yaml b/src/wroboarm_22/config/joint_limits.yaml deleted file mode 100644 index b9def49a..00000000 --- a/src/wroboarm_22/config/joint_limits.yaml +++ /dev/null @@ -1,52 +0,0 @@ -# joint_limits.yaml allows the dynamics properties specified in the URDF to be overwritten or augmented as needed - -# For beginners, we downscale velocity and acceleration limits. -# You can always specify higher scaling factors (<= 1.0) in your motion requests. # Increase the values below to 1.0 to always move at maximum speed. -default_velocity_scaling_factor: 1.0 -default_acceleration_scaling_factor: 1.0 - -# Specific joint properties can be changed with the keys [max_position, min_position, max_velocity, max_acceleration] -# Joint limits can be turned off with [has_velocity_limits, has_acceleration_limits] -joint_limits: - elbow: - max_position: 0.436 - min_position: -2.5307 - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - forearm_roll: - max_position: 1.57 - min_position: -1.57 - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - shoulder: - max_position: 2.2689 - min_position: -0.87266 - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - turntable: - max_position: 3.1 - min_position: -3.1 - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - wrist_pitch: - max_position: 1.57 - min_position: -1.57 - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 - wrist_roll: - max_position: 1.57 - min_position: -1.57 - has_velocity_limits: false - max_velocity: 0 - has_acceleration_limits: false - max_acceleration: 0 \ No newline at end of file diff --git a/src/wroboarm_22/config/joint_names_wroboarm_22.yaml b/src/wroboarm_22/config/joint_names_wroboarm_22.yaml deleted file mode 100644 index 159fc6fe..00000000 --- a/src/wroboarm_22/config/joint_names_wroboarm_22.yaml +++ /dev/null @@ -1 +0,0 @@ -controller_joint_names: ['', 'turntable', 'shoulder', 'elbow', 'forearm_roll', 'wrist_pitch', 'wrist_roll', ] diff --git a/src/wroboarm_22/config/kinematics.yaml b/src/wroboarm_22/config/kinematics.yaml deleted file mode 100644 index 05573e5c..00000000 --- a/src/wroboarm_22/config/kinematics.yaml +++ /dev/null @@ -1,4 +0,0 @@ -arm: - kinematics_solver: kdl_kinematics_plugin/KDLKinematicsPlugin - kinematics_solver_search_resolution: 0.005 - kinematics_solver_timeout: 0.005 \ No newline at end of file diff --git a/src/wroboarm_22/config/ros_controllers.yaml b/src/wroboarm_22/config/ros_controllers.yaml deleted file mode 100644 index f8e4418a..00000000 --- a/src/wroboarm_22/config/ros_controllers.yaml +++ /dev/null @@ -1,35 +0,0 @@ -# Simulation settings for using moveit_sim_controllers -moveit_sim_hw_interface: - joint_model_group: todo_group_name - joint_model_group_pose: todo_state_name -# Settings for ros_control_boilerplate control loop -generic_hw_control_loop: - loop_hz: 300 - cycle_time_error_threshold: 0.01 -# Settings for ros_control hardware interface -hardware_interface: - joints: - - turntable - - shoulder - - elbow - - forearm_roll - - wrist_pitch - - wrist_roll - sim_control_mode: 1 # 0: position, 1: velocity -# Publish all joint states -# Creates the /joint_states topic necessary in ROS -joint_state_controller: - type: joint_state_controller/JointStateController - publish_rate: 50 -controller_list: - - name: arm_controller - action_ns: follow_joint_trajectory - default: True - type: FollowJointTrajectory - joints: - - turntable - - shoulder - - elbow - - forearm_roll - - wrist_pitch - - wrist_roll \ No newline at end of file diff --git a/src/wroboarm_22/config/sensors_3d.yaml b/src/wroboarm_22/config/sensors_3d.yaml deleted file mode 100644 index a4bb13e3..00000000 --- a/src/wroboarm_22/config/sensors_3d.yaml +++ /dev/null @@ -1,10 +0,0 @@ -# The name of this file shouldn't be changed, or else the Setup Assistant won't detect it -sensors: - - filtered_cloud_topic: filtered_cloud - max_range: 5.0 - max_update_rate: 1.0 - padding_offset: 0.1 - padding_scale: 1.0 - point_cloud_topic: /head_mount_kinect/depth_registered/points - point_subsample: 1 - sensor_plugin: occupancy_map_monitor/PointCloudOctomapUpdater \ No newline at end of file diff --git a/src/wroboarm_22/config/simple_moveit_controllers.yaml b/src/wroboarm_22/config/simple_moveit_controllers.yaml deleted file mode 100644 index 044fd7a1..00000000 --- a/src/wroboarm_22/config/simple_moveit_controllers.yaml +++ /dev/null @@ -1,23 +0,0 @@ -controller_list: - - name: arm_controller - action_ns: follow_joint_trajectory - type: FollowJointTrajectory - default: True - joints: - - turntable - - shoulder - - elbow - - forearm_roll - - wrist_pitch - - wrist_roll - - name: arm_controller - action_ns: follow_joint_trajectory - type: FollowJointTrajectory - default: True - joints: - - turntable - - shoulder - - elbow - - forearm_roll - - wrist_pitch - - wrist_roll \ No newline at end of file diff --git a/src/wroboarm_22/export.log b/src/wroboarm_22/export.log deleted file mode 100644 index 0f28f844..00000000 --- a/src/wroboarm_22/export.log +++ /dev/null @@ -1,566 +0,0 @@ -2022-01-28 23:47:18,488 INFO Logger.cs: 70 - --------------------------------------------------------------------------------- -2022-01-28 23:47:18,508 INFO Logger.cs: 71 - Logging commencing for SW2URDF exporter -2022-01-28 23:47:18,508 INFO Logger.cs: 73 - Commit version 1.6.0-4-g7f85cfe -2022-01-28 23:47:18,509 INFO Logger.cs: 74 - Build version 1.6.7995.38578 -2022-01-28 23:47:18,510 INFO SwAddin.cs: 192 - Attempting to connect to SW -2022-01-28 23:47:18,511 INFO SwAddin.cs: 197 - Setting up callbacks -2022-01-28 23:47:18,511 INFO SwAddin.cs: 201 - Setting up command manager -2022-01-28 23:47:18,512 INFO SwAddin.cs: 204 - Adding command manager -2022-01-28 23:47:18,517 INFO SwAddin.cs: 263 - Adding Assembly export to file menu -2022-01-28 23:47:18,517 INFO SwAddin.cs: 272 - Adding Part export to file menu -2022-01-28 23:47:18,518 INFO SwAddin.cs: 210 - Adding event handlers -2022-01-28 23:47:18,520 INFO SwAddin.cs: 217 - Connecting plugin to SolidWorks -2022-01-29 04:01:04,989 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM -2022-01-29 04:01:07,687 INFO SwAddin.cs: 313 - Saving assembly -2022-01-29 04:01:07,864 INFO SwAddin.cs: 316 - Opening property manager -2022-01-29 04:01:07,891 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:01:07,894 INFO ExportHelperExtension.cs: 1136 - Found 44 in ArmAssembly.SLDASM -2022-01-29 04:01:07,894 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:01:07,895 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:07,895 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:07,930 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:01:07,930 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:07,931 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:01:07,931 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:01:07,931 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:07,932 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:01:07,932 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:01:07,932 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:07,933 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:01:07,933 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:01:07,934 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:07,934 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:01:07,934 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:01:07,935 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:07,936 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:01:07,936 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:01:07,936 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:07,937 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:01:07,937 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1136 - Found 44 in ArmAssembly.SLDASM -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:07,938 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:07,939 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:01:07,939 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:07,939 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:01:07,940 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:01:07,940 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:07,940 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:01:07,941 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:01:07,942 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:07,942 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:01:07,942 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:01:07,943 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:07,943 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:01:07,943 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:01:07,944 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:07,944 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:01:07,944 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:01:07,945 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:07,945 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:01:08,306 INFO SwAddin.cs: 339 - Loading config tree -2022-01-29 04:01:08,309 INFO ExportPropertyManagerExtension.cs: 520 - Starting new configuration -2022-01-29 04:01:08,315 INFO SwAddin.cs: 344 - Showing property manager -2022-01-29 04:01:36,796 INFO ExportPropertyManager.cs: 422 - Configuration saved -2022-01-29 04:01:38,889 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:01:38,895 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:38,895 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:01:38,895 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:38,896 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:38,896 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:01:38,896 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:38,897 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:01:38,897 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:01:38,897 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:38,898 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:01:38,898 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:01:38,899 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:38,899 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:01:38,899 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:01:38,900 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:38,900 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:01:38,900 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:01:38,901 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:38,901 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:01:38,902 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:01:38,902 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:38,902 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:01:38,903 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:01:38,903 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:38,903 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:01:38,904 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:01:38,904 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:38,904 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:01:38,905 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:38,905 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:38,905 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:01:38,906 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:38,906 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:01:38,906 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:01:38,907 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:38,908 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:01:38,908 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:01:38,908 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:38,909 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:01:38,909 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:01:38,909 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:38,910 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:01:38,910 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:01:38,910 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:38,911 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:01:38,911 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:01:38,911 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:38,912 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:01:38,958 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:01:48,808 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM -2022-01-29 04:01:48,808 INFO SwAddin.cs: 299 - Save is required -2022-01-29 04:01:48,809 INFO SwAddin.cs: 313 - Saving assembly -2022-01-29 04:01:49,233 INFO SwAddin.cs: 316 - Opening property manager -2022-01-29 04:01:49,234 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:01:49,235 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:49,235 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:01:49,235 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:49,236 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:49,236 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:01:49,236 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:49,237 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:01:49,237 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:01:49,237 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:49,238 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:01:49,238 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:01:49,238 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:49,239 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:01:49,239 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:01:49,240 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:49,240 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:01:49,240 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:01:49,241 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:49,241 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:01:49,241 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:01:49,242 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:49,248 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:01:49,248 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:01:49,279 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:49,279 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:01:49,280 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:01:49,281 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:01:49,281 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:01:49,282 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:01:49,282 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:01:49,282 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:01:49,283 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:01:49,283 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:01:49,283 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:01:49,284 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:01:49,284 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:01:49,285 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:01:49,285 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:01:49,285 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:01:49,286 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:01:49,286 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:01:49,287 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:01:49,288 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:01:49,288 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:01:49,288 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:01:49,398 INFO SwAddin.cs: 339 - Loading config tree -2022-01-29 04:01:49,400 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:01:49,445 INFO LinkNode.cs: 35 - Building node base_link -2022-01-29 04:01:49,446 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM -2022-01-29 04:01:49,447 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly -2022-01-29 04:01:49,448 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\Tests\URDF_Assembly\base.SLDPRT -2022-01-29 04:01:49,449 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link -2022-01-29 04:01:49,471 INFO SwAddin.cs: 344 - Showing property manager -2022-01-29 04:02:15,278 INFO ExportPropertyManager.cs: 422 - Configuration saved -2022-01-29 04:02:15,279 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:02:15,425 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:02:15,426 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:02:15,426 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:02:15,427 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:02:15,427 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:02:15,427 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:02:15,428 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:02:15,428 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:02:15,428 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:02:15,429 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:02:15,429 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:02:15,429 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:02:15,430 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:02:15,431 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:02:15,431 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:02:15,431 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:02:15,432 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:02:15,432 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:02:15,432 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:02:15,433 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:02:15,433 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:02:15,433 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:02:15,434 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:02:15,434 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:02:15,434 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:02:15,435 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:02:15,435 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:02:15,435 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:02:15,436 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:02:15,436 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:02:15,436 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:02:15,437 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:02:15,437 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:02:15,437 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:02:15,438 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:02:15,438 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:02:15,438 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:02:15,439 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:02:15,439 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:02:15,439 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:02:15,440 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:02:15,440 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:02:15,441 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:02:15,442 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:02:15,442 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:02:15,443 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:02:15,488 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:03:44,437 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:03:50,608 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM -2022-01-29 04:03:50,608 INFO SwAddin.cs: 299 - Save is required -2022-01-29 04:03:50,608 INFO SwAddin.cs: 313 - Saving assembly -2022-01-29 04:03:50,733 INFO SwAddin.cs: 316 - Opening property manager -2022-01-29 04:03:50,733 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:03:50,734 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:03:50,734 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:03:50,734 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:03:50,735 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:03:50,735 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:03:50,736 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:03:50,736 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:03:50,736 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:03:50,737 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:03:50,737 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:03:50,738 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:03:50,738 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:03:50,739 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:03:50,739 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:03:50,740 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:03:50,740 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:03:50,740 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:03:50,741 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:03:50,741 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:03:50,741 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:03:50,742 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:03:50,743 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:03:50,743 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:03:50,743 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:03:50,744 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:03:50,744 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:03:50,745 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM -2022-01-29 04:03:50,745 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:03:50,745 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:03:50,746 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:03:50,746 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:03:50,746 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:03:50,747 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:03:50,747 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:03:50,747 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:03:50,748 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:03:50,748 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:03:50,748 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:03:50,749 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:03:50,749 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:03:50,749 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:03:50,750 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:03:50,750 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:03:50,750 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:03:50,751 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:03:50,751 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:03:50,752 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:03:50,752 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:03:50,752 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:03:50,753 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:03:50,753 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:03:50,802 INFO SwAddin.cs: 339 - Loading config tree -2022-01-29 04:03:50,803 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:03:50,803 INFO LinkNode.cs: 35 - Building node base_link -2022-01-29 04:03:50,804 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM -2022-01-29 04:03:50,804 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly -2022-01-29 04:03:50,804 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\Tests\URDF_Assembly\base.SLDPRT -2022-01-29 04:03:50,805 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link -2022-01-29 04:03:50,813 INFO SwAddin.cs: 344 - Showing property manager -2022-01-29 04:03:55,199 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:04:02,915 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:04:06,718 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:04:08,432 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:07:25,776 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:07:36,624 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:08:34,715 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:09:06,042 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:09:28,401 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:09:33,716 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:10:26,057 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:10:32,832 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:01,760 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:10,262 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:32,320 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:11:50,721 INFO ExportPropertyManager.cs: 422 - Configuration saved -2022-01-29 04:11:50,723 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:11:50,809 INFO ExportHelperExtension.cs: 347 - Creating joint shoulderBase_link -2022-01-29 04:11:50,815 INFO ExportHelperExtension.cs: 1397 - Fixing components for base_link -2022-01-29 04:11:50,816 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:50,816 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:51,179 INFO : 0 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:51,183 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:51,183 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:51,184 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:53,156 WARN ExportHelperExtension.cs: 351 - Creating joint from parent base_link to child shoulderBase_link failed -2022-01-29 04:11:53,162 INFO ExportHelperExtension.cs: 347 - Creating joint upperArm_link -2022-01-29 04:11:53,163 INFO ExportHelperExtension.cs: 1397 - Fixing components for shoulderBase_link -2022-01-29 04:11:53,163 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:53,163 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:53,164 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:53,382 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:53,383 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:53,383 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:53,383 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:53,384 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:11:55,357 WARN ExportHelperExtension.cs: 351 - Creating joint from parent shoulderBase_link to child upperArm_link failed -2022-01-29 04:11:55,362 INFO ExportHelperExtension.cs: 347 - Creating joint forarm_link -2022-01-29 04:11:55,362 INFO ExportHelperExtension.cs: 1397 - Fixing components for upperArm_link -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:55,363 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:55,607 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:55,607 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:55,607 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:55,608 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:55,608 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:11:55,608 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:11:57,637 WARN ExportHelperExtension.cs: 351 - Creating joint from parent upperArm_link to child forarm_link failed -2022-01-29 04:11:57,644 INFO ExportHelperExtension.cs: 347 - Creating joint wirstBase_link -2022-01-29 04:11:57,644 INFO ExportHelperExtension.cs: 1397 - Fixing components for forarm_link -2022-01-29 04:11:57,645 INFO ExportHelperExtension.cs: 1402 - Fixing 35 -2022-01-29 04:11:57,645 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:11:57,645 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:57,646 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:57,646 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:11:57,884 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:11:57,885 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:11:57,885 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:11:57,886 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:11:57,886 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 -2022-01-29 04:11:57,886 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:11:57,887 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:11:59,971 WARN ExportHelperExtension.cs: 351 - Creating joint from parent forarm_link to child wirstBase_link failed -2022-01-29 04:11:59,975 INFO ExportHelperExtension.cs: 347 - Creating joint wrist_link -2022-01-29 04:11:59,975 INFO ExportHelperExtension.cs: 1397 - Fixing components for wirstBase_link -2022-01-29 04:11:59,976 INFO ExportHelperExtension.cs: 1402 - Fixing 40 -2022-01-29 04:11:59,976 INFO ExportHelperExtension.cs: 1402 - Fixing 35 -2022-01-29 04:11:59,976 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:11:59,977 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:11:59,977 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:11:59,977 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:12:00,240 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:12:00,241 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:12:00,241 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:12:00,241 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:12:00,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 40 -2022-01-29 04:12:00,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 -2022-01-29 04:12:00,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:12:00,243 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:12:02,368 WARN ExportHelperExtension.cs: 351 - Creating joint from parent wirstBase_link to child wrist_link failed -2022-01-29 04:12:02,372 INFO ExportHelperExtension.cs: 347 - Creating joint manipulator_link -2022-01-29 04:12:02,373 INFO ExportHelperExtension.cs: 1397 - Fixing components for wrist_link -2022-01-29 04:12:02,373 INFO ExportHelperExtension.cs: 1402 - Fixing 39 -2022-01-29 04:12:02,373 INFO ExportHelperExtension.cs: 1402 - Fixing 40 -2022-01-29 04:12:02,374 INFO ExportHelperExtension.cs: 1402 - Fixing 35 -2022-01-29 04:12:02,374 INFO ExportHelperExtension.cs: 1402 - Fixing 26 -2022-01-29 04:12:02,374 INFO ExportHelperExtension.cs: 1402 - Fixing 25 -2022-01-29 04:12:02,375 INFO ExportHelperExtension.cs: 1402 - Fixing 24 -2022-01-29 04:12:02,375 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed -2022-01-29 04:12:02,655 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] -2022-01-29 04:12:02,655 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 -2022-01-29 04:12:02,656 INFO ExportHelperExtension.cs: 849 - L1: 0 -2022-01-29 04:12:02,656 INFO ExportHelperExtension.cs: 857 - L2: 0 -2022-01-29 04:12:02,698 INFO ExportHelperExtension.cs: 1352 - Unfixing component 39 -2022-01-29 04:12:02,699 INFO ExportHelperExtension.cs: 1352 - Unfixing component 40 -2022-01-29 04:12:02,699 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 -2022-01-29 04:12:02,699 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 -2022-01-29 04:12:02,700 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 -2022-01-29 04:12:04,927 WARN ExportHelperExtension.cs: 351 - Creating joint from parent wrist_link to child manipulator_link failed -2022-01-29 04:12:05,029 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM -2022-01-29 04:12:05,030 INFO ExportHelperExtension.cs: 1136 - Found 59 in ArmAssembly.SLDASM -2022-01-29 04:12:05,031 INFO ExportHelperExtension.cs: 1145 - Found 7 features of type [CoordSys] in ArmAssembly.SLDASM -2022-01-29 04:12:05,031 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:12:05,031 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:12:05,032 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 -2022-01-29 04:12:05,032 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:12:05,032 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 -2022-01-29 04:12:05,033 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 -2022-01-29 04:12:05,033 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:12:05,033 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 -2022-01-29 04:12:05,034 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 -2022-01-29 04:12:05,034 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:12:05,035 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 -2022-01-29 04:12:05,035 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 -2022-01-29 04:12:05,035 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:12:05,036 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 -2022-01-29 04:12:05,036 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 -2022-01-29 04:12:05,036 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:12:05,037 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 -2022-01-29 04:12:05,037 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 -2022-01-29 04:12:05,037 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:12:05,038 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 -2022-01-29 04:12:05,038 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 -2022-01-29 04:12:05,038 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:12:05,039 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 -2022-01-29 04:12:05,039 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM -2022-01-29 04:12:05,039 INFO ExportHelperExtension.cs: 1136 - Found 59 in ArmAssembly.SLDASM -2022-01-29 04:12:05,040 INFO ExportHelperExtension.cs: 1145 - Found 6 features of type [RefAxis] in ArmAssembly.SLDASM -2022-01-29 04:12:05,040 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components -2022-01-29 04:12:05,040 INFO ExportHelperExtension.cs: 1160 - 7 components to check -2022-01-29 04:12:05,041 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 -2022-01-29 04:12:05,041 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 -2022-01-29 04:12:05,041 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 -2022-01-29 04:12:05,042 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 -2022-01-29 04:12:05,042 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 -2022-01-29 04:12:05,042 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 -2022-01-29 04:12:05,043 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 -2022-01-29 04:12:05,044 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 -2022-01-29 04:12:05,044 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 -2022-01-29 04:12:05,044 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 -2022-01-29 04:12:05,045 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 -2022-01-29 04:12:05,045 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 -2022-01-29 04:12:05,045 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 -2022-01-29 04:12:05,046 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 -2022-01-29 04:12:05,046 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 -2022-01-29 04:12:05,046 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 -2022-01-29 04:12:05,047 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 -2022-01-29 04:12:05,047 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 -2022-01-29 04:12:05,103 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message -2022-01-29 04:13:17,527 INFO AssemblyExportForm.cs: 253 - Completing URDF export -2022-01-29 04:13:17,529 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GeneratelinktruenametrueshoulderBase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueturntabletypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically GeneratelinktruenametrueupperArm_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueshouldertypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametrueforarm_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueelbowtypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically GeneratelinktruenametruewirstBase_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueforearm_rolltypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametruewrist_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_pitchtypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically Generatelinktruenametruemanipulator_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_rolltypetruerevolutexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAutomatically GenerateAutomatically GeneratelinktruefalsesDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalsefalsesDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==falsefalsefalsesDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==falsefalsefalsesDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAfalsefalsefalsesDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==falsefalsefalsesDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==falsefalsefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:13:41,728 INFO AssemblyExportForm.cs: 309 - Saving URDF package to E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM -2022-01-29 04:13:41,730 INFO ExportHelper.cs: 147 - Beginning the export process -2022-01-29 04:13:41,731 INFO ExportHelper.cs: 153 - Creating package directories with name ArmAssembly.SLDASM and save path E:\Robotics\WR\Tests\URDF_Assembly -2022-01-29 04:13:46,142 ERROR AssemblyExportForm.cs: 126 - Exception encountered in Assembly export form -System.IO.IOException: Cannot create "E:\Robotics\WR\Tests\URDF_Assembly\ArmAssembly.SLDASM" because a file or directory with the same name already exists. - at System.IO.__Error.WinIOError(Int32 errorCode, String maybeFullPath) - at System.IO.Directory.InternalCreateDirectory(String fullPath, String path, Object dirSecurityObj, Boolean checkHost) - at System.IO.Directory.InternalCreateDirectoryHelper(String path, Boolean checkHost) - at SW2URDF.URDFExport.URDFPackage.CreateDirectories() in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\URDFExport\URDFPackage.cs:line 78 - at SW2URDF.URDFExport.ExportHelper.ExportRobot(Boolean exportSTL) in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\URDFExport\ExportHelper.cs:line 155 - at SW2URDF.UI.AssemblyExportForm.FinishExport(Boolean exportSTL) in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\UI\AssemblyExportForm.cs:line 310 - at SW2URDF.UI.AssemblyExportForm.ButtonLinksFinishClick(Object sender, EventArgs e) in C:\Users\Stephen Brawner\workspace\solidworks_urdf_exporter\SW2URDF\UI\AssemblyExportForm.cs:line 243 - at System.Windows.Forms.Control.OnClick(EventArgs e) - at System.Windows.Forms.Button.OnClick(EventArgs e) - at System.Windows.Forms.Button.OnMouseUp(MouseEventArgs mevent) - at System.Windows.Forms.Control.WmMouseUp(Message& m, MouseButtons button, Int32 clicks) - at System.Windows.Forms.Control.WndProc(Message& m) - at System.Windows.Forms.ButtonBase.WndProc(Message& m) - at System.Windows.Forms.Button.WndProc(Message& m) - at System.Windows.Forms.NativeWindow.Callback(IntPtr hWnd, Int32 msg, IntPtr wparam, IntPtr lparam) -2022-01-29 04:13:53,196 INFO AssemblyExportForm.cs: 253 - Completing URDF export -2022-01-29 04:13:53,197 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found -nametruebase_linkxyztrue1.035828411313638E-180.0156064900891439571.9357498027169635E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504418ixytrue8.6586155170563642E-21ixztrue-7.3748524136608228E-20iyytrue0.0044229329573873041iyztrue2.2771129801693437E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametrueshoulderBase_linkxyztrue-0.0122586821821900790.1285772495779757-0.0037054435004292684rpytrue000originfalsefalsevaluetrue0.99636680500272734massfalseixxtrue0.0065237009420894719ixytrue0.0010646616036528998ixztrue0.00028312700527736404iyytrue0.0050231810993567032iyztrue6.82113719161566E-05izztrue0.0086334538259584inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueturntabletypetruecontinuousxyztrue000.035865rpytrue1.57080-0.25129originfalsefalselinktruebase_linkparenttruelinktrueshoulderBase_linkchildtruexyztrue010axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_turntableOrigin_turntablelinktruenametrueupperArm_linkxyztrue0.014397399905456463-3.2006162568792851E-050.27934838479492807rpytrue000originfalsefalsevaluetrue0.98521034391581119massfalseixxtrue0.023798222473833903ixytrue-8.87977733299251E-07ixztrue-0.0038853285623011904iyytrue0.029359472259760169iyztrue-7.1294436997127461E-06izztrue0.0062503483932010362inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueshouldertypetruecontinuousxyztrue00.180980.043071rpytrue-1.102100originfalsefalselinktrueshoulderBase_linkparenttruelinktrueupperArm_linkchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_shoulderOrigin_shoulderlinktruenametrueforarm_linkxyztrue1.8457457784393227E-150.0550154986611603450.12015280303424725rpytrue000originfalsefalsevaluetrue0.51779610173045887massfalseixxtrue0.00404850874710771ixytrue2.1141942363467336E-18ixztrue-1.5487150407597627E-17iyytrue0.003755483293922739iyztrue-0.00037738536370652919izztrue0.00078832783822656164inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueelbowtypetruecontinuousxyztrue000.46634rpytrue2.493600originfalsefalselinktrueupperArm_linkparenttruelinktrueforarm_linkchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_elbowOrigin_elbowlinktruenametruewirstBase_linkxyztrue-1.9428902930940239E-16-1.6653345369377348E-150.09870348455642336rpytrue000originfalsefalsevaluetrue0.30176308217533721massfalseixxtrue0.0021034428970283731ixytrue-2.7105054312137611E-19ixztrue-2.2497195079074217E-18iyytrue0.003050162507065583iyztrue1.8566962203814263E-18izztrue0.0010760910650178595inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueforearm_rolltypetruecontinuousxyztrue00.044450.2285rpytrue000originfalsefalselinktrueforarm_linkparenttruelinktruewirstBase_linkchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_forearm_rollOrigin_forearm_rolllinktruenametruewrist_linkxyztrue4.3021142204224816E-16-2.7755575615628914E-170rpytrue000originfalsefalsevaluetrue0.44770711794317625massfalseixxtrue0.00036770226690479489ixytrue1.7999450129153882E-19ixztrue-7.453889935837843E-19iyytrue0.00084342708626575322iyztrue-1.3552527156068805E-20izztrue0.00084474612356065992inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_pitchtypetruecontinuousxyztrue000.23716rpytrue-1.33300originfalsefalselinktruewirstBase_linkparenttruelinktruewrist_linkchildtruexyztrue100axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_wrist_pitchOrigin_wrist_pitchlinktruenametruemanipulator_linkxyztrue-0.00073032374046050341-0.000899365669252000230.049056009995342265rpytrue000originfalsefalsevaluetrue0.39742022555481077massfalseixxtrue0.0015968430526387824ixytrue-3.0724322789165625E-06ixztrue2.5323557993615128E-05iyytrue0.0016343224414687998iyztrue5.0029229087463509E-05izztrue0.00025632256399428705inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewrist_rolltypetruecontinuousxyztrue000rpytrue000.096862originfalsefalselinktruewrist_linkparenttruelinktruemanipulator_linkchildtruexyztrue001axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis_wrist_rollOrigin_wrist_rolllinktruefalsesDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalsefalsesDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==falsefalsefalsesDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==falsefalsefalsesDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAfalsefalsefalsesDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==falsefalsefalsesDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==falsefalsefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse -2022-01-29 04:14:02,877 INFO AssemblyExportForm.cs: 309 - Saving URDF package to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM -2022-01-29 04:14:02,877 INFO ExportHelper.cs: 147 - Beginning the export process -2022-01-29 04:14:02,877 INFO ExportHelper.cs: 153 - Creating package directories with name ArmAssembly.SLDASM and save path E:\Robotics\WR\Tests\URDF_Assembly\URDF -2022-01-29 04:14:04,383 INFO ExportHelper.cs: 162 - Creating CMakeLists.txt at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\CMakeLists.txt -2022-01-29 04:14:04,384 INFO ExportHelper.cs: 166 - Creating joint names config at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\config\joint_names_ArmAssembly.SLDASM.yaml -2022-01-29 04:14:04,385 INFO ExportHelper.cs: 170 - Creating package.xml at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\package.xml -2022-01-29 04:14:04,385 INFO PackageXMLWriter.cs: 21 - Creating package.xml at E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\package.xml -2022-01-29 04:14:04,389 INFO ExportHelper.cs: 177 - Creating RVIZ launch file in E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\launch\ -2022-01-29 04:14:04,391 INFO ExportHelper.cs: 182 - Creating Gazebo launch file in E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\launch\ -2022-01-29 04:14:04,392 INFO ExportHelper.cs: 187 - Saving existing STL preferences -2022-01-29 04:14:04,392 INFO ExportHelper.cs: 450 - Saving users preferences -2022-01-29 04:14:04,393 INFO ExportHelper.cs: 190 - Modifying STL preferences -2022-01-29 04:14:04,394 INFO ExportHelper.cs: 464 - Setting STL preferences -2022-01-29 04:14:04,397 INFO ExportHelper.cs: 196 - Found 0 hidden components -2022-01-29 04:14:04,398 INFO ExportHelper.cs: 197 - Hiding all components -2022-01-29 04:14:04,618 INFO ExportHelper.cs: 204 - Beginning individual files export -2022-01-29 04:14:04,622 INFO ExportHelper.cs: 270 - Exporting link: base_link -2022-01-29 04:14:04,623 INFO ExportHelper.cs: 272 - Link base_link has 1 children -2022-01-29 04:14:04,624 INFO ExportHelper.cs: 270 - Exporting link: shoulderBase_link -2022-01-29 04:14:04,624 INFO ExportHelper.cs: 272 - Link shoulderBase_link has 1 children -2022-01-29 04:14:04,625 INFO ExportHelper.cs: 270 - Exporting link: upperArm_link -2022-01-29 04:14:04,625 INFO ExportHelper.cs: 272 - Link upperArm_link has 1 children -2022-01-29 04:14:04,625 INFO ExportHelper.cs: 270 - Exporting link: forarm_link -2022-01-29 04:14:04,626 INFO ExportHelper.cs: 272 - Link forarm_link has 1 children -2022-01-29 04:14:04,626 INFO ExportHelper.cs: 270 - Exporting link: wirstBase_link -2022-01-29 04:14:04,627 INFO ExportHelper.cs: 272 - Link wirstBase_link has 1 children -2022-01-29 04:14:04,628 INFO ExportHelper.cs: 270 - Exporting link: wrist_link -2022-01-29 04:14:04,628 INFO ExportHelper.cs: 272 - Link wrist_link has 1 children -2022-01-29 04:14:04,629 INFO ExportHelper.cs: 270 - Exporting link: manipulator_link -2022-01-29 04:14:04,629 INFO ExportHelper.cs: 272 - Link manipulator_link has 0 children -2022-01-29 04:14:04,630 INFO ExportHelper.cs: 317 - manipulator_link: Exporting STL with coordinate frame Origin_wrist_roll -2022-01-29 04:14:04,631 INFO ExportHelper.cs: 322 - manipulator_link: Reference geometry name -2022-01-29 04:14:04,669 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\manipulator_link.STL -2022-01-29 04:14:04,785 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,785 INFO ExportHelper.cs: 317 - wrist_link: Exporting STL with coordinate frame Origin_wrist_pitch -2022-01-29 04:14:04,786 INFO ExportHelper.cs: 322 - wrist_link: Reference geometry name -2022-01-29 04:14:04,797 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\wrist_link.STL -2022-01-29 04:14:04,834 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,835 INFO ExportHelper.cs: 317 - wirstBase_link: Exporting STL with coordinate frame Origin_forearm_roll -2022-01-29 04:14:04,835 INFO ExportHelper.cs: 322 - wirstBase_link: Reference geometry name -2022-01-29 04:14:04,846 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\wirstBase_link.STL -2022-01-29 04:14:04,873 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,874 INFO ExportHelper.cs: 317 - forarm_link: Exporting STL with coordinate frame Origin_elbow -2022-01-29 04:14:04,874 INFO ExportHelper.cs: 322 - forarm_link: Reference geometry name -2022-01-29 04:14:04,932 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\forarm_link.STL -2022-01-29 04:14:04,986 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:04,987 INFO ExportHelper.cs: 317 - upperArm_link: Exporting STL with coordinate frame Origin_shoulder -2022-01-29 04:14:04,987 INFO ExportHelper.cs: 322 - upperArm_link: Reference geometry name -2022-01-29 04:14:05,001 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\upperArm_link.STL -2022-01-29 04:14:05,035 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:05,035 INFO ExportHelper.cs: 317 - shoulderBase_link: Exporting STL with coordinate frame Origin_turntable -2022-01-29 04:14:05,036 INFO ExportHelper.cs: 322 - shoulderBase_link: Reference geometry name -2022-01-29 04:14:05,111 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\shoulderBase_link.STL -2022-01-29 04:14:05,189 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:05,190 INFO ExportHelper.cs: 317 - base_link: Exporting STL with coordinate frame Origin_global -2022-01-29 04:14:05,191 INFO ExportHelper.cs: 322 - base_link: Reference geometry name -2022-01-29 04:14:05,235 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\meshes\base_link.STL -2022-01-29 04:14:05,274 INFO ExportHelper.cs: 405 - Removing SW header in STL file -2022-01-29 04:14:05,275 INFO ExportHelper.cs: 145 - Showing all components except previously hidden components -2022-01-29 04:14:05,465 INFO ExportHelper.cs: 145 - Resetting STL preferences -2022-01-29 04:14:05,466 INFO ExportHelper.cs: 478 - Returning STL preferences to user preferences -2022-01-29 04:14:05,466 INFO ExportHelper.cs: 228 - Writing URDF file to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\urdf\ArmAssembly.SLDASM.urdf -2022-01-29 04:14:05,470 INFO CSVImportExport.cs: 32 - Writing CSV file E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\urdf\ArmAssembly.SLDASM.csv -2022-01-29 04:14:05,493 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,494 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,495 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,495 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,495 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,496 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,496 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, -2022-01-29 04:14:05,497 INFO ExportHelper.cs: 234 - Copying log file -2022-01-29 04:14:05,497 INFO ExportHelper.cs: 439 - Copying C:\Users\Payton Jackson\sw2urdf_logs\sw2urdf.log to E:\Robotics\WR\Tests\URDF_Assembly\URDF\ArmAssembly.SLDASM\export.log diff --git a/src/wroboarm_22/launch/arm_assembly_moveit_sensor_manager.launch.xml b/src/wroboarm_22/launch/arm_assembly_moveit_sensor_manager.launch.xml deleted file mode 100644 index 5d02698d..00000000 --- a/src/wroboarm_22/launch/arm_assembly_moveit_sensor_manager.launch.xml +++ /dev/null @@ -1,3 +0,0 @@ - - - diff --git a/src/wroboarm_22/launch/chomp_planning_pipeline.launch.xml b/src/wroboarm_22/launch/chomp_planning_pipeline.launch.xml deleted file mode 100644 index 97a44bff..00000000 --- a/src/wroboarm_22/launch/chomp_planning_pipeline.launch.xml +++ /dev/null @@ -1,25 +0,0 @@ - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/default_warehouse_db.launch b/src/wroboarm_22/launch/default_warehouse_db.launch deleted file mode 100644 index 198a981d..00000000 --- a/src/wroboarm_22/launch/default_warehouse_db.launch +++ /dev/null @@ -1,15 +0,0 @@ - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/demo.launch b/src/wroboarm_22/launch/demo.launch deleted file mode 100644 index fb9b64ca..00000000 --- a/src/wroboarm_22/launch/demo.launch +++ /dev/null @@ -1,67 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - [move_group/fake_controller_joint_states] - - - [move_group/fake_controller_joint_states] - - - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/demo_gazebo.launch b/src/wroboarm_22/launch/demo_gazebo.launch deleted file mode 100644 index b8005362..00000000 --- a/src/wroboarm_22/launch/demo_gazebo.launch +++ /dev/null @@ -1,73 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - [move_group/fake_controller_joint_states] - [/joint_states] - - - [move_group/fake_controller_joint_states] - [/joint_states] - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/demo_test.launch b/src/wroboarm_22/launch/demo_test.launch deleted file mode 100644 index ff35c359..00000000 --- a/src/wroboarm_22/launch/demo_test.launch +++ /dev/null @@ -1,67 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - [control/arm_joint_states] - - - [control/arm_joint_states] - - - - - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/gazebo copy.launch b/src/wroboarm_22/launch/gazebo copy.launch deleted file mode 100644 index bc973f34..00000000 --- a/src/wroboarm_22/launch/gazebo copy.launch +++ /dev/null @@ -1,23 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/gazebo.launch b/src/wroboarm_22/launch/gazebo.launch deleted file mode 100644 index d74221c0..00000000 --- a/src/wroboarm_22/launch/gazebo.launch +++ /dev/null @@ -1,20 +0,0 @@ - - - - - - \ No newline at end of file diff --git a/src/wroboarm_22/launch/joystick_control.launch b/src/wroboarm_22/launch/joystick_control.launch deleted file mode 100644 index 9411f6e6..00000000 --- a/src/wroboarm_22/launch/joystick_control.launch +++ /dev/null @@ -1,17 +0,0 @@ - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/moveit.rviz b/src/wroboarm_22/launch/moveit.rviz deleted file mode 100644 index 53262e3d..00000000 --- a/src/wroboarm_22/launch/moveit.rviz +++ /dev/null @@ -1,339 +0,0 @@ -Panels: - - Class: rviz/Displays - Help Height: 138 - Name: Displays - Property Tree Widget: - Expanded: - - /MotionPlanning1 - - /Pose1 - - /TF1/Frames1 - - /MarkerArray1 - - /PointCloud21 - Splitter Ratio: 0.47119078040122986 - Tree Height: 270 - - Class: rviz/Help - Name: Help - - Class: rviz/Views - Expanded: - - /Current View1 - Name: Views - Splitter Ratio: 0.5 -Preferences: - PromptSaveOnExit: true -Toolbars: - toolButtonStyle: 2 -Visualization Manager: - Class: "" - Displays: - - Alpha: 0.5 - Cell Size: 1 - Class: rviz/Grid - Color: 160; 160; 164 - Enabled: true - Line Style: - Line Width: 0.029999999329447746 - Value: Lines - Name: Grid - Normal Cell Count: 0 - Offset: - X: 0 - Y: 0 - Z: 0 - Plane: XY - Plane Cell Count: 10 - Reference Frame: - Value: true - - Acceleration_Scaling_Factor: 0.1 - Class: moveit_rviz_plugin/MotionPlanning - Enabled: true - Move Group Namespace: "" - MoveIt_Allow_Approximate_IK: false - MoveIt_Allow_External_Program: false - MoveIt_Allow_Replanning: false - MoveIt_Allow_Sensor_Positioning: false - MoveIt_Planning_Attempts: 10 - MoveIt_Planning_Time: 5 - MoveIt_Use_Cartesian_Path: false - MoveIt_Use_Constraint_Aware_IK: true - MoveIt_Workspace: - Center: - X: 0 - Y: 0 - Z: 0 - Size: - X: 2 - Y: 2 - Z: 2 - Name: MotionPlanning - Planned Path: - Color Enabled: true - Interrupt Display: false - Links: - All Links Enabled: true - Expand Joint Details: false - Expand Link Details: false - Expand Tree: false - Link Tree Style: Links in Alphabetic Order - base_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - forarm_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - manipulator_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - shoulderBase_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - upperArm_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - wirstBase_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - wrist_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - Loop Animation: false - Robot Alpha: 1 - Robot Color: 150; 50; 150 - Show Robot Collision: false - Show Robot Visual: false - Show Trail: false - State Display Time: 0.05 s - Trail Step Size: 1 - Trajectory Topic: move_group/display_planned_path - Use Sim Time: false - Planning Metrics: - Payload: 1 - Show Joint Torques: false - Show Manipulability: false - Show Manipulability Index: false - Show Weight Limit: false - TextHeight: 0.07999999821186066 - Planning Request: - Colliding Link Color: 255; 0; 0 - Goal State Alpha: 1 - Goal State Color: 250; 128; 0 - Interactive Marker Size: 0 - Joint Violation Color: 255; 0; 255 - Planning Group: arm - Query Goal State: false - Query Start State: false - Show Workspace: false - Start State Alpha: 1 - Start State Color: 0; 255; 0 - Planning Scene Topic: /move_group/monitored_planning_scene - Robot Description: robot_description - Scene Geometry: - Scene Alpha: 1 - Scene Color: 50; 230; 50 - Scene Display Time: 0.20000000298023224 - Show Scene Geometry: true - Voxel Coloring: Z-Axis - Voxel Rendering: Occupied Voxels - Scene Robot: - Attached Body Color: 150; 50; 150 - Links: - All Links Enabled: true - Expand Joint Details: false - Expand Link Details: false - Expand Tree: false - Link Tree Style: Links in Alphabetic Order - base_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - forarm_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - manipulator_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - shoulderBase_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - upperArm_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - wirstBase_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - wrist_link: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - Robot Alpha: 1 - Show Robot Collision: false - Show Robot Visual: true - Value: true - Velocity_Scaling_Factor: 0.1 - - Alpha: 1 - Axes Length: 0.10000000149011612 - Axes Radius: 0.029999999329447746 - Class: rviz/Pose - Color: 255; 25; 0 - Enabled: true - Head Length: 0.07000000029802322 - Head Radius: 0.05000000074505806 - Name: Pose - Queue Size: 10 - Shaft Length: 0.10000000149011612 - Shaft Radius: 0.029999999329447746 - Shape: Axes - Topic: /logic/arm_teleop/next_target - Unreliable: false - Value: true - - Class: rviz/TF - Enabled: true - Frame Timeout: 15 - Frames: - All Enabled: false - base_link: - Value: false - forarm_link: - Value: true - manipulator_link: - Value: true - shoulderBase_link: - Value: true - upperArm_link: - Value: true - wirstBase_link: - Value: true - wrist_link: - Value: true - Marker Alpha: 1 - Marker Scale: 0.5 - Name: TF - Show Arrows: true - Show Axes: true - Show Names: false - Tree: - base_link: - shoulderBase_link: - upperArm_link: - forarm_link: - wirstBase_link: - wrist_link: - manipulator_link: - {} - Update Interval: 0 - Value: true - - Class: rviz/MarkerArray - Enabled: true - Marker Topic: /rviz_visual_tools - Name: MarkerArray - Namespaces: - {} - Queue Size: 100 - Value: true - - Alpha: 1 - Autocompute Intensity Bounds: true - Autocompute Value Bounds: - Max Value: 10 - Min Value: -10 - Value: true - Axis: Z - Channel Name: intensity - Class: rviz/PointCloud2 - Color: 255; 255; 255 - Color Transformer: "" - Decay Time: 0 - Enabled: true - Invert Rainbow: false - Max Color: 255; 255; 255 - Min Color: 0; 0; 0 - Name: PointCloud2 - Position Transformer: "" - Queue Size: 10 - Selectable: true - Size (Pixels): 3 - Size (m): 0.009999999776482582 - Style: Flat Squares - Topic: /move_group/filtered_cloud - Unreliable: false - Use Fixed Frame: true - Use rainbow: true - Value: true - Enabled: true - Global Options: - Background Color: 48; 48; 48 - Default Light: true - Fixed Frame: base_link - Frame Rate: 30 - Name: root - Tools: - - Class: rviz/Interact - Hide Inactive Objects: true - - Class: rviz/MoveCamera - - Class: rviz/Select - Value: true - Views: - Current: - Class: rviz/XYOrbit - Distance: 3.7679052352905273 - Enable Stereo Rendering: - Stereo Eye Separation: 0.05999999865889549 - Stereo Focal Distance: 1 - Swap Stereo Eyes: false - Value: false - Field of View: 0.7853981852531433 - Focal Point: - X: 0.11356700211763382 - Y: 0.10592000186443329 - Z: 2.2351800055275817e-07 - Focal Shape Fixed Size: true - Focal Shape Size: 0.05000000074505806 - Invert Z Axis: false - Name: Current View - Near Clip Distance: 0.009999999776482582 - Pitch: -1.1802031993865967 - Target Frame: base_link - Yaw: 5.961830139160156 - Saved: ~ -Window Geometry: - Displays: - collapsed: true - Height: 2272 - Help: - collapsed: false - Hide Left Dock: true - Hide Right Dock: false - MotionPlanning: - collapsed: true - MotionPlanning - Trajectory Slider: - collapsed: false - QMainWindow State: 000000ff00000000fd0000000100000000000003a300000844fc0200000007fb000000100044006900730070006c006100790073000000006e000002e30000018200fffffffb0000000800480065006c00700000000342000000bb000000d400fffffffb0000000a0056006900650077007300000003b0000000b00000013200fffffffb0000000c00430061006d00650072006100000002ff000001610000000000000000fb0000001e004d006f00740069006f006e00200050006c0061006e006e0069006e00670100000374000001890000000000000000fb00000044004d006f00740069006f006e0050006c0061006e006e0069006e00670020002d0020005400720061006a006500630074006f0072007900200053006c0069006400650072000000020c000000410000002600000026fb0000001c004d006f00740069006f006e0050006c0061006e006e0069006e0067000000035d00000555000002b800ffffff000007380000084400000001000000020000000100000002fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000 - Views: - collapsed: false - Width: 1848 - X: 1992 - Y: 54 diff --git a/src/wroboarm_22/launch/ompl_planning_pipeline.launch.xml b/src/wroboarm_22/launch/ompl_planning_pipeline.launch.xml deleted file mode 100644 index f6aa6b50..00000000 --- a/src/wroboarm_22/launch/ompl_planning_pipeline.launch.xml +++ /dev/null @@ -1,28 +0,0 @@ - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml b/src/wroboarm_22/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml deleted file mode 100644 index 9478782e..00000000 --- a/src/wroboarm_22/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml +++ /dev/null @@ -1,19 +0,0 @@ - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/ros_controllers.launch b/src/wroboarm_22/launch/ros_controllers.launch deleted file mode 100644 index da2ca750..00000000 --- a/src/wroboarm_22/launch/ros_controllers.launch +++ /dev/null @@ -1,11 +0,0 @@ - - - - - - - - - - diff --git a/src/wroboarm_22/launch/run_benchmark_ompl.launch b/src/wroboarm_22/launch/run_benchmark_ompl.launch deleted file mode 100644 index 8773b211..00000000 --- a/src/wroboarm_22/launch/run_benchmark_ompl.launch +++ /dev/null @@ -1,21 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/sensor_manager.launch.xml b/src/wroboarm_22/launch/sensor_manager.launch.xml deleted file mode 100644 index bd976670..00000000 --- a/src/wroboarm_22/launch/sensor_manager.launch.xml +++ /dev/null @@ -1,17 +0,0 @@ - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/trajectory_execution.launch.xml b/src/wroboarm_22/launch/trajectory_execution.launch.xml deleted file mode 100644 index 4c9ce3ff..00000000 --- a/src/wroboarm_22/launch/trajectory_execution.launch.xml +++ /dev/null @@ -1,24 +0,0 @@ - - - - - - - - - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/warehouse_settings.launch.xml b/src/wroboarm_22/launch/warehouse_settings.launch.xml deleted file mode 100644 index e473b083..00000000 --- a/src/wroboarm_22/launch/warehouse_settings.launch.xml +++ /dev/null @@ -1,16 +0,0 @@ - - - - - - - - - - - - - - - - diff --git a/src/wroboarm_22/launch/wroboarm_22_moveit_controller_manager.launch.xml b/src/wroboarm_22/launch/wroboarm_22_moveit_controller_manager.launch.xml deleted file mode 100644 index 6e73a267..00000000 --- a/src/wroboarm_22/launch/wroboarm_22_moveit_controller_manager.launch.xml +++ /dev/null @@ -1,10 +0,0 @@ - - - - - - - - - diff --git a/src/wroboarm_22/launch/wroboarm_22_moveit_sensor_manager.launch.xml b/src/wroboarm_22/launch/wroboarm_22_moveit_sensor_manager.launch.xml deleted file mode 100644 index 5d02698d..00000000 --- a/src/wroboarm_22/launch/wroboarm_22_moveit_sensor_manager.launch.xml +++ /dev/null @@ -1,3 +0,0 @@ - - - diff --git a/src/wroboarm_22/meshes/base_link.stl b/src/wroboarm_22/meshes/base_link.stl deleted file mode 100644 index c298f6b5..00000000 Binary files a/src/wroboarm_22/meshes/base_link.stl and /dev/null differ diff --git a/src/wroboarm_22/meshes/forarm_link.stl b/src/wroboarm_22/meshes/forarm_link.stl deleted file mode 100644 index fb511b34..00000000 Binary files a/src/wroboarm_22/meshes/forarm_link.stl and /dev/null differ diff --git a/src/wroboarm_22/meshes/manipulator_link.stl b/src/wroboarm_22/meshes/manipulator_link.stl deleted file mode 100644 index 6bbdfa56..00000000 Binary files a/src/wroboarm_22/meshes/manipulator_link.stl and /dev/null differ diff --git a/src/wroboarm_22/meshes/shoulderBase_link.stl b/src/wroboarm_22/meshes/shoulderBase_link.stl deleted file mode 100644 index bad98d04..00000000 Binary files a/src/wroboarm_22/meshes/shoulderBase_link.stl and /dev/null differ diff --git a/src/wroboarm_22/meshes/upperArm_link.stl b/src/wroboarm_22/meshes/upperArm_link.stl deleted file mode 100644 index d111945c..00000000 Binary files a/src/wroboarm_22/meshes/upperArm_link.stl and /dev/null differ diff --git a/src/wroboarm_22/meshes/wirstBase_link.stl b/src/wroboarm_22/meshes/wirstBase_link.stl deleted file mode 100644 index 0e2de135..00000000 Binary files a/src/wroboarm_22/meshes/wirstBase_link.stl and /dev/null differ diff --git a/src/wroboarm_22/meshes/wrist_link.stl b/src/wroboarm_22/meshes/wrist_link.stl deleted file mode 100644 index 0e6b6ab5..00000000 Binary files a/src/wroboarm_22/meshes/wrist_link.stl and /dev/null differ diff --git a/src/wroboarm_22/urdf/wroboarm_22.csv b/src/wroboarm_22/urdf/wroboarm_22.csv deleted file mode 100644 index 9bb21378..00000000 --- a/src/wroboarm_22/urdf/wroboarm_22.csv +++ /dev/null @@ -1,8 +0,0 @@ -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,1.03582841131364E-18,0.015606490089144,1.93574980271696E-18,0,0,0,0.93972387307473,0.00251429022255044,8.65861551705636E-21,-7.37485241366082E-20,0.0044229329573873,2.27711298016934E-20,0.0021336882069818,0,0,0,0,0,0,package://wroboarm_22/meshes/base_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/base_link.stl,,base-1,Origin_global,,,,0,0,0,0,0,0,,0,0,0,,,,,,,,,,,, -shoulderBase_link,-0.0122586821821901,0.128577249577976,-0.00370544350042927,0,0,0,0.996366805002727,0.00652370094208947,0.0010646616036529,0.000283127005277364,0.0050231810993567,6.82113719161566E-05,0.0086334538259584,0,0,0,0,0,0,package://wroboarm_22/meshes/shoulderBase_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/shoulderBase_link.stl,,Shoulder-1,Origin_turntable,Axis_turntable,turntable,continuous,0,0,0.035865,1.5708,0,-0.25129,base_link,0,1,0,,,,,,,,,,,, -upperArm_link,0.0143973999054565,-3.20061625687929E-05,0.279348384794928,0,0,0,0.985210343915811,0.0237982224738339,-8.87977733299251E-07,-0.00388532856230119,0.0293594722597602,-7.12944369971275E-06,0.00625034839320104,0,0,0,0,0,0,package://wroboarm_22/meshes/upperArm_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/upperArm_link.stl,,UpperArm-1,Origin_shoulder,Axis_shoulder,shoulder,continuous,0,0.18098,0.043071,-1.1021,0,0,shoulderBase_link,1,0,0,,,,,,,,,,,, -forarm_link,1.84574577843932E-15,0.0550154986611603,0.120152803034247,0,0,0,0.517796101730459,0.00404850874710771,2.11419423634673E-18,-1.54871504075976E-17,0.00375548329392274,-0.000377385363706529,0.000788327838226562,0,0,0,0,0,0,package://wroboarm_22/meshes/forarm_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/forarm_link.stl,,Forarm-1,Origin_elbow,Axis_elbow,elbow,continuous,0,0,0.46634,2.4936,0,0,upperArm_link,1,0,0,,,,,,,,,,,, -wirstBase_link,-1.94289029309402E-16,-1.66533453693773E-15,0.0987034845564234,0,0,0,0.301763082175337,0.00210344289702837,-2.71050543121376E-19,-2.24971950790742E-18,0.00305016250706558,1.85669622038143E-18,0.00107609106501786,0,0,0,0,0,0,package://wroboarm_22/meshes/wirstBase_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/wirstBase_link.stl,,WristStructure-1,Origin_forearm_roll,Axis_forearm_roll,forearm_roll,continuous,0,0.04445,0.2285,0,0,0,forarm_link,0,0,1,,,,,,,,,,,, -wrist_link,4.30211422042248E-16,-2.77555756156289E-17,0,0,0,0,0.447707117943176,0.000367702266904795,1.79994501291539E-19,-7.45388993583784E-19,0.000843427086265753,-1.35525271560688E-20,0.00084474612356066,0,0,0,0,0,0,package://wroboarm_22/meshes/wrist_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/wrist_link.stl,,Wrist-1,Origin_wrist_pitch,Axis_wrist_pitch,wrist_pitch,continuous,0,0,0.23716,-1.333,0,0,wirstBase_link,1,0,0,,,,,,,,,,,, -manipulator_link,-0.000730323740460503,-0.000899365669252,0.0490560099953423,0,0,0,0.397420225554811,0.00159684305263878,-3.07243227891656E-06,2.53235579936151E-05,0.0016343224414688,5.00292290874635E-05,0.000256322563994287,0,0,0,0,0,0,package://wroboarm_22/meshes/manipulator_link.stl,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_22/meshes/manipulator_link.stl,,Manipulator-1,Origin_wrist_roll,Axis_wrist_roll,wrist_roll,continuous,0,0,0,0,0,0.096862,wrist_link,0,0,1,,,,,,,,,,,, diff --git a/src/wroboarm_23/.setup_assistant b/src/wroboarm_23/.setup_assistant new file mode 100644 index 00000000..ccd64ddc --- /dev/null +++ b/src/wroboarm_23/.setup_assistant @@ -0,0 +1,11 @@ +moveit_setup_assistant_config: + URDF: + package: wroboarm_23 + relative_path: urdf/ArmAssembly.SLDASM.urdf + xacro_args: "" + SRDF: + relative_path: config/wroboarm_23.srdf + CONFIG: + author_name: Ben Nowotny + author_email: bennowotny65535@gmail.com + generated_timestamp: 1669082391 \ No newline at end of file diff --git a/src/wroboarm_21/CMakeLists.txt b/src/wroboarm_23/CMakeLists.txt similarity index 93% rename from src/wroboarm_21/CMakeLists.txt rename to src/wroboarm_23/CMakeLists.txt index 1fbbe71b..f1e67c4f 100644 --- a/src/wroboarm_21/CMakeLists.txt +++ b/src/wroboarm_23/CMakeLists.txt @@ -1,5 +1,5 @@ cmake_minimum_required(VERSION 3.1.3) -project(wroboarm_21) +project(wroboarm_23) find_package(catkin REQUIRED) diff --git a/src/wroboarm_21/config/cartesian_limits.yaml b/src/wroboarm_23/config/cartesian_limits.yaml similarity index 100% rename from src/wroboarm_21/config/cartesian_limits.yaml rename to src/wroboarm_23/config/cartesian_limits.yaml diff --git a/src/wroboarm_21/config/chomp_planning.yaml b/src/wroboarm_23/config/chomp_planning.yaml similarity index 79% rename from src/wroboarm_21/config/chomp_planning.yaml rename to src/wroboarm_23/config/chomp_planning.yaml index 75258e53..eb9c9122 100644 --- a/src/wroboarm_21/config/chomp_planning.yaml +++ b/src/wroboarm_23/config/chomp_planning.yaml @@ -7,12 +7,12 @@ learning_rate: 0.01 smoothness_cost_velocity: 0.0 smoothness_cost_acceleration: 1.0 smoothness_cost_jerk: 0.0 -ridge_factor: 0.01 +ridge_factor: 0.0 use_pseudo_inverse: false pseudo_inverse_ridge_factor: 1e-4 joint_update_limit: 0.1 -collision_clearence: 0.2 +collision_clearance: 0.2 collision_threshold: 0.07 use_stochastic_descent: true -enable_failure_recovery: true -max_recovery_attempts: 5 \ No newline at end of file +enable_failure_recovery: false +max_recovery_attempts: 5 diff --git a/src/wroboarm_23/config/fake_controllers.yaml b/src/wroboarm_23/config/fake_controllers.yaml new file mode 100644 index 00000000..46de675b --- /dev/null +++ b/src/wroboarm_23/config/fake_controllers.yaml @@ -0,0 +1,15 @@ +controller_list: + - name: fake_arm_controller + type: $(arg fake_execution_type) + joints: + - turntable_joint + - shoulder_joint + - elbowPitch_joint + - elbowRoll_joint + - wristPitch_joint + - wristRoll_link +initial: # Define initial robot poses per group +# - group: arm +# pose: home + + [] \ No newline at end of file diff --git a/src/wroboarm_22/config/gazebo_controllers.yaml b/src/wroboarm_23/config/gazebo_controllers.yaml similarity index 100% rename from src/wroboarm_22/config/gazebo_controllers.yaml rename to src/wroboarm_23/config/gazebo_controllers.yaml diff --git a/src/wroboarm_22/urdf/wroboarm_22.urdf b/src/wroboarm_23/config/gazebo_wroboarm_23.urdf similarity index 52% rename from src/wroboarm_22/urdf/wroboarm_22.urdf rename to src/wroboarm_23/config/gazebo_wroboarm_23.urdf index 22dda5d9..e4edc521 100644 --- a/src/wroboarm_22/urdf/wroboarm_22.urdf +++ b/src/wroboarm_23/config/gazebo_wroboarm_23.urdf @@ -1,281 +1,262 @@ - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - transmission_interface/SimpleTransmission - - hardware_interface/EffortJointInterface - - - hardware_interface/EffortJointInterface - 1 - - - - - / - - - \ No newline at end of file + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + transmission_interface/SimpleTransmission + + hardware_interface/EffortJointInterface + + + hardware_interface/EffortJointInterface + 1 + + + + transmission_interface/SimpleTransmission + + hardware_interface/EffortJointInterface + + + hardware_interface/EffortJointInterface + 1 + + + + transmission_interface/SimpleTransmission + + hardware_interface/EffortJointInterface + + + hardware_interface/EffortJointInterface + 1 + + + + transmission_interface/SimpleTransmission + + hardware_interface/EffortJointInterface + + + hardware_interface/EffortJointInterface + 1 + + + + transmission_interface/SimpleTransmission + + hardware_interface/EffortJointInterface + + + hardware_interface/EffortJointInterface + 1 + + + + transmission_interface/SimpleTransmission + + hardware_interface/EffortJointInterface + + + hardware_interface/EffortJointInterface + 1 + + + + + / + + + + diff --git a/src/wroboarm_23/config/joint_limits.yaml b/src/wroboarm_23/config/joint_limits.yaml new file mode 100644 index 00000000..ae579b8e --- /dev/null +++ b/src/wroboarm_23/config/joint_limits.yaml @@ -0,0 +1,52 @@ +# joint_limits.yaml allows the dynamics properties specified in the URDF to be overwritten or augmented as needed + +# For beginners, we downscale velocity and acceleration limits. +# You can always specify higher scaling factors (<= 1.0) in your motion requests. # Increase the values below to 1.0 to always move at maximum speed. +default_velocity_scaling_factor: 1.0 +default_acceleration_scaling_factor: 1.0 + +# Specific joint properties can be changed with the keys [max_position, min_position, max_velocity, max_acceleration] +# Joint limits can be turned off with [has_velocity_limits, has_acceleration_limits] +joint_limits: + elbowPitch_joint: + has_velocity_limits: true + max_velocity: 10 + has_acceleration_limits: true + max_acceleration: 10 + max_position: !radians 2.2 + min_position: !radians -0.2 + elbowRoll_joint: + has_velocity_limits: true + max_velocity: 10 + has_acceleration_limits: true + max_acceleration: 10 + max_position: !radians 0.7 + min_position: !radians -0.7 + shoulder_joint: + has_velocity_limits: true + max_velocity: 10 + has_acceleration_limits: true + max_acceleration: 10 + max_position: !radians 0 + min_position: !radians -1.3 + turntable_joint: + has_velocity_limits: true + max_velocity: 10 + has_acceleration_limits: true + max_acceleration: 10 + max_position: !radians pi / 2 + min_position: !radians 0 + wristPitch_joint: + has_velocity_limits: true + max_velocity: 10 + has_acceleration_limits: true + max_acceleration: 10 + max_position: !radians 2.5 + min_position: !radians -2.5 + wristRoll_link: + has_velocity_limits: true + max_velocity: 10 + has_acceleration_limits: true + max_acceleration: 10 + max_position: !radians pi + min_position: !radians -pi \ No newline at end of file diff --git a/src/wroboarm_23/config/joint_names_ArmAssembly.SLDASM.yaml b/src/wroboarm_23/config/joint_names_ArmAssembly.SLDASM.yaml new file mode 100644 index 00000000..05cd2083 --- /dev/null +++ b/src/wroboarm_23/config/joint_names_ArmAssembly.SLDASM.yaml @@ -0,0 +1 @@ +controller_joint_names: ['', 'turntable_joint', 'shoulder_joint', 'elbowPitch_joint', 'elbowRoll_joint', 'wristPitch_joint', 'wristRoll_link', ] diff --git a/src/wroboarm_21/config/kinematics.yaml b/src/wroboarm_23/config/kinematics.yaml similarity index 100% rename from src/wroboarm_21/config/kinematics.yaml rename to src/wroboarm_23/config/kinematics.yaml diff --git a/src/wroboarm_22/config/ompl_planning.yaml b/src/wroboarm_23/config/ompl_planning.yaml similarity index 98% rename from src/wroboarm_22/config/ompl_planning.yaml rename to src/wroboarm_23/config/ompl_planning.yaml index 47312ca4..5e0528df 100644 --- a/src/wroboarm_22/config/ompl_planning.yaml +++ b/src/wroboarm_23/config/ompl_planning.yaml @@ -153,3 +153,5 @@ arm: - LazyPRMstar - SPARS - SPARStwo + projection_evaluator: joints(turntable_joint,shoulder_joint) + longest_valid_segment_fraction: 0.005 diff --git a/src/wroboarm_23/config/ros_controllers.yaml b/src/wroboarm_23/config/ros_controllers.yaml new file mode 100644 index 00000000..a79ae41f --- /dev/null +++ b/src/wroboarm_23/config/ros_controllers.yaml @@ -0,0 +1,12 @@ +controller_list: + - name: arm_controller + action_ns: follow_joint_trajectory + type: FollowJointTrajectory + default: True + joints: + - turntable_joint + - shoulder_joint + - elbowPitch_joint + - elbowRoll_joint + - wristPitch_joint + - wristRoll_link \ No newline at end of file diff --git a/src/wroboarm_23/config/sensors_3d.yaml b/src/wroboarm_23/config/sensors_3d.yaml new file mode 100644 index 00000000..51010a36 --- /dev/null +++ b/src/wroboarm_23/config/sensors_3d.yaml @@ -0,0 +1,2 @@ +sensors: + [] \ No newline at end of file diff --git a/src/wroboarm_23/config/simple_moveit_controllers.yaml b/src/wroboarm_23/config/simple_moveit_controllers.yaml new file mode 100644 index 00000000..a79ae41f --- /dev/null +++ b/src/wroboarm_23/config/simple_moveit_controllers.yaml @@ -0,0 +1,12 @@ +controller_list: + - name: arm_controller + action_ns: follow_joint_trajectory + type: FollowJointTrajectory + default: True + joints: + - turntable_joint + - shoulder_joint + - elbowPitch_joint + - elbowRoll_joint + - wristPitch_joint + - wristRoll_link \ No newline at end of file diff --git a/src/wroboarm_23/config/stomp_planning.yaml b/src/wroboarm_23/config/stomp_planning.yaml new file mode 100644 index 00000000..ece56380 --- /dev/null +++ b/src/wroboarm_23/config/stomp_planning.yaml @@ -0,0 +1,39 @@ +stomp/arm: + group_name: arm + optimization: + num_timesteps: 60 + num_iterations: 40 + num_iterations_after_valid: 0 + num_rollouts: 30 + max_rollouts: 30 + initialization_method: 1 # [1 : LINEAR_INTERPOLATION, 2 : CUBIC_POLYNOMIAL, 3 : MININUM_CONTROL_COST] + control_cost_weight: 0.0 + task: + noise_generator: + - class: stomp_moveit/NormalDistributionSampling + stddev: [0.05, 0.05, 0.05, 0.05, 0.05, 0.05] + cost_functions: + - class: stomp_moveit/CollisionCheck + collision_penalty: 1.0 + cost_weight: 1.0 + kernel_window_percentage: 0.2 + longest_valid_joint_move: 0.05 + noisy_filters: + - class: stomp_moveit/JointLimits + lock_start: True + lock_goal: True + - class: stomp_moveit/MultiTrajectoryVisualization + line_width: 0.02 + rgb: [255, 255, 0] + marker_array_topic: stomp_trajectories + marker_namespace: noisy + update_filters: + - class: stomp_moveit/PolynomialSmoother + poly_order: 6 + - class: stomp_moveit/TrajectoryVisualization + line_width: 0.05 + rgb: [0, 191, 255] + error_rgb: [255, 0, 0] + publish_intermediate: True + marker_topic: stomp_trajectory + marker_namespace: optimized \ No newline at end of file diff --git a/src/wroboarm_22/config/wroboarm_22.srdf b/src/wroboarm_23/config/wroboarm_23.srdf similarity index 60% rename from src/wroboarm_22/config/wroboarm_22.srdf rename to src/wroboarm_23/config/wroboarm_23.srdf index 97c46660..f3d67e92 100644 --- a/src/wroboarm_22/config/wroboarm_22.srdf +++ b/src/wroboarm_23/config/wroboarm_23.srdf @@ -3,32 +3,26 @@ This is a format for representing semantic information about the robot structure. A URDF file must exist for this robot as well, where the joints and the links that are referenced are defined --> - + - - - - - - - + - + - + - - - - - - - - + + + + + + + + diff --git a/src/wroboarm_23/export.log b/src/wroboarm_23/export.log new file mode 100644 index 00000000..f12be56f --- /dev/null +++ b/src/wroboarm_23/export.log @@ -0,0 +1,705 @@ +2022-04-26 21:16:19,486 INFO Logger.cs: 70 - +-------------------------------------------------------------------------------- +2022-04-26 21:16:19,505 INFO Logger.cs: 71 - Logging commencing for SW2URDF exporter +2022-04-26 21:16:19,506 INFO Logger.cs: 73 - Commit version 1.6.0-4-g7f85cfe +2022-04-26 21:16:19,506 INFO Logger.cs: 74 - Build version 1.6.7995.38578 +2022-04-26 21:16:19,508 INFO SwAddin.cs: 192 - Attempting to connect to SW +2022-04-26 21:16:19,508 INFO SwAddin.cs: 197 - Setting up callbacks +2022-04-26 21:16:19,509 INFO SwAddin.cs: 201 - Setting up command manager +2022-04-26 21:16:19,509 INFO SwAddin.cs: 204 - Adding command manager +2022-04-26 21:16:19,511 INFO SwAddin.cs: 263 - Adding Assembly export to file menu +2022-04-26 21:16:19,512 INFO SwAddin.cs: 272 - Adding Part export to file menu +2022-04-26 21:16:19,512 INFO SwAddin.cs: 210 - Adding event handlers +2022-04-26 21:16:19,514 INFO SwAddin.cs: 217 - Connecting plugin to SolidWorks +2022-04-26 21:19:01,163 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM +2022-04-26 21:19:03,867 INFO SwAddin.cs: 313 - Saving assembly +2022-04-26 21:19:05,013 INFO SwAddin.cs: 316 - Opening property manager +2022-04-26 21:19:05,060 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:19:05,088 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:19:05,089 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:19:05,089 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:19:05,111 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:19:05,122 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:19:05,123 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:19:05,123 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:19:05,123 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:19:05,124 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:19:05,124 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:19:05,125 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:19:05,125 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:19:05,125 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:19:05,126 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:19:05,126 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:19:05,127 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:19:05,127 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:19:05,127 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:19:05,128 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:19:05,128 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:19:05,128 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:19:05,129 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:19:05,129 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:19:05,187 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:19:05,187 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:19:05,188 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:19:05,188 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:19:05,189 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:19:05,189 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:19:05,189 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:19:05,190 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:19:05,190 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:19:05,190 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:19:05,191 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:19:05,191 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:19:05,191 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:19:05,192 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:19:05,192 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:19:05,192 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:19:05,193 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:19:05,193 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:19:05,193 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:19:05,194 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:19:05,194 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:19:05,194 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:19:05,195 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:19:05,195 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:19:05,195 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:19:05,196 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:19:05,196 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:19:05,196 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:19:05,777 INFO SwAddin.cs: 339 - Loading config tree +2022-04-26 21:19:05,789 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 21:19:05,911 INFO LinkNode.cs: 35 - Building node base_link +2022-04-26 21:19:05,914 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\URDF\ArmAssembly.SLDASM +2022-04-26 21:19:05,915 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly +2022-04-26 21:19:05,935 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\base.SLDPRT +2022-04-26 21:19:05,935 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link +2022-04-26 21:19:05,981 INFO SwAddin.cs: 344 - Showing property manager +2022-04-26 21:19:16,795 INFO ExportPropertyManager.cs: 422 - Configuration saved +2022-04-26 21:19:16,812 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 21:19:16,903 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:19:54,237 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM +2022-04-26 21:19:55,264 INFO SwAddin.cs: 313 - Saving assembly +2022-04-26 21:19:55,326 INFO SwAddin.cs: 316 - Opening property manager +2022-04-26 21:19:55,326 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:19:55,327 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:19:55,327 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:19:55,328 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:19:55,328 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:19:55,328 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:19:55,329 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:19:55,329 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:19:55,329 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:19:55,330 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:19:55,330 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:19:55,330 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:19:55,331 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:19:55,331 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:19:55,331 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:19:55,332 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:19:55,332 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:19:55,340 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:19:55,360 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:19:55,360 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:19:55,361 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:19:55,361 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:19:55,361 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:19:55,362 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:19:55,362 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:19:55,363 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:19:55,363 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:19:55,364 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:19:55,364 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:19:55,364 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:19:55,365 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:19:55,365 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:19:55,365 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:19:55,366 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:19:55,366 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:19:55,366 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:19:55,367 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:19:55,367 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:19:55,367 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:19:55,368 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:19:55,368 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:19:55,369 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:19:55,369 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:19:55,369 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:19:55,370 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:19:55,370 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:19:55,370 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:19:55,371 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:19:55,371 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:19:55,371 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:19:55,372 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:19:55,372 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:19:55,413 INFO SwAddin.cs: 339 - Loading config tree +2022-04-26 21:19:55,413 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 21:19:55,414 INFO LinkNode.cs: 35 - Building node base_link +2022-04-26 21:19:55,414 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\URDF\ArmAssembly.SLDASM +2022-04-26 21:19:55,415 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly +2022-04-26 21:19:55,415 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\base.SLDPRT +2022-04-26 21:19:55,415 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link +2022-04-26 21:19:55,433 INFO SwAddin.cs: 344 - Showing property manager +2022-04-26 21:20:28,795 INFO ExportPropertyManager.cs: 422 - Configuration saved +2022-04-26 21:20:28,797 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 21:20:29,098 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:20:29,110 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:20:29,111 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:20:29,111 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:20:29,112 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:20:29,112 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:20:29,112 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:20:29,113 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:20:29,113 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:20:29,113 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:20:29,114 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:20:29,114 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:20:29,114 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:20:29,115 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:20:29,115 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:20:29,115 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:20:29,116 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:20:29,116 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:20:29,116 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:20:29,117 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:20:29,117 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:20:29,117 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:20:29,118 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:20:29,118 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:20:29,118 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:20:29,119 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:20:29,119 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:20:29,120 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:20:29,120 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:20:29,120 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:20:29,121 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:20:29,121 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:20:29,121 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:20:29,122 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:20:29,122 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:20:29,122 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:20:29,123 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:20:29,123 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:20:29,138 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:20:29,139 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:20:29,139 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:20:29,140 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:20:29,140 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:20:29,140 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:20:29,141 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:20:29,141 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:20:29,141 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:20:29,142 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:20:29,142 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:20:29,142 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:20:29,143 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:20:29,143 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:20:29,182 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:45,550 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM +2022-04-26 21:20:45,550 INFO SwAddin.cs: 299 - Save is required +2022-04-26 21:20:45,551 INFO SwAddin.cs: 313 - Saving assembly +2022-04-26 21:20:45,614 INFO SwAddin.cs: 316 - Opening property manager +2022-04-26 21:20:45,615 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:20:45,616 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:20:45,616 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:20:45,616 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:20:45,617 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:20:45,617 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:20:45,617 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:20:45,618 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:20:45,618 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:20:45,618 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:20:45,619 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:20:45,619 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:20:45,619 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:20:45,620 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:20:45,620 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:20:45,620 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:20:45,621 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:20:45,621 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:20:45,621 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:20:45,622 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:20:45,622 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:20:45,623 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:20:45,623 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:20:45,624 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:20:45,624 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:20:45,625 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:20:45,625 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:20:45,625 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:20:45,626 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:20:45,626 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:20:45,626 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:20:45,627 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:20:45,627 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:20:45,628 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:20:45,628 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:20:45,629 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:20:45,629 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:20:45,630 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:20:45,630 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:20:45,630 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:20:45,631 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:20:45,631 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:20:45,632 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:20:45,632 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:20:45,633 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:20:45,633 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:20:45,633 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:20:45,634 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:20:45,634 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:20:45,635 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:20:45,635 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:20:45,636 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:20:45,732 INFO SwAddin.cs: 339 - Loading config tree +2022-04-26 21:20:45,733 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=sDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==sDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==sDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAsDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==sDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==sDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalse +2022-04-26 21:20:45,734 INFO LinkNode.cs: 35 - Building node base_link +2022-04-26 21:20:45,734 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\URDF\ArmAssembly.SLDASM +2022-04-26 21:20:45,734 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly +2022-04-26 21:20:45,734 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\base.SLDPRT +2022-04-26 21:20:45,735 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???Shoulder-1@ArmAssembly +2022-04-26 21:20:45,735 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\Shoulder.SLDPRT +2022-04-26 21:20:45,735 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???UpperArm-1@ArmAssembly +2022-04-26 21:20:45,736 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\UpperArm.SLDPRT +2022-04-26 21:20:45,736 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???Forarm-1@ArmAssembly# +2022-04-26 21:20:45,736 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\Forarm.SLDPRT +2022-04-26 21:20:45,737 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???WristStructure-1@ArmAssembly( +2022-04-26 21:20:45,737 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\WristStructure.SLDPRT +2022-04-26 21:20:45,737 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???Wrist-1@ArmAssembly' +2022-04-26 21:20:45,738 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\Wrist.SLDPRT +2022-04-26 21:20:45,738 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???Manipulator-1@ArmAssembly$ +2022-04-26 21:20:45,739 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\Manipulator.SLDPRT +2022-04-26 21:20:45,739 INFO CommonSwOperations.cs: 230 - Loaded 7 components for link base_link +2022-04-26 21:20:45,909 INFO SwAddin.cs: 344 - Showing property manager +2022-04-26 21:20:50,182 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:50,491 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:52,134 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:53,289 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:53,987 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:54,678 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:55,176 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:55,830 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:20:58,315 INFO ExportPropertyManager.cs: 422 - Configuration saved +2022-04-26 21:20:58,316 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=sDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==sDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==sDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAsDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==sDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==sDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalse +2022-04-26 21:20:58,417 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:20:58,418 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:20:58,418 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:20:58,418 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:20:58,419 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:20:58,419 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:20:58,419 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:20:58,420 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:20:58,430 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:20:58,441 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:20:58,442 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:20:58,442 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:20:58,443 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:20:58,443 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:20:58,443 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:20:58,444 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:20:58,444 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:20:58,444 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:20:58,445 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:20:58,445 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:20:58,445 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:20:58,446 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:20:58,446 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:20:58,446 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:20:58,447 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:20:58,447 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:20:58,448 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:20:58,448 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:20:58,448 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:20:58,449 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:20:58,449 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:20:58,449 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:20:58,449 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:20:58,450 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:20:58,450 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:20:58,450 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:20:58,451 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:20:58,451 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:20:58,451 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:20:58,452 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:20:58,452 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:20:58,452 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:20:58,453 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:20:58,453 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:20:58,453 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:20:58,454 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:20:58,454 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:20:58,454 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:20:58,455 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:20:58,455 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:20:58,455 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:20:58,456 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:20:58,496 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:22:40,251 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM +2022-04-26 21:22:40,252 INFO SwAddin.cs: 299 - Save is required +2022-04-26 21:22:40,252 INFO SwAddin.cs: 313 - Saving assembly +2022-04-26 21:22:40,312 INFO SwAddin.cs: 316 - Opening property manager +2022-04-26 21:22:40,312 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:22:40,313 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:22:40,313 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:22:40,313 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:22:40,314 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:22:40,314 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:22:40,314 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:22:40,315 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:22:40,315 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:22:40,315 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:22:40,316 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:22:40,316 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:22:40,316 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:22:40,317 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:22:40,317 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:22:40,318 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:22:40,318 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:22:40,318 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:22:40,319 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:22:40,320 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:22:40,320 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:22:40,320 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:22:40,321 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:22:40,321 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:22:40,321 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:22:40,322 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:22:40,322 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:22:40,322 INFO ExportHelperExtension.cs: 1136 - Found 47 in ArmAssembly.SLDASM +2022-04-26 21:22:40,323 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:22:40,323 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:22:40,323 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:22:40,324 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:22:40,324 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:22:40,324 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:22:40,325 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:22:40,325 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:22:40,325 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:22:40,326 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:22:40,326 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:22:40,326 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:22:40,327 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:22:40,327 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:22:40,328 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:22:40,328 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:22:40,328 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:22:40,329 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:22:40,329 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:22:40,329 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:22:40,330 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:22:40,331 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:22:40,331 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:22:40,331 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:22:40,462 INFO SwAddin.cs: 339 - Loading config tree +2022-04-26 21:22:40,463 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 21:22:40,464 INFO LinkNode.cs: 35 - Building node base_link +2022-04-26 21:22:40,464 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\URDF\ArmAssembly.SLDASM +2022-04-26 21:22:40,464 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly +2022-04-26 21:22:40,464 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\base.SLDPRT +2022-04-26 21:22:40,465 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link +2022-04-26 21:22:40,495 INFO SwAddin.cs: 344 - Showing property manager +2022-04-26 21:22:43,955 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:22:44,696 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:22:46,553 INFO ExportPropertyManager.cs: 1036 - OnListboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:22:49,426 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:25:55,950 INFO SwAddin.cs: 294 - Assembly export called for file ArmAssembly.SLDASM +2022-04-26 21:25:55,950 INFO SwAddin.cs: 299 - Save is required +2022-04-26 21:25:55,951 INFO SwAddin.cs: 313 - Saving assembly +2022-04-26 21:25:56,086 INFO SwAddin.cs: 316 - Opening property manager +2022-04-26 21:25:56,087 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 21:25:56,088 INFO ExportHelperExtension.cs: 1136 - Found 53 in ArmAssembly.SLDASM +2022-04-26 21:25:56,088 INFO ExportHelperExtension.cs: 1145 - Found 1 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 21:25:56,088 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:25:56,089 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:25:56,089 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 21:25:56,089 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:25:56,090 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 21:25:56,090 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 21:25:56,090 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:25:56,091 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 21:25:56,091 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 21:25:56,091 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:25:56,092 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 21:25:56,092 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 21:25:56,093 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:25:56,093 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 21:25:56,094 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 21:25:56,095 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:25:56,096 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 21:25:56,096 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 21:25:56,096 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:25:56,097 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 21:25:56,097 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 21:25:56,097 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:25:56,098 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 21:25:56,098 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 21:25:56,099 INFO ExportHelperExtension.cs: 1136 - Found 53 in ArmAssembly.SLDASM +2022-04-26 21:25:56,099 INFO ExportHelperExtension.cs: 1145 - Found 6 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 21:25:56,099 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 21:25:56,100 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 21:25:56,100 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 21:25:56,100 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 21:25:56,101 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 21:25:56,101 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 21:25:56,101 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 21:25:56,102 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 21:25:56,102 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 21:25:56,102 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 21:25:56,103 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 21:25:56,103 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 21:25:56,103 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 21:25:56,103 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 21:25:56,104 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 21:25:56,104 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 21:25:56,104 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 21:25:56,105 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 21:25:56,105 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 21:25:56,105 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 21:25:56,106 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 21:25:56,106 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 21:25:56,106 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 21:25:56,235 INFO SwAddin.cs: 339 - Loading config tree +2022-04-26 21:25:56,236 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 21:25:56,236 INFO LinkNode.cs: 35 - Building node base_link +2022-04-26 21:25:56,237 INFO CommonSwOperations.cs: 221 - Loading SolidWorks components for base_link from E:\Robotics\WR\URDF\ArmAssembly.SLDASM +2022-04-26 21:25:56,237 INFO CommonSwOperations.cs: 245 - Loading component with PID ?6???base-1@ArmAssembly +2022-04-26 21:25:56,237 INFO CommonSwOperations.cs: 254 - Successfully loaded component E:\Robotics\WR\URDF\base.SLDPRT +2022-04-26 21:25:56,238 INFO CommonSwOperations.cs: 230 - Loaded 1 components for link base_link +2022-04-26 21:25:56,271 INFO SwAddin.cs: 344 - Showing property manager +2022-04-26 21:26:17,760 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:26:21,486 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:26:29,220 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:26:48,883 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:27:03,931 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:27:16,584 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:27:31,267 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:27:44,310 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:27:51,841 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:28:03,077 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:28:11,859 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:28:24,385 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:28:26,812 INFO ExportPropertyManager.cs: 1136 - OnNumberBoxTrackingCompleted called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 21:28:35,610 INFO ExportPropertyManager.cs: 1018 - OnComboboxSelectionChanged called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 22:16:01,745 INFO ExportPropertyManager.cs: 422 - Configuration saved +2022-04-26 22:16:01,747 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 22:16:01,816 INFO ExportHelperExtension.cs: 347 - Creating joint turntable_link +2022-04-26 22:16:01,823 INFO ExportHelperExtension.cs: 1397 - Fixing components for base_link +2022-04-26 22:16:01,824 INFO ExportHelperExtension.cs: 1402 - Fixing 24 +2022-04-26 22:16:01,824 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed +2022-04-26 22:16:02,369 INFO : 0 - R1: 1, System.__ComObject, 1, System.Double[] +2022-04-26 22:16:02,373 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 +2022-04-26 22:16:02,374 INFO ExportHelperExtension.cs: 849 - L1: 0 +2022-04-26 22:16:02,374 INFO ExportHelperExtension.cs: 857 - L2: 0 +2022-04-26 22:16:04,962 WARN ExportHelperExtension.cs: 351 - Creating joint from parent base_link to child turntable_link failed +2022-04-26 22:16:04,971 INFO ExportHelperExtension.cs: 347 - Creating joint upperArm_link +2022-04-26 22:16:04,971 INFO ExportHelperExtension.cs: 1397 - Fixing components for turntable_link +2022-04-26 22:16:04,972 INFO ExportHelperExtension.cs: 1402 - Fixing 25 +2022-04-26 22:16:04,972 INFO ExportHelperExtension.cs: 1402 - Fixing 24 +2022-04-26 22:16:04,972 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed +2022-04-26 22:16:05,267 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] +2022-04-26 22:16:05,267 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 +2022-04-26 22:16:05,268 INFO ExportHelperExtension.cs: 849 - L1: 0 +2022-04-26 22:16:05,268 INFO ExportHelperExtension.cs: 857 - L2: 0 +2022-04-26 22:16:05,268 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 +2022-04-26 22:16:06,570 WARN ExportHelperExtension.cs: 351 - Creating joint from parent turntable_link to child upperArm_link failed +2022-04-26 22:16:06,575 INFO ExportHelperExtension.cs: 347 - Creating joint forearm_link +2022-04-26 22:16:06,576 INFO ExportHelperExtension.cs: 1397 - Fixing components for upperArm_link +2022-04-26 22:16:06,576 INFO ExportHelperExtension.cs: 1402 - Fixing 26 +2022-04-26 22:16:06,576 INFO ExportHelperExtension.cs: 1402 - Fixing 25 +2022-04-26 22:16:06,577 INFO ExportHelperExtension.cs: 1402 - Fixing 24 +2022-04-26 22:16:06,577 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed +2022-04-26 22:16:06,893 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] +2022-04-26 22:16:06,893 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 +2022-04-26 22:16:06,893 INFO ExportHelperExtension.cs: 849 - L1: 0 +2022-04-26 22:16:06,894 INFO ExportHelperExtension.cs: 857 - L2: 0 +2022-04-26 22:16:06,894 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 +2022-04-26 22:16:06,894 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 +2022-04-26 22:16:08,241 WARN ExportHelperExtension.cs: 351 - Creating joint from parent upperArm_link to child forearm_link failed +2022-04-26 22:16:08,248 INFO ExportHelperExtension.cs: 347 - Creating joint wrist_link +2022-04-26 22:16:08,248 INFO ExportHelperExtension.cs: 1397 - Fixing components for forearm_link +2022-04-26 22:16:08,248 INFO ExportHelperExtension.cs: 1402 - Fixing 35 +2022-04-26 22:16:08,249 INFO ExportHelperExtension.cs: 1402 - Fixing 26 +2022-04-26 22:16:08,249 INFO ExportHelperExtension.cs: 1402 - Fixing 25 +2022-04-26 22:16:08,249 INFO ExportHelperExtension.cs: 1402 - Fixing 24 +2022-04-26 22:16:08,250 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed +2022-04-26 22:16:08,561 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] +2022-04-26 22:16:08,562 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 +2022-04-26 22:16:08,562 INFO ExportHelperExtension.cs: 849 - L1: 0 +2022-04-26 22:16:08,562 INFO ExportHelperExtension.cs: 857 - L2: 0 +2022-04-26 22:16:08,563 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 +2022-04-26 22:16:08,563 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 +2022-04-26 22:16:08,563 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 +2022-04-26 22:16:09,913 WARN ExportHelperExtension.cs: 351 - Creating joint from parent forearm_link to child wrist_link failed +2022-04-26 22:16:09,916 INFO ExportHelperExtension.cs: 347 - Creating joint carpus_link +2022-04-26 22:16:09,916 INFO ExportHelperExtension.cs: 1397 - Fixing components for wrist_link +2022-04-26 22:16:09,916 INFO ExportHelperExtension.cs: 1402 - Fixing 40 +2022-04-26 22:16:09,917 INFO ExportHelperExtension.cs: 1402 - Fixing 35 +2022-04-26 22:16:09,917 INFO ExportHelperExtension.cs: 1402 - Fixing 26 +2022-04-26 22:16:09,917 INFO ExportHelperExtension.cs: 1402 - Fixing 25 +2022-04-26 22:16:09,918 INFO ExportHelperExtension.cs: 1402 - Fixing 24 +2022-04-26 22:16:09,918 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed +2022-04-26 22:16:10,240 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] +2022-04-26 22:16:10,241 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 +2022-04-26 22:16:10,241 INFO ExportHelperExtension.cs: 849 - L1: 0 +2022-04-26 22:16:10,241 INFO ExportHelperExtension.cs: 857 - L2: 0 +2022-04-26 22:16:10,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 40 +2022-04-26 22:16:10,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 +2022-04-26 22:16:10,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 +2022-04-26 22:16:10,242 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 +2022-04-26 22:16:11,595 WARN ExportHelperExtension.cs: 351 - Creating joint from parent wrist_link to child carpus_link failed +2022-04-26 22:16:11,599 INFO ExportHelperExtension.cs: 347 - Creating joint endEffector_link +2022-04-26 22:16:11,599 INFO ExportHelperExtension.cs: 1397 - Fixing components for carpus_link +2022-04-26 22:16:11,600 INFO ExportHelperExtension.cs: 1402 - Fixing 39 +2022-04-26 22:16:11,600 INFO ExportHelperExtension.cs: 1402 - Fixing 40 +2022-04-26 22:16:11,600 INFO ExportHelperExtension.cs: 1402 - Fixing 35 +2022-04-26 22:16:11,601 INFO ExportHelperExtension.cs: 1402 - Fixing 26 +2022-04-26 22:16:11,601 INFO ExportHelperExtension.cs: 1402 - Fixing 25 +2022-04-26 22:16:11,601 INFO ExportHelperExtension.cs: 1402 - Fixing 24 +2022-04-26 22:16:11,607 INFO ExportHelperExtension.cs: 1409 - Component 24 is already fixed +2022-04-26 22:16:12,003 INFO ExportHelperExtension.cs: 828 - R1: 1, System.__ComObject, 1, System.Double[] +2022-04-26 22:16:12,004 INFO ExportHelperExtension.cs: 841 - R2: 0, 0 +2022-04-26 22:16:12,004 INFO ExportHelperExtension.cs: 849 - L1: 0 +2022-04-26 22:16:12,005 INFO ExportHelperExtension.cs: 857 - L2: 0 +2022-04-26 22:16:12,005 INFO ExportHelperExtension.cs: 1352 - Unfixing component 39 +2022-04-26 22:16:12,005 INFO ExportHelperExtension.cs: 1352 - Unfixing component 40 +2022-04-26 22:16:12,006 INFO ExportHelperExtension.cs: 1352 - Unfixing component 35 +2022-04-26 22:16:12,006 INFO ExportHelperExtension.cs: 1352 - Unfixing component 26 +2022-04-26 22:16:12,006 INFO ExportHelperExtension.cs: 1352 - Unfixing component 25 +2022-04-26 22:16:13,493 WARN ExportHelperExtension.cs: 351 - Creating joint from parent carpus_link to child endEffector_link failed +2022-04-26 22:16:13,569 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from ArmAssembly.SLDASM +2022-04-26 22:16:13,570 INFO ExportHelperExtension.cs: 1136 - Found 59 in ArmAssembly.SLDASM +2022-04-26 22:16:13,570 INFO ExportHelperExtension.cs: 1145 - Found 7 features of type [CoordSys] in ArmAssembly.SLDASM +2022-04-26 22:16:13,570 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 22:16:13,571 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 22:16:13,571 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from base-1 +2022-04-26 22:16:13,571 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 22:16:13,572 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in base-1 +2022-04-26 22:16:13,572 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Shoulder-1 +2022-04-26 22:16:13,572 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 22:16:13,573 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Shoulder-1 +2022-04-26 22:16:13,573 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from UpperArm-1 +2022-04-26 22:16:13,573 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 22:16:13,574 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in UpperArm-1 +2022-04-26 22:16:13,574 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Forarm-1 +2022-04-26 22:16:13,575 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 22:16:13,575 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Forarm-1 +2022-04-26 22:16:13,575 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Wrist-1 +2022-04-26 22:16:13,576 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 22:16:13,576 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Wrist-1 +2022-04-26 22:16:13,576 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from WristStructure-1 +2022-04-26 22:16:13,577 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 22:16:13,577 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in WristStructure-1 +2022-04-26 22:16:13,577 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [CoordSys] from Manipulator-1 +2022-04-26 22:16:13,578 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 22:16:13,578 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [CoordSys] in Manipulator-1 +2022-04-26 22:16:13,578 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from ArmAssembly.SLDASM +2022-04-26 22:16:13,579 INFO ExportHelperExtension.cs: 1136 - Found 59 in ArmAssembly.SLDASM +2022-04-26 22:16:13,579 INFO ExportHelperExtension.cs: 1145 - Found 6 features of type [RefAxis] in ArmAssembly.SLDASM +2022-04-26 22:16:13,579 INFO ExportHelperExtension.cs: 1148 - Proceeding through assembly components +2022-04-26 22:16:13,580 INFO ExportHelperExtension.cs: 1160 - 7 components to check +2022-04-26 22:16:13,580 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from base-1 +2022-04-26 22:16:13,580 INFO ExportHelperExtension.cs: 1136 - Found 27 in base-1 +2022-04-26 22:16:13,580 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in base-1 +2022-04-26 22:16:13,581 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Shoulder-1 +2022-04-26 22:16:13,581 INFO ExportHelperExtension.cs: 1136 - Found 50 in Shoulder-1 +2022-04-26 22:16:13,581 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Shoulder-1 +2022-04-26 22:16:13,582 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from UpperArm-1 +2022-04-26 22:16:13,582 INFO ExportHelperExtension.cs: 1136 - Found 41 in UpperArm-1 +2022-04-26 22:16:13,582 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in UpperArm-1 +2022-04-26 22:16:13,583 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Forarm-1 +2022-04-26 22:16:13,583 INFO ExportHelperExtension.cs: 1136 - Found 35 in Forarm-1 +2022-04-26 22:16:13,583 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Forarm-1 +2022-04-26 22:16:13,584 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Wrist-1 +2022-04-26 22:16:13,584 INFO ExportHelperExtension.cs: 1136 - Found 30 in Wrist-1 +2022-04-26 22:16:13,584 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Wrist-1 +2022-04-26 22:16:13,585 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from WristStructure-1 +2022-04-26 22:16:13,585 INFO ExportHelperExtension.cs: 1136 - Found 30 in WristStructure-1 +2022-04-26 22:16:13,585 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in WristStructure-1 +2022-04-26 22:16:13,586 INFO ExportHelperExtension.cs: 1125 - Retrieving features of type [RefAxis] from Manipulator-1 +2022-04-26 22:16:13,586 INFO ExportHelperExtension.cs: 1136 - Found 39 in Manipulator-1 +2022-04-26 22:16:13,586 INFO ExportHelperExtension.cs: 1145 - Found 0 features of type [RefAxis] in Manipulator-1 +2022-04-26 22:16:13,635 INFO ExportPropertyManager.cs: 1142 - AfterClose called. This method no longer throws an Exception. It just silently does nothing. Ok, except for this logging message +2022-04-26 22:17:26,131 INFO AssemblyExportForm.cs: 253 - Completing URDF export +2022-04-26 22:17:26,137 INFO ConfigurationSerialization.cs: 276 - URDF Configuration found +nametruebase_linkxyztrue9.1830074983591922E-190.0156064900891439551.5715252581589567E-18rpytrue000originfalsefalsevaluetrue0.93972387307473026massfalseixxtrue0.0025142902225504422ixytrue8.02209898558041E-21ixztrue-7.374852413660824E-20iyytrue0.0044229329573873041iyztrue2.2568808327940613E-20izztrue0.0021336882069818023inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue0.7921568627450980.819607843137254880.933333333333333351colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruetypetruexyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseOrigin_globallinktruenametrueturntable_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueturntable_jointtypetrueAutomatically Detectxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis1Automatically GeneratelinktruenametrueupperArm_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueshoulder_jointtypetrueAutomatically Detectxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis2Automatically Generatelinktruenametrueforearm_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueelbowPitch_jointtypetrueAutomatically Detectxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis3Automatically Generatelinktruenametruewrist_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametrueelbowRoll_jointtypetrueAutomatically Detectxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis4Automatically Generatelinktruenametruecarpus_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewristPitch_jointtypetrueAutomatically Detectxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis5Automatically GeneratelinktruenametrueendEffector_linkxyztrue000rpytrue000originfalsefalsevaluetrue0massfalseixxtrue0ixytrue0ixztrue0iyytrue0iyztrue0izztrue0inertiafalseinertialfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruenametruergbatrue1111colorfalsefilenametruetexturefalsematerialfalsevisualfalsexyztrue000rpytrue000originfalsefalsefilenametruemeshfalsegeometrytruecollisionfalsenametruewristRoll_linktypetrueAutomatically Detectxyztrue000rpytrue000originfalsefalselinktrueparenttruelinktruechildtruexyztrue000axisfalselowerfalseupperfalseefforttruevelocitytruelimitfalserisingfalsefallingfalsecalibrationfalsedampingfalsefrictionfalsedynamicsfalsesoft_upper_limitfalsesoft_lower_limitfalsek_positionfalsek_velocitytruesafety_controllerfalsejointtruemultiplierfalseoffsetfalsemimicfalsejointfalseAxis6Automatically GeneratelinktruefalsesDYAAAUAAAD//v8ZTQBhAG4AaQBwAHUAbABhAHQAbwByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJAAAAA==falsefalsefalsesDYAAAUAAAD//v8TVwByAGkAcwB0AC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAJwAAAA==falsefalsefalsesDYAAAUAAAD//v8cVwByAGkAcwB0AFMAdAByAHUAYwB0AHUAcgBlAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAKAAAAA==falsefalsefalsesDYAAAUAAAD//v8URgBvAHIAYQByAG0ALQAxAEAAQQByAG0AQQBzAHMAZQBtAGIAbAB5AAQAAAAQAAAAAQAAAAEAAAAjAAAAfalsefalsefalsesDYAAAUAAAD//v8WVQBwAHAAZQByAEEAcgBtAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGgAAAA==falsefalsefalsesDYAAAUAAAD//v8WUwBoAG8AdQBsAGQAZQByAC0AMQBAAEEAcgBtAEEAcwBzAGUAbQBiAGwAeQAEAAAAEAAAAAEAAAABAAAAGQAAAA==falsefalsefalsesDYAAAUAAAD//v8SYgBhAHMAZQAtADEAQABBAHIAbQBBAHMAcwBlAG0AYgBsAHkABAAAABAAAAABAAAAAQAAABgAAAA=falsefalse +2022-04-26 22:17:53,105 INFO AssemblyExportForm.cs: 309 - Saving URDF package to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM +2022-04-26 22:17:53,107 INFO ExportHelper.cs: 147 - Beginning the export process +2022-04-26 22:17:53,108 INFO ExportHelper.cs: 153 - Creating package directories with name ArmAssembly.SLDASM and save path E:\Robotics\WR\URDF\URDF +2022-04-26 22:17:55,069 INFO ExportHelper.cs: 162 - Creating CMakeLists.txt at E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\CMakeLists.txt +2022-04-26 22:17:55,070 INFO ExportHelper.cs: 166 - Creating joint names config at E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\config\joint_names_ArmAssembly.SLDASM.yaml +2022-04-26 22:17:55,071 INFO ExportHelper.cs: 170 - Creating package.xml at E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\package.xml +2022-04-26 22:17:55,071 INFO PackageXMLWriter.cs: 21 - Creating package.xml at E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\package.xml +2022-04-26 22:17:55,076 INFO ExportHelper.cs: 177 - Creating RVIZ launch file in E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\launch\ +2022-04-26 22:17:55,078 INFO ExportHelper.cs: 182 - Creating Gazebo launch file in E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\launch\ +2022-04-26 22:17:55,079 INFO ExportHelper.cs: 187 - Saving existing STL preferences +2022-04-26 22:17:55,080 INFO ExportHelper.cs: 450 - Saving users preferences +2022-04-26 22:17:55,080 INFO ExportHelper.cs: 190 - Modifying STL preferences +2022-04-26 22:17:55,081 INFO ExportHelper.cs: 464 - Setting STL preferences +2022-04-26 22:17:55,085 INFO ExportHelper.cs: 196 - Found 0 hidden components +2022-04-26 22:17:55,085 INFO ExportHelper.cs: 197 - Hiding all components +2022-04-26 22:17:55,336 INFO ExportHelper.cs: 204 - Beginning individual files export +2022-04-26 22:17:55,339 INFO ExportHelper.cs: 270 - Exporting link: base_link +2022-04-26 22:17:55,339 INFO ExportHelper.cs: 272 - Link base_link has 1 children +2022-04-26 22:17:55,340 INFO ExportHelper.cs: 270 - Exporting link: turntable_link +2022-04-26 22:17:55,341 INFO ExportHelper.cs: 272 - Link turntable_link has 1 children +2022-04-26 22:17:55,342 INFO ExportHelper.cs: 270 - Exporting link: upperArm_link +2022-04-26 22:17:55,342 INFO ExportHelper.cs: 272 - Link upperArm_link has 1 children +2022-04-26 22:17:55,343 INFO ExportHelper.cs: 270 - Exporting link: forearm_link +2022-04-26 22:17:55,343 INFO ExportHelper.cs: 272 - Link forearm_link has 1 children +2022-04-26 22:17:55,344 INFO ExportHelper.cs: 270 - Exporting link: wrist_link +2022-04-26 22:17:55,344 INFO ExportHelper.cs: 272 - Link wrist_link has 1 children +2022-04-26 22:17:55,344 INFO ExportHelper.cs: 270 - Exporting link: carpus_link +2022-04-26 22:17:55,345 INFO ExportHelper.cs: 272 - Link carpus_link has 1 children +2022-04-26 22:17:55,345 INFO ExportHelper.cs: 270 - Exporting link: endEffector_link +2022-04-26 22:17:55,346 INFO ExportHelper.cs: 272 - Link endEffector_link has 0 children +2022-04-26 22:17:55,346 INFO ExportHelper.cs: 317 - endEffector_link: Exporting STL with coordinate frame Origin_wristRoll_link +2022-04-26 22:17:55,347 INFO ExportHelper.cs: 322 - endEffector_link: Reference geometry name +2022-04-26 22:17:55,506 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\endEffector_link.STL +2022-04-26 22:17:55,923 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:55,923 INFO ExportHelper.cs: 317 - carpus_link: Exporting STL with coordinate frame Origin_wristPitch_joint +2022-04-26 22:17:55,924 INFO ExportHelper.cs: 322 - carpus_link: Reference geometry name +2022-04-26 22:17:55,969 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\carpus_link.STL +2022-04-26 22:17:56,017 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:56,018 INFO ExportHelper.cs: 317 - wrist_link: Exporting STL with coordinate frame Origin_elbowRoll_joint +2022-04-26 22:17:56,018 INFO ExportHelper.cs: 322 - wrist_link: Reference geometry name +2022-04-26 22:17:56,031 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\wrist_link.STL +2022-04-26 22:17:56,058 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:56,059 INFO ExportHelper.cs: 317 - forearm_link: Exporting STL with coordinate frame Origin_elbowPitch_joint +2022-04-26 22:17:56,059 INFO ExportHelper.cs: 322 - forearm_link: Reference geometry name +2022-04-26 22:17:56,112 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\forearm_link.STL +2022-04-26 22:17:56,168 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:56,169 INFO ExportHelper.cs: 317 - upperArm_link: Exporting STL with coordinate frame Origin_shoulder_joint +2022-04-26 22:17:56,169 INFO ExportHelper.cs: 322 - upperArm_link: Reference geometry name +2022-04-26 22:17:56,180 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\upperArm_link.STL +2022-04-26 22:17:56,216 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:56,217 INFO ExportHelper.cs: 317 - turntable_link: Exporting STL with coordinate frame Origin_turntable_joint +2022-04-26 22:17:56,217 INFO ExportHelper.cs: 322 - turntable_link: Reference geometry name +2022-04-26 22:17:56,290 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\turntable_link.STL +2022-04-26 22:17:56,359 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:56,360 INFO ExportHelper.cs: 317 - base_link: Exporting STL with coordinate frame Origin_global +2022-04-26 22:17:56,360 INFO ExportHelper.cs: 322 - base_link: Reference geometry name +2022-04-26 22:17:56,369 INFO ExportHelper.cs: 330 - Saving STL to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\meshes\base_link.STL +2022-04-26 22:17:56,393 INFO ExportHelper.cs: 405 - Removing SW header in STL file +2022-04-26 22:17:56,394 INFO ExportHelper.cs: 145 - Showing all components except previously hidden components +2022-04-26 22:17:56,648 INFO ExportHelper.cs: 145 - Resetting STL preferences +2022-04-26 22:17:56,649 INFO ExportHelper.cs: 478 - Returning STL preferences to user preferences +2022-04-26 22:17:56,649 INFO ExportHelper.cs: 228 - Writing URDF file to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\urdf\ArmAssembly.SLDASM.urdf +2022-04-26 22:17:56,675 INFO CSVImportExport.cs: 32 - Writing CSV file E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\urdf\ArmAssembly.SLDASM.csv +2022-04-26 22:17:56,718 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,718 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,719 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,719 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,720 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,720 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,726 ERROR CSVImportExport.cs: 130 - The following columns were not written to the CSV: Link.Joint.ChildLink.link, +2022-04-26 22:17:56,727 INFO ExportHelper.cs: 234 - Copying log file +2022-04-26 22:17:56,730 INFO ExportHelper.cs: 439 - Copying C:\Users\Payton Jackson\sw2urdf_logs\sw2urdf.log to E:\Robotics\WR\URDF\URDF\ArmAssembly.SLDASM\export.log diff --git a/src/wroboarm_23/launch/chomp_planning_pipeline.launch.xml b/src/wroboarm_23/launch/chomp_planning_pipeline.launch.xml new file mode 100644 index 00000000..34271389 --- /dev/null +++ b/src/wroboarm_23/launch/chomp_planning_pipeline.launch.xml @@ -0,0 +1,24 @@ + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_21/launch/default_warehouse_db.launch b/src/wroboarm_23/launch/default_warehouse_db.launch similarity index 85% rename from src/wroboarm_21/launch/default_warehouse_db.launch rename to src/wroboarm_23/launch/default_warehouse_db.launch index 1145f07a..2543e8f8 100644 --- a/src/wroboarm_21/launch/default_warehouse_db.launch +++ b/src/wroboarm_23/launch/default_warehouse_db.launch @@ -2,10 +2,10 @@ - + - + diff --git a/src/wroboarm_23/launch/demo.launch b/src/wroboarm_23/launch/demo.launch new file mode 100644 index 00000000..9abb2e63 --- /dev/null +++ b/src/wroboarm_23/launch/demo.launch @@ -0,0 +1,69 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + [move_group/fake_controller_joint_states] + + + + [move_group/fake_controller_joint_states] + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_23/launch/demo_gazebo.launch b/src/wroboarm_23/launch/demo_gazebo.launch new file mode 100644 index 00000000..a9f320c5 --- /dev/null +++ b/src/wroboarm_23/launch/demo_gazebo.launch @@ -0,0 +1,21 @@ + + + + + + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_23/launch/demo_test.launch b/src/wroboarm_23/launch/demo_test.launch new file mode 100644 index 00000000..8c258868 --- /dev/null +++ b/src/wroboarm_23/launch/demo_test.launch @@ -0,0 +1,69 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + [control/arm_joint_states] + + + + [control/arm_joint_states] + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_22/launch/display.launch b/src/wroboarm_23/launch/display.launch similarity index 73% rename from src/wroboarm_22/launch/display.launch rename to src/wroboarm_23/launch/display.launch index 21a998d4..ce58753b 100644 --- a/src/wroboarm_22/launch/display.launch +++ b/src/wroboarm_23/launch/display.launch @@ -3,7 +3,7 @@ name="model" /> + textfile="$(find wroboarm_23)/urdf/ArmAssembly.SLDASM.urdf" /> + args="-d $(find wroboarm_23)/urdf.rviz" /> \ No newline at end of file diff --git a/src/wroboarm_22/launch/fake_moveit_controller_manager.launch.xml b/src/wroboarm_23/launch/fake_moveit_controller_manager.launch.xml similarity index 77% rename from src/wroboarm_22/launch/fake_moveit_controller_manager.launch.xml rename to src/wroboarm_23/launch/fake_moveit_controller_manager.launch.xml index dc8b90e9..46689c86 100644 --- a/src/wroboarm_22/launch/fake_moveit_controller_manager.launch.xml +++ b/src/wroboarm_23/launch/fake_moveit_controller_manager.launch.xml @@ -1,12 +1,12 @@ - + - + diff --git a/src/wroboarm_23/launch/gazebo.launch b/src/wroboarm_23/launch/gazebo.launch new file mode 100644 index 00000000..cb085009 --- /dev/null +++ b/src/wroboarm_23/launch/gazebo.launch @@ -0,0 +1,32 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_21/launch/joystick_control.launch b/src/wroboarm_23/launch/joystick_control.launch similarity index 100% rename from src/wroboarm_21/launch/joystick_control.launch rename to src/wroboarm_23/launch/joystick_control.launch diff --git a/src/wroboarm_22/launch/move_group.launch b/src/wroboarm_23/launch/move_group.launch similarity index 68% rename from src/wroboarm_22/launch/move_group.launch rename to src/wroboarm_23/launch/move_group.launch index ccea67e0..bbaa5eb5 100644 --- a/src/wroboarm_22/launch/move_group.launch +++ b/src/wroboarm_23/launch/move_group.launch @@ -4,7 +4,7 @@ + value="gdb -x $(dirname)/gdb_settings.gdb --ex run --args" /> @@ -14,10 +14,9 @@ - - + + - @@ -38,9 +37,9 @@ " /> --> - + - + @@ -48,38 +47,37 @@ - + - + - - + + + file="$(dirname)/planning_pipeline.launch.xml"> - + - - - + + - - + + @@ -88,12 +86,15 @@ - - + + + + diff --git a/src/wroboarm_21/launch/moveit.rviz b/src/wroboarm_23/launch/moveit.rviz similarity index 76% rename from src/wroboarm_21/launch/moveit.rviz rename to src/wroboarm_23/launch/moveit.rviz index 87a9b996..97d51153 100644 --- a/src/wroboarm_21/launch/moveit.rviz +++ b/src/wroboarm_23/launch/moveit.rviz @@ -4,11 +4,11 @@ Panels: Name: Displays Property Tree Widget: Expanded: - - /Global Options1 - /MotionPlanning1 + - /MotionPlanning1/Planning Request1 - /Pose1 - Splitter Ratio: 0.7425600290298462 - Tree Height: 357 + Splitter Ratio: 0.5 + Tree Height: 295 - Class: rviz/Help Name: Help - Class: rviz/Views @@ -41,7 +41,7 @@ Visualization Manager: Plane Cell Count: 10 Reference Frame: Value: true - - Acceleration_Scaling_Factor: 1 + - Acceleration_Scaling_Factor: 0.1 Class: moveit_rviz_plugin/MotionPlanning Enabled: true Move Group Namespace: "" @@ -50,11 +50,9 @@ Visualization Manager: MoveIt_Allow_Replanning: false MoveIt_Allow_Sensor_Positioning: false MoveIt_Planning_Attempts: 10 - MoveIt_Planning_Time: 0.5 + MoveIt_Planning_Time: 5 MoveIt_Use_Cartesian_Path: false - MoveIt_Use_Constraint_Aware_IK: true - MoveIt_Warehouse_Host: 127.0.0.1 - MoveIt_Warehouse_Port: 33829 + MoveIt_Use_Constraint_Aware_IK: false MoveIt_Workspace: Center: X: 0 @@ -74,42 +72,37 @@ Visualization Manager: Expand Link Details: false Expand Tree: false Link Tree Style: Links in Alphabetic Order - dummy: + base_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - elbow: + carpus_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - forearm: + endEffector_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - gearbox: + forearm_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - manipulator: + turntable_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - turntable: + upperArm_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - upperarm: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - wrist: + wrist_link: Alpha: 1 Show Axes: false Show Trail: false @@ -123,6 +116,7 @@ Visualization Manager: State Display Time: 0.05 s Trail Step Size: 1 Trajectory Topic: move_group/display_planned_path + Use Sim Time: false Planning Metrics: Payload: 1 Show Joint Torques: false @@ -147,7 +141,7 @@ Visualization Manager: Scene Geometry: Scene Alpha: 1 Scene Color: 50; 230; 50 - Scene Display Time: 0.20000000298023224 + Scene Display Time: 0.009999999776482582 Show Scene Geometry: true Voxel Coloring: Z-Axis Voxel Rendering: Occupied Voxels @@ -159,63 +153,58 @@ Visualization Manager: Expand Link Details: false Expand Tree: false Link Tree Style: Links in Alphabetic Order - dummy: - Alpha: 1 - Show Axes: false - Show Trail: false - Value: true - elbow: + base_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - forearm: + carpus_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - gearbox: + endEffector_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - manipulator: + forearm_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - turntable: + turntable_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - upperarm: + upperArm_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - wrist: + wrist_link: Alpha: 1 Show Axes: false Show Trail: false Value: true - Robot Alpha: 1 + Robot Alpha: 0.85 Show Robot Collision: false Show Robot Visual: true Value: true - Velocity_Scaling_Factor: 1 + Velocity_Scaling_Factor: 0.1 - Alpha: 1 Axes Length: 0.10000000149011612 - Axes Radius: 0.029999999329447746 + Axes Radius: 0.02500000037252903 Class: rviz/Pose Color: 255; 25; 0 Enabled: true - Head Length: 0.07000000029802322 - Head Radius: 0.05000000074505806 + Head Length: 0.30000001192092896 + Head Radius: 0.10000000149011612 Name: Pose Queue Size: 10 - Shaft Length: 0.10000000149011612 - Shaft Radius: 0.029999999329447746 + Shaft Length: 1 + Shaft Radius: 0.05000000074505806 Shape: Axes Topic: /logic/arm_teleop/next_target Unreliable: false @@ -224,7 +213,7 @@ Visualization Manager: Global Options: Background Color: 48; 48; 48 Default Light: true - Fixed Frame: turntable + Fixed Frame: base_link Frame Rate: 30 Name: root Tools: @@ -235,42 +224,42 @@ Visualization Manager: Value: true Views: Current: - Class: rviz/XYOrbit - Distance: 1.7158159017562866 + Class: rviz/Orbit + Distance: 2 Enable Stereo Rendering: Stereo Eye Separation: 0.05999999865889549 Stereo Focal Distance: 1 Swap Stereo Eyes: false Value: false - Field of View: 0.7853981852531433 + Field of View: 0.75 Focal Point: - X: 0.05638057738542557 - Y: 0.06656442582607269 - Z: 1.6391335577736754e-07 + X: -0.10000000149011612 + Y: 0.25 + Z: 0.30000001192092896 Focal Shape Fixed Size: true Focal Shape Size: 0.05000000074505806 Invert Z Axis: false Name: Current View Near Clip Distance: 0.009999999776482582 - Pitch: 0.6097966432571411 - Target Frame: turntable - Yaw: 5.253137111663818 + Pitch: 0.5 + Target Frame: base_link + Yaw: -0.6232355833053589 Saved: ~ Window Geometry: Displays: - collapsed: true + collapsed: false Height: 1016 Help: collapsed: false - Hide Left Dock: true + Hide Left Dock: false Hide Right Dock: false MotionPlanning: - collapsed: true + collapsed: false MotionPlanning - Trajectory Slider: collapsed: false - QMainWindow State: 000000ff00000000fd0000000100000000000002a20000039efc0200000007fb000000100044006900730070006c006100790073000000003d000001c2000000c900fffffffb0000000800480065006c00700000000342000000bb0000006e00fffffffb0000000a0056006900650077007300000003b0000000b0000000a400fffffffb0000000c00430061006d00650072006100000002ff000001610000000000000000fb0000001e004d006f00740069006f006e00200050006c0061006e006e0069006e00670100000374000001890000000000000000fb00000044004d006f00740069006f006e0050006c0061006e006e0069006e00670020002d0020005400720061006a006500630074006f0072007900200053006c00690064006500720000000000ffffffff0000001600000016fb0000001c004d006f00740069006f006e0050006c0061006e006e0069006e00670000000205000001d60000017d00ffffff0000045e0000039e00000001000000020000000100000002fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000 + QMainWindow State: 000000ff00000000fd0000000100000000000001f30000039efc0200000007fb000000100044006900730070006c006100790073010000003d000001b8000000c900fffffffb0000000800480065006c00700000000342000000bb0000006e00fffffffb0000000a00560069006500770073000000010c000000a4000000a400fffffffb0000000c00430061006d00650072006100000002ff000001610000000000000000fb0000001e004d006f00740069006f006e00200050006c0061006e006e0069006e00670100000374000001890000000000000000fb00000044004d006f00740069006f006e0050006c0061006e006e0069006e00670020002d0020005400720061006a006500630074006f0072007900200053006c00690064006500720000000000ffffffff0000001600000016fb0000001c004d006f00740069006f006e0050006c0061006e006e0069006e006701000001fb000001e00000017d00ffffff0000053f0000039e00000001000000020000000100000002fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000 Views: collapsed: false - Width: 1118 - X: 802 + Width: 1848 + X: 72 Y: 27 diff --git a/src/wroboarm_22/launch/moveit_rviz.launch b/src/wroboarm_23/launch/moveit_rviz.launch similarity index 100% rename from src/wroboarm_22/launch/moveit_rviz.launch rename to src/wroboarm_23/launch/moveit_rviz.launch diff --git a/src/wroboarm_23/launch/ompl-chomp_planning_pipeline.launch.xml b/src/wroboarm_23/launch/ompl-chomp_planning_pipeline.launch.xml new file mode 100644 index 00000000..7318a0b8 --- /dev/null +++ b/src/wroboarm_23/launch/ompl-chomp_planning_pipeline.launch.xml @@ -0,0 +1,20 @@ + + + + + + + + + + + + diff --git a/src/wroboarm_23/launch/ompl_planning_pipeline.launch.xml b/src/wroboarm_23/launch/ompl_planning_pipeline.launch.xml new file mode 100644 index 00000000..1bdd6cfc --- /dev/null +++ b/src/wroboarm_23/launch/ompl_planning_pipeline.launch.xml @@ -0,0 +1,27 @@ + + + + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_23/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml b/src/wroboarm_23/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml new file mode 100644 index 00000000..c7c4cf50 --- /dev/null +++ b/src/wroboarm_23/launch/pilz_industrial_motion_planner_planning_pipeline.launch.xml @@ -0,0 +1,15 @@ + + + + + + + + + + + + + + diff --git a/src/wroboarm_22/launch/planning_context.launch b/src/wroboarm_23/launch/planning_context.launch similarity index 75% rename from src/wroboarm_22/launch/planning_context.launch rename to src/wroboarm_23/launch/planning_context.launch index 9e6bc4cb..b5f6954c 100644 --- a/src/wroboarm_22/launch/planning_context.launch +++ b/src/wroboarm_23/launch/planning_context.launch @@ -6,20 +6,20 @@ - + - + - - + + - + diff --git a/src/wroboarm_22/launch/planning_pipeline.launch.xml b/src/wroboarm_23/launch/planning_pipeline.launch.xml similarity index 70% rename from src/wroboarm_22/launch/planning_pipeline.launch.xml rename to src/wroboarm_23/launch/planning_pipeline.launch.xml index 93a9ab28..4b4d0d66 100644 --- a/src/wroboarm_22/launch/planning_pipeline.launch.xml +++ b/src/wroboarm_23/launch/planning_pipeline.launch.xml @@ -5,6 +5,6 @@ - + diff --git a/src/wroboarm_22/launch/ros_control_moveit_controller_manager.launch.xml b/src/wroboarm_23/launch/ros_control_moveit_controller_manager.launch.xml similarity index 100% rename from src/wroboarm_22/launch/ros_control_moveit_controller_manager.launch.xml rename to src/wroboarm_23/launch/ros_control_moveit_controller_manager.launch.xml diff --git a/src/wroboarm_21/launch/ros_controllers.launch b/src/wroboarm_23/launch/ros_controllers.launch similarity index 71% rename from src/wroboarm_21/launch/ros_controllers.launch rename to src/wroboarm_23/launch/ros_controllers.launch index f23ccb91..7c953597 100644 --- a/src/wroboarm_21/launch/ros_controllers.launch +++ b/src/wroboarm_23/launch/ros_controllers.launch @@ -2,10 +2,10 @@ - + + output="screen" args="arm_controller "/> diff --git a/src/wroboarm_21/launch/run_benchmark_ompl.launch b/src/wroboarm_23/launch/run_benchmark_ompl.launch similarity index 74% rename from src/wroboarm_21/launch/run_benchmark_ompl.launch rename to src/wroboarm_23/launch/run_benchmark_ompl.launch index f4cc195a..abea39b7 100644 --- a/src/wroboarm_21/launch/run_benchmark_ompl.launch +++ b/src/wroboarm_23/launch/run_benchmark_ompl.launch @@ -4,18 +4,18 @@ - + - + - + diff --git a/src/wroboarm_21/launch/sensor_manager.launch.xml b/src/wroboarm_23/launch/sensor_manager.launch.xml similarity index 69% rename from src/wroboarm_21/launch/sensor_manager.launch.xml rename to src/wroboarm_23/launch/sensor_manager.launch.xml index 31fd01af..c12a65c3 100644 --- a/src/wroboarm_21/launch/sensor_manager.launch.xml +++ b/src/wroboarm_23/launch/sensor_manager.launch.xml @@ -3,7 +3,7 @@ - + @@ -11,7 +11,7 @@ - - + + diff --git a/src/wroboarm_22/launch/setup_assistant.launch b/src/wroboarm_23/launch/setup_assistant.launch similarity index 88% rename from src/wroboarm_22/launch/setup_assistant.launch rename to src/wroboarm_23/launch/setup_assistant.launch index 41910f78..da7b439c 100644 --- a/src/wroboarm_22/launch/setup_assistant.launch +++ b/src/wroboarm_23/launch/setup_assistant.launch @@ -8,8 +8,9 @@ diff --git a/src/wroboarm_22/launch/simple_moveit_controller_manager.launch.xml b/src/wroboarm_23/launch/simple_moveit_controller_manager.launch.xml similarity index 70% rename from src/wroboarm_22/launch/simple_moveit_controller_manager.launch.xml rename to src/wroboarm_23/launch/simple_moveit_controller_manager.launch.xml index c8236948..7a92fb9b 100644 --- a/src/wroboarm_22/launch/simple_moveit_controller_manager.launch.xml +++ b/src/wroboarm_23/launch/simple_moveit_controller_manager.launch.xml @@ -3,6 +3,6 @@ - - + + diff --git a/src/wroboarm_23/launch/stomp_planning_pipeline.launch.xml b/src/wroboarm_23/launch/stomp_planning_pipeline.launch.xml new file mode 100644 index 00000000..a1676cb5 --- /dev/null +++ b/src/wroboarm_23/launch/stomp_planning_pipeline.launch.xml @@ -0,0 +1,26 @@ + + + + + + + + + + + + + + + + + + + + diff --git a/src/wroboarm_21/launch/trajectory_execution.launch.xml b/src/wroboarm_23/launch/trajectory_execution.launch.xml similarity index 56% rename from src/wroboarm_21/launch/trajectory_execution.launch.xml rename to src/wroboarm_23/launch/trajectory_execution.launch.xml index 26c4b149..a2841558 100644 --- a/src/wroboarm_21/launch/trajectory_execution.launch.xml +++ b/src/wroboarm_23/launch/trajectory_execution.launch.xml @@ -1,6 +1,9 @@ + - + + + @@ -9,12 +12,12 @@ - + - - - + + diff --git a/src/wroboarm_22/launch/warehouse.launch b/src/wroboarm_23/launch/warehouse.launch similarity index 84% rename from src/wroboarm_22/launch/warehouse.launch rename to src/wroboarm_23/launch/warehouse.launch index d46aaeb6..0712e670 100644 --- a/src/wroboarm_22/launch/warehouse.launch +++ b/src/wroboarm_23/launch/warehouse.launch @@ -4,7 +4,7 @@ - + diff --git a/src/wroboarm_21/launch/warehouse_settings.launch.xml b/src/wroboarm_23/launch/warehouse_settings.launch.xml similarity index 100% rename from src/wroboarm_21/launch/warehouse_settings.launch.xml rename to src/wroboarm_23/launch/warehouse_settings.launch.xml diff --git a/src/wroboarm_21/launch/wroboarm_21_moveit_sensor_manager.launch.xml b/src/wroboarm_23/launch/wroboarm_23_moveit_sensor_manager.launch.xml similarity index 100% rename from src/wroboarm_21/launch/wroboarm_21_moveit_sensor_manager.launch.xml rename to src/wroboarm_23/launch/wroboarm_23_moveit_sensor_manager.launch.xml diff --git a/src/arm_assembly/meshes/base_link.STL b/src/wroboarm_23/meshes/base_link.STL similarity index 100% rename from src/arm_assembly/meshes/base_link.STL rename to src/wroboarm_23/meshes/base_link.STL diff --git a/src/wroboarm_23/meshes/carpus_link.STL b/src/wroboarm_23/meshes/carpus_link.STL new file mode 100644 index 00000000..412f5322 Binary files /dev/null and b/src/wroboarm_23/meshes/carpus_link.STL differ diff --git a/src/wroboarm_23/meshes/endEffector_link.STL b/src/wroboarm_23/meshes/endEffector_link.STL new file mode 100644 index 00000000..3efbbee9 Binary files /dev/null and b/src/wroboarm_23/meshes/endEffector_link.STL differ diff --git a/src/wroboarm_23/meshes/forearm_link.STL b/src/wroboarm_23/meshes/forearm_link.STL new file mode 100644 index 00000000..c9155a2e Binary files /dev/null and b/src/wroboarm_23/meshes/forearm_link.STL differ diff --git a/src/wroboarm_23/meshes/turntable_link.STL b/src/wroboarm_23/meshes/turntable_link.STL new file mode 100644 index 00000000..80b5b615 Binary files /dev/null and b/src/wroboarm_23/meshes/turntable_link.STL differ diff --git a/src/wroboarm_23/meshes/upperArm_link.STL b/src/wroboarm_23/meshes/upperArm_link.STL new file mode 100644 index 00000000..f8a54dcb Binary files /dev/null and b/src/wroboarm_23/meshes/upperArm_link.STL differ diff --git a/src/wroboarm_23/meshes/wrist_link.STL b/src/wroboarm_23/meshes/wrist_link.STL new file mode 100644 index 00000000..f79e328d Binary files /dev/null and b/src/wroboarm_23/meshes/wrist_link.STL differ diff --git a/src/wroboarm_22/package.xml b/src/wroboarm_23/package.xml similarity index 71% rename from src/wroboarm_22/package.xml rename to src/wroboarm_23/package.xml index 2ca5eaf6..ee8c34af 100644 --- a/src/wroboarm_22/package.xml +++ b/src/wroboarm_23/package.xml @@ -1,12 +1,12 @@ - wroboarm_22 + wroboarm_23 0.3.0 - An automatically generated package with all the configuration and launch files for using the wroboarm_22 with the MoveIt Motion Planning Framework + An automatically generated package with all the configuration and launch files for using the wroboarm_23 with the MoveIt Motion Planning Framework - Nicholas Underwood - Nicholas Underwood + Ben Nowotny + Ben Nowotny BSD @@ -29,6 +29,10 @@ rviz tf2_ros xacro + + + diff --git a/src/wroboarm_23/urdf/ArmAssembly.SLDASM.csv b/src/wroboarm_23/urdf/ArmAssembly.SLDASM.csv new file mode 100644 index 00000000..294889b5 --- /dev/null +++ b/src/wroboarm_23/urdf/ArmAssembly.SLDASM.csv @@ -0,0 +1,8 @@ +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,9.1830074983592E-19,-9.80159456515381E-19,0.015606490089144,0,0,0,0.93972387307473,0.00251429022255044,7.37485241366082E-20,8.66637218064247E-21,0.0021336882069818,1.14091331088149E-19,0.0044229329573873,0,0,0,0,0,0,package://wroboarm_23/meshes/base_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/base_link.STL,,base-1,Origin_global,,,,0,0,0,0,0,0,,0,0,0,,,,,,,,,,,, +turntable_link,-0.01225868218219,0.128577249577976,-0.00370544350042927,0,0,0,0.996366805002726,0.00652370094208946,0.0010646616036529,0.000283127005277363,0.0050231810993567,6.82113719161566E-05,0.00863345382595838,0,0,0,0,0,0,package://wroboarm_23/meshes/turntable_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/turntable_link.STL,,Shoulder-1,Origin_turntable_joint,Axis1,turntable_joint,continuous,0,0,0.035865,1.5708,0,-0.84509,base_link,0,1,0,,,,,,,,,,,, +upperArm_link,0.0143973999054599,-3.20061625693202E-05,0.279348384794928,0,0,0,0.985210343915811,0.0237982224738338,-8.8797773328906E-07,-0.00388532856230116,0.0293594722597601,-7.129443699684E-06,0.00625034839320102,0,0,0,0,0,0,package://wroboarm_23/meshes/upperArm_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/upperArm_link.STL,,UpperArm-1,Origin_shoulder_joint,Axis2,shoulder_joint,continuous,0,0.18098,0.043071,-1.5572,0,0,turntable_link,-1,0,0,,,,,,,,,,,, +forearm_link,-4.1286418728248E-16,0.0550154986611603,0.120152803034247,0,0,0,0.51779610173045,0.00404850874710764,-4.33680868994202E-19,2.87313575708659E-18,0.00375548329392275,-0.000377385363706531,0.000788327838226511,0,0,0,0,0,0,package://wroboarm_23/meshes/forearm_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/forearm_link.STL,,Forarm-1,Origin_elbowPitch_joint,Axis3,elbowPitch_joint,continuous,0,0,0.46634,2.7009,0,0,upperArm_link,-1,0,0,,,,,,,,,,,, +wrist_link,-2.77555756156289E-17,5.55111512312578E-17,0.096820252622317,0,0,0,0.301763082175336,0.00210344289702837,1.30104260698261E-18,5.14996031930615E-19,0.00305016250706558,-1.15196480826585E-18,0.00107609106501786,0,0,0,0,0,0,package://wroboarm_23/meshes/wrist_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/wrist_link.STL,,WristStructure-1,Origin_elbowRoll_joint,Axis4,elbowRoll_joint,continuous,0,0.04445,0.23038,0,0,0,forearm_link,0,0,1,,,,,,,,,,,, +carpus_link,5.55111512312578E-17,5.55111512312578E-17,0,0,0,0,0.447707117943177,0.000367702266904795,7.04731412115578E-19,1.62630325872826E-19,0.000843427086265753,0,0.000844746123560661,0,0,0,0,0,0,package://wroboarm_23/meshes/carpus_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/carpus_link.STL,,Wrist-1,Origin_wristPitch_joint,Axis5,wristPitch_joint,continuous,0,0,0.23528,0,0,0,wrist_link,-1,0,0,,,,,,,,,,,, +endEffector_link,-0.000725623905114631,-0.000893578002320872,0.0499824104113341,0,0,0,0.399994299548626,0.00169604127916281,-3.07411212276679E-06,2.57918978917245E-05,0.00173351996343527,5.0605971705242E-05,0.000256533582960489,0,0,0,0,0,0,package://wroboarm_23/meshes/endEffector_link.STL,0.792156862745098,0.819607843137255,0.933333333333333,1,0,0,0,0,0,0,package://wroboarm_23/meshes/endEffector_link.STL,,Manipulator-1,Origin_wristRoll_link,Axis6,wristRoll_link,continuous,0,0,0,0,0,0,carpus_link,0,0,1,,,,,,,,,,,, diff --git a/src/wroboarm_23/urdf/ArmAssembly.SLDASM.urdf b/src/wroboarm_23/urdf/ArmAssembly.SLDASM.urdf new file mode 100644 index 00000000..3bd1ee46 --- /dev/null +++ b/src/wroboarm_23/urdf/ArmAssembly.SLDASM.urdf @@ -0,0 +1,371 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + \ No newline at end of file diff --git a/test_arm_control_stack.sh b/test_arm_control_stack.sh index d86b8bb0..af265954 100755 --- a/test_arm_control_stack.sh +++ b/test_arm_control_stack.sh @@ -11,6 +11,8 @@ cd $ROOT_DIR #done #rm ./out.temp; export WROVER_LOCAL=true -export WROVER_HW=REAL +export WROVER_HW=MOCK +MOTOR_TO_INSPECT=11 +# (sleep 2 && rqt_plot /control/arm/$MOTOR_TO_INSPECT/output /control/arm/$MOTOR_TO_INSPECT/setpoint /control/arm/$MOTOR_TO_INSPECT/feedback) & #/hsi/roboclaw/aux1/cmd/left roslaunch wr_entry_point mock_arm.launch diff --git a/testscrpt.py b/testscrpt.py new file mode 100755 index 00000000..dd6cb4c3 --- /dev/null +++ b/testscrpt.py @@ -0,0 +1,41 @@ +#!/usr/bin/env python3 +import rospy +import sensor_msgs.msg as sensor_msgs +import matplotlib.pyplot as plt +from threading import Thread + +positions = None +names = None + +def newJS(jsMsg: sensor_msgs.JointState): + global positions, names + if positions is None: + positions = [] + names = [name for name in jsMsg.name] + for pos in jsMsg.position: + positions.append([pos]) + else: + for l, pos in zip(positions, jsMsg.position): + l.append(pos) + if len(l) > 500: + del l[0] + +def plot(): + global positions, names + while not rospy.is_shutdown(): + if positions is not None and names is not None: + for l in positions: + plt.plot(l) + plt.legend(names) + plt.pause(0.05) + plt.clf() + + +if __name__=="__main__": + rospy.init_node("testNode") + sub = rospy.Subscriber("/joint_states", sensor_msgs.JointState, newJS) + t1 = Thread(target=plot) + t1.start() + t1.join() + rospy.spin() + \ No newline at end of file