roboticstoolbox-python 1.3.0__cp312-cp312-win_amd64.whl
This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
- roboticstoolbox/__init__.py +104 -0
- roboticstoolbox/backends/Connector.py +107 -0
- roboticstoolbox/backends/Dynamixel/README.md +9 -0
- roboticstoolbox/backends/Dynamixel/dynamixel.json +581 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_io.py +450 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/LICENSE +201 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/README.md +28 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/ReleaseNote.md +181 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/__init__.py +27 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/group_bulk_read.py +163 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/group_bulk_write.py +109 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/group_sync_read.py +166 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/group_sync_write.py +99 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/packet_handler.py +33 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/port_handler.py +155 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/protocol1_packet_handler.py +548 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/protocol2_packet_handler.py +1080 -0
- roboticstoolbox/backends/Dynamixel/dynamixel_sdk/robotis_def.py +75 -0
- roboticstoolbox/backends/Dynamixel/dyndata.py +121 -0
- roboticstoolbox/backends/PyPlot/EllipsePlot.py +253 -0
- roboticstoolbox/backends/PyPlot/PyPlot.py +769 -0
- roboticstoolbox/backends/PyPlot/PyPlot2.py +526 -0
- roboticstoolbox/backends/PyPlot/README.md +67 -0
- roboticstoolbox/backends/PyPlot/RobotPlot.py +247 -0
- roboticstoolbox/backends/PyPlot/RobotPlot2.py +123 -0
- roboticstoolbox/backends/PyPlot/__init__.py +4 -0
- roboticstoolbox/backends/ROS/ROS.py +129 -0
- roboticstoolbox/backends/ROS/__init__.py +3 -0
- roboticstoolbox/backends/__init__.py +39 -0
- roboticstoolbox/backends/swift/__init__.py +26 -0
- roboticstoolbox/bin/__init__.py +0 -0
- roboticstoolbox/bin/rtbtool.py +307 -0
- roboticstoolbox/blocks/Icons/250x250/armplot.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/bicycle.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/camera.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/circlepath.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/coriolis.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/ctraj.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/delta2tr.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/diffsteer.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/fdyn.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/fdynx.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/fkine.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/gravload.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/idyn.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/idynx.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/ikine.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/inertia.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/jacobian.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/jtraj.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/lspb.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/multirotor.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/multirotormixer.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/multirotorplot.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/point2tr.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/tr2delta.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/tr2t.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/unicycle.png +0 -0
- roboticstoolbox/blocks/Icons/250x250/vehicleplot.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/armplot.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/bicycle.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/camera.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/circlepath.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/coriolis.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/delta2tr.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/diffsteer.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/fdyn.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/fdynx.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/fkine.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/gravload.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/idyn.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/idynx.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/ikine.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/inertia.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/jacobian.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/jtraj.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/lspb.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/multirotor.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/multirotormixer.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/multirotorplot.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/point2tr.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/tr2delta.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/tr2t.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/unicycle.png +0 -0
- roboticstoolbox/blocks/Icons/50x50/vehicleplot.png +0 -0
- roboticstoolbox/blocks/Icons/armplot.png +0 -0
- roboticstoolbox/blocks/Icons/bicycle.png +0 -0
- roboticstoolbox/blocks/Icons/camera.png +0 -0
- roboticstoolbox/blocks/Icons/circlepath.png +0 -0
- roboticstoolbox/blocks/Icons/coriolis.png +0 -0
- roboticstoolbox/blocks/Icons/ctraj.png +0 -0
- roboticstoolbox/blocks/Icons/delta2tr.png +0 -0
- roboticstoolbox/blocks/Icons/diffsteer.png +0 -0
- roboticstoolbox/blocks/Icons/fdyn.png +0 -0
- roboticstoolbox/blocks/Icons/fdynx.png +0 -0
- roboticstoolbox/blocks/Icons/fkine.png +0 -0
- roboticstoolbox/blocks/Icons/gravload.png +0 -0
- roboticstoolbox/blocks/Icons/idyn.png +0 -0
- roboticstoolbox/blocks/Icons/idynx.png +0 -0
- roboticstoolbox/blocks/Icons/ikine.png +0 -0
- roboticstoolbox/blocks/Icons/inertia.png +0 -0
- roboticstoolbox/blocks/Icons/jacobian.png +0 -0
- roboticstoolbox/blocks/Icons/jtraj.png +0 -0
- roboticstoolbox/blocks/Icons/lspb.png +0 -0
- roboticstoolbox/blocks/Icons/multirotor.png +0 -0
- roboticstoolbox/blocks/Icons/multirotormixer.png +0 -0
- roboticstoolbox/blocks/Icons/multirotorplot.png +0 -0
- roboticstoolbox/blocks/Icons/point2tr.png +0 -0
- roboticstoolbox/blocks/Icons/tr2delta.png +0 -0
- roboticstoolbox/blocks/Icons/tr2t.png +0 -0
- roboticstoolbox/blocks/Icons/unicycle.png +0 -0
- roboticstoolbox/blocks/Icons/vehicleplot.png +0 -0
- roboticstoolbox/blocks/README.md +43 -0
- roboticstoolbox/blocks/__init__.py +6 -0
- roboticstoolbox/blocks/arm.py +1587 -0
- roboticstoolbox/blocks/mobile.py +500 -0
- roboticstoolbox/blocks/quad_model.py +132 -0
- roboticstoolbox/blocks/spatial.py +245 -0
- roboticstoolbox/blocks/uav.py +949 -0
- roboticstoolbox/core/Eigen/Cholesky +45 -0
- roboticstoolbox/core/Eigen/CholmodSupport +48 -0
- roboticstoolbox/core/Eigen/Core +384 -0
- roboticstoolbox/core/Eigen/Dense +7 -0
- roboticstoolbox/core/Eigen/Eigen +2 -0
- roboticstoolbox/core/Eigen/Eigenvalues +60 -0
- roboticstoolbox/core/Eigen/Geometry +59 -0
- roboticstoolbox/core/Eigen/Householder +29 -0
- roboticstoolbox/core/Eigen/IterativeLinearSolvers +48 -0
- roboticstoolbox/core/Eigen/Jacobi +32 -0
- roboticstoolbox/core/Eigen/KLUSupport +41 -0
- roboticstoolbox/core/Eigen/LU +47 -0
- roboticstoolbox/core/Eigen/MetisSupport +35 -0
- roboticstoolbox/core/Eigen/OrderingMethods +70 -0
- roboticstoolbox/core/Eigen/PaStiXSupport +49 -0
- roboticstoolbox/core/Eigen/PardisoSupport +35 -0
- roboticstoolbox/core/Eigen/QR +50 -0
- roboticstoolbox/core/Eigen/QtAlignedMalloc +39 -0
- roboticstoolbox/core/Eigen/SPQRSupport +34 -0
- roboticstoolbox/core/Eigen/SVD +50 -0
- roboticstoolbox/core/Eigen/Sparse +34 -0
- roboticstoolbox/core/Eigen/SparseCholesky +37 -0
- roboticstoolbox/core/Eigen/SparseCore +69 -0
- roboticstoolbox/core/Eigen/SparseLU +50 -0
- roboticstoolbox/core/Eigen/SparseQR +36 -0
- roboticstoolbox/core/Eigen/StdDeque +27 -0
- roboticstoolbox/core/Eigen/StdList +26 -0
- roboticstoolbox/core/Eigen/StdVector +27 -0
- roboticstoolbox/core/Eigen/SuperLUSupport +64 -0
- roboticstoolbox/core/Eigen/UmfPackSupport +40 -0
- roboticstoolbox/core/Eigen/src/Cholesky/LDLT.h +688 -0
- roboticstoolbox/core/Eigen/src/Cholesky/LLT.h +558 -0
- roboticstoolbox/core/Eigen/src/Cholesky/LLT_LAPACKE.h +99 -0
- roboticstoolbox/core/Eigen/src/CholmodSupport/CholmodSupport.h +682 -0
- roboticstoolbox/core/Eigen/src/Core/ArithmeticSequence.h +413 -0
- roboticstoolbox/core/Eigen/src/Core/Array.h +417 -0
- roboticstoolbox/core/Eigen/src/Core/ArrayBase.h +226 -0
- roboticstoolbox/core/Eigen/src/Core/ArrayWrapper.h +209 -0
- roboticstoolbox/core/Eigen/src/Core/Assign.h +90 -0
- roboticstoolbox/core/Eigen/src/Core/AssignEvaluator.h +1010 -0
- roboticstoolbox/core/Eigen/src/Core/Assign_MKL.h +178 -0
- roboticstoolbox/core/Eigen/src/Core/BandMatrix.h +353 -0
- roboticstoolbox/core/Eigen/src/Core/Block.h +448 -0
- roboticstoolbox/core/Eigen/src/Core/BooleanRedux.h +162 -0
- roboticstoolbox/core/Eigen/src/Core/CommaInitializer.h +164 -0
- roboticstoolbox/core/Eigen/src/Core/ConditionEstimator.h +175 -0
- roboticstoolbox/core/Eigen/src/Core/CoreEvaluators.h +1741 -0
- roboticstoolbox/core/Eigen/src/Core/CoreIterators.h +132 -0
- roboticstoolbox/core/Eigen/src/Core/CwiseBinaryOp.h +183 -0
- roboticstoolbox/core/Eigen/src/Core/CwiseNullaryOp.h +1001 -0
- roboticstoolbox/core/Eigen/src/Core/CwiseTernaryOp.h +197 -0
- roboticstoolbox/core/Eigen/src/Core/CwiseUnaryOp.h +103 -0
- roboticstoolbox/core/Eigen/src/Core/CwiseUnaryView.h +132 -0
- roboticstoolbox/core/Eigen/src/Core/DenseBase.h +701 -0
- roboticstoolbox/core/Eigen/src/Core/DenseCoeffsBase.h +685 -0
- roboticstoolbox/core/Eigen/src/Core/DenseStorage.h +652 -0
- roboticstoolbox/core/Eigen/src/Core/Diagonal.h +258 -0
- roboticstoolbox/core/Eigen/src/Core/DiagonalMatrix.h +391 -0
- roboticstoolbox/core/Eigen/src/Core/DiagonalProduct.h +28 -0
- roboticstoolbox/core/Eigen/src/Core/Dot.h +318 -0
- roboticstoolbox/core/Eigen/src/Core/EigenBase.h +160 -0
- roboticstoolbox/core/Eigen/src/Core/ForceAlignedAccess.h +150 -0
- roboticstoolbox/core/Eigen/src/Core/Fuzzy.h +155 -0
- roboticstoolbox/core/Eigen/src/Core/GeneralProduct.h +465 -0
- roboticstoolbox/core/Eigen/src/Core/GenericPacketMath.h +1040 -0
- roboticstoolbox/core/Eigen/src/Core/GlobalFunctions.h +194 -0
- roboticstoolbox/core/Eigen/src/Core/IO.h +258 -0
- roboticstoolbox/core/Eigen/src/Core/IndexedView.h +237 -0
- roboticstoolbox/core/Eigen/src/Core/Inverse.h +117 -0
- roboticstoolbox/core/Eigen/src/Core/Map.h +171 -0
- roboticstoolbox/core/Eigen/src/Core/MapBase.h +310 -0
- roboticstoolbox/core/Eigen/src/Core/MathFunctions.h +2057 -0
- roboticstoolbox/core/Eigen/src/Core/MathFunctionsImpl.h +200 -0
- roboticstoolbox/core/Eigen/src/Core/Matrix.h +565 -0
- roboticstoolbox/core/Eigen/src/Core/MatrixBase.h +547 -0
- roboticstoolbox/core/Eigen/src/Core/NestByValue.h +85 -0
- roboticstoolbox/core/Eigen/src/Core/NoAlias.h +109 -0
- roboticstoolbox/core/Eigen/src/Core/NumTraits.h +335 -0
- roboticstoolbox/core/Eigen/src/Core/PartialReduxEvaluator.h +232 -0
- roboticstoolbox/core/Eigen/src/Core/PermutationMatrix.h +605 -0
- roboticstoolbox/core/Eigen/src/Core/PlainObjectBase.h +1128 -0
- roboticstoolbox/core/Eigen/src/Core/Product.h +191 -0
- roboticstoolbox/core/Eigen/src/Core/ProductEvaluators.h +1179 -0
- roboticstoolbox/core/Eigen/src/Core/Random.h +218 -0
- roboticstoolbox/core/Eigen/src/Core/Redux.h +515 -0
- roboticstoolbox/core/Eigen/src/Core/Ref.h +381 -0
- roboticstoolbox/core/Eigen/src/Core/Replicate.h +142 -0
- roboticstoolbox/core/Eigen/src/Core/Reshaped.h +454 -0
- roboticstoolbox/core/Eigen/src/Core/ReturnByValue.h +119 -0
- roboticstoolbox/core/Eigen/src/Core/Reverse.h +217 -0
- roboticstoolbox/core/Eigen/src/Core/Select.h +164 -0
- roboticstoolbox/core/Eigen/src/Core/SelfAdjointView.h +365 -0
- roboticstoolbox/core/Eigen/src/Core/SelfCwiseBinaryOp.h +47 -0
- roboticstoolbox/core/Eigen/src/Core/Solve.h +188 -0
- roboticstoolbox/core/Eigen/src/Core/SolveTriangular.h +235 -0
- roboticstoolbox/core/Eigen/src/Core/SolverBase.h +168 -0
- roboticstoolbox/core/Eigen/src/Core/StableNorm.h +251 -0
- roboticstoolbox/core/Eigen/src/Core/StlIterators.h +463 -0
- roboticstoolbox/core/Eigen/src/Core/Stride.h +116 -0
- roboticstoolbox/core/Eigen/src/Core/Swap.h +68 -0
- roboticstoolbox/core/Eigen/src/Core/Transpose.h +464 -0
- roboticstoolbox/core/Eigen/src/Core/Transpositions.h +386 -0
- roboticstoolbox/core/Eigen/src/Core/TriangularMatrix.h +1001 -0
- roboticstoolbox/core/Eigen/src/Core/VectorBlock.h +96 -0
- roboticstoolbox/core/Eigen/src/Core/VectorwiseOp.h +784 -0
- roboticstoolbox/core/Eigen/src/Core/Visitor.h +381 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX/Complex.h +372 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX/MathFunctions.h +228 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX/PacketMath.h +1574 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX/TypeCasting.h +115 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX512/Complex.h +422 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX512/MathFunctions.h +362 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX512/PacketMath.h +2303 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AVX512/TypeCasting.h +89 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AltiVec/Complex.h +417 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AltiVec/MathFunctions.h +90 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AltiVec/MatrixProduct.h +2937 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AltiVec/MatrixProductCommon.h +221 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AltiVec/MatrixProductMMA.h +629 -0
- roboticstoolbox/core/Eigen/src/Core/arch/AltiVec/PacketMath.h +2711 -0
- roboticstoolbox/core/Eigen/src/Core/arch/CUDA/Complex.h +258 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/BFloat16.h +700 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/ConjHelper.h +117 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/GenericPacketMathFunctions.h +1649 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/GenericPacketMathFunctionsFwd.h +110 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/Half.h +942 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/Settings.h +49 -0
- roboticstoolbox/core/Eigen/src/Core/arch/Default/TypeCasting.h +120 -0
- roboticstoolbox/core/Eigen/src/Core/arch/GPU/MathFunctions.h +103 -0
- roboticstoolbox/core/Eigen/src/Core/arch/GPU/PacketMath.h +1685 -0
- roboticstoolbox/core/Eigen/src/Core/arch/GPU/TypeCasting.h +80 -0
- roboticstoolbox/core/Eigen/src/Core/arch/HIP/hcc/math_constants.h +23 -0
- roboticstoolbox/core/Eigen/src/Core/arch/MSA/Complex.h +648 -0
- roboticstoolbox/core/Eigen/src/Core/arch/MSA/MathFunctions.h +387 -0
- roboticstoolbox/core/Eigen/src/Core/arch/MSA/PacketMath.h +1233 -0
- roboticstoolbox/core/Eigen/src/Core/arch/NEON/Complex.h +584 -0
- roboticstoolbox/core/Eigen/src/Core/arch/NEON/GeneralBlockPanelKernel.h +183 -0
- roboticstoolbox/core/Eigen/src/Core/arch/NEON/MathFunctions.h +75 -0
- roboticstoolbox/core/Eigen/src/Core/arch/NEON/PacketMath.h +4587 -0
- roboticstoolbox/core/Eigen/src/Core/arch/NEON/TypeCasting.h +1419 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SSE/Complex.h +351 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SSE/MathFunctions.h +199 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SSE/PacketMath.h +1505 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SSE/TypeCasting.h +142 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SVE/MathFunctions.h +44 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SVE/PacketMath.h +752 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SVE/TypeCasting.h +49 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SYCL/InteropHeaders.h +232 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SYCL/MathFunctions.h +301 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SYCL/PacketMath.h +670 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SYCL/SyclMemoryModel.h +694 -0
- roboticstoolbox/core/Eigen/src/Core/arch/SYCL/TypeCasting.h +85 -0
- roboticstoolbox/core/Eigen/src/Core/arch/ZVector/Complex.h +426 -0
- roboticstoolbox/core/Eigen/src/Core/arch/ZVector/MathFunctions.h +233 -0
- roboticstoolbox/core/Eigen/src/Core/arch/ZVector/PacketMath.h +1060 -0
- roboticstoolbox/core/Eigen/src/Core/functors/AssignmentFunctors.h +177 -0
- roboticstoolbox/core/Eigen/src/Core/functors/BinaryFunctors.h +541 -0
- roboticstoolbox/core/Eigen/src/Core/functors/NullaryFunctors.h +189 -0
- roboticstoolbox/core/Eigen/src/Core/functors/StlFunctors.h +166 -0
- roboticstoolbox/core/Eigen/src/Core/functors/TernaryFunctors.h +25 -0
- roboticstoolbox/core/Eigen/src/Core/functors/UnaryFunctors.h +1131 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralBlockPanelKernel.h +2645 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralMatrixMatrix.h +517 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralMatrixMatrixTriangular.h +317 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralMatrixMatrixTriangular_BLAS.h +145 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralMatrixMatrix_BLAS.h +124 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralMatrixVector.h +518 -0
- roboticstoolbox/core/Eigen/src/Core/products/GeneralMatrixVector_BLAS.h +136 -0
- roboticstoolbox/core/Eigen/src/Core/products/Parallelizer.h +180 -0
- roboticstoolbox/core/Eigen/src/Core/products/SelfadjointMatrixMatrix.h +544 -0
- roboticstoolbox/core/Eigen/src/Core/products/SelfadjointMatrixMatrix_BLAS.h +295 -0
- roboticstoolbox/core/Eigen/src/Core/products/SelfadjointMatrixVector.h +262 -0
- roboticstoolbox/core/Eigen/src/Core/products/SelfadjointMatrixVector_BLAS.h +118 -0
- roboticstoolbox/core/Eigen/src/Core/products/SelfadjointProduct.h +133 -0
- roboticstoolbox/core/Eigen/src/Core/products/SelfadjointRank2Update.h +94 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularMatrixMatrix.h +472 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularMatrixMatrix_BLAS.h +317 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularMatrixVector.h +350 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularMatrixVector_BLAS.h +255 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularSolverMatrix.h +337 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularSolverMatrix_BLAS.h +167 -0
- roboticstoolbox/core/Eigen/src/Core/products/TriangularSolverVector.h +148 -0
- roboticstoolbox/core/Eigen/src/Core/util/BlasUtil.h +583 -0
- roboticstoolbox/core/Eigen/src/Core/util/ConfigureVectorization.h +512 -0
- roboticstoolbox/core/Eigen/src/Core/util/Constants.h +563 -0
- roboticstoolbox/core/Eigen/src/Core/util/DisableStupidWarnings.h +106 -0
- roboticstoolbox/core/Eigen/src/Core/util/ForwardDeclarations.h +322 -0
- roboticstoolbox/core/Eigen/src/Core/util/IndexedViewHelper.h +186 -0
- roboticstoolbox/core/Eigen/src/Core/util/IntegralConstant.h +272 -0
- roboticstoolbox/core/Eigen/src/Core/util/MKL_support.h +137 -0
- roboticstoolbox/core/Eigen/src/Core/util/Macros.h +1464 -0
- roboticstoolbox/core/Eigen/src/Core/util/Memory.h +1163 -0
- roboticstoolbox/core/Eigen/src/Core/util/Meta.h +812 -0
- roboticstoolbox/core/Eigen/src/Core/util/NonMPL2.h +3 -0
- roboticstoolbox/core/Eigen/src/Core/util/ReenableStupidWarnings.h +31 -0
- roboticstoolbox/core/Eigen/src/Core/util/ReshapedHelper.h +51 -0
- roboticstoolbox/core/Eigen/src/Core/util/StaticAssert.h +221 -0
- roboticstoolbox/core/Eigen/src/Core/util/SymbolicIndex.h +293 -0
- roboticstoolbox/core/Eigen/src/Core/util/XprHelper.h +856 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/ComplexEigenSolver.h +346 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/ComplexSchur.h +462 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/ComplexSchur_LAPACKE.h +91 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/EigenSolver.h +622 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/GeneralizedEigenSolver.h +418 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/GeneralizedSelfAdjointEigenSolver.h +226 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/HessenbergDecomposition.h +374 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/MatrixBaseEigenvalues.h +158 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/RealQZ.h +657 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/RealSchur.h +558 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/RealSchur_LAPACKE.h +77 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/SelfAdjointEigenSolver.h +904 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/SelfAdjointEigenSolver_LAPACKE.h +87 -0
- roboticstoolbox/core/Eigen/src/Eigenvalues/Tridiagonalization.h +561 -0
- roboticstoolbox/core/Eigen/src/Geometry/AlignedBox.h +486 -0
- roboticstoolbox/core/Eigen/src/Geometry/AngleAxis.h +247 -0
- roboticstoolbox/core/Eigen/src/Geometry/EulerAngles.h +114 -0
- roboticstoolbox/core/Eigen/src/Geometry/Homogeneous.h +501 -0
- roboticstoolbox/core/Eigen/src/Geometry/Hyperplane.h +282 -0
- roboticstoolbox/core/Eigen/src/Geometry/OrthoMethods.h +235 -0
- roboticstoolbox/core/Eigen/src/Geometry/ParametrizedLine.h +232 -0
- roboticstoolbox/core/Eigen/src/Geometry/Quaternion.h +870 -0
- roboticstoolbox/core/Eigen/src/Geometry/Rotation2D.h +199 -0
- roboticstoolbox/core/Eigen/src/Geometry/RotationBase.h +206 -0
- roboticstoolbox/core/Eigen/src/Geometry/Scaling.h +188 -0
- roboticstoolbox/core/Eigen/src/Geometry/Transform.h +1563 -0
- roboticstoolbox/core/Eigen/src/Geometry/Translation.h +202 -0
- roboticstoolbox/core/Eigen/src/Geometry/Umeyama.h +166 -0
- roboticstoolbox/core/Eigen/src/Geometry/arch/Geometry_SIMD.h +168 -0
- roboticstoolbox/core/Eigen/src/Householder/BlockHouseholder.h +110 -0
- roboticstoolbox/core/Eigen/src/Householder/Householder.h +176 -0
- roboticstoolbox/core/Eigen/src/Householder/HouseholderSequence.h +545 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/BasicPreconditioners.h +226 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/BiCGSTAB.h +212 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/ConjugateGradient.h +229 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/IncompleteCholesky.h +394 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/IncompleteLUT.h +453 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/IterativeSolverBase.h +444 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/LeastSquareConjugateGradient.h +198 -0
- roboticstoolbox/core/Eigen/src/IterativeLinearSolvers/SolveWithGuess.h +117 -0
- roboticstoolbox/core/Eigen/src/Jacobi/Jacobi.h +483 -0
- roboticstoolbox/core/Eigen/src/KLUSupport/KLUSupport.h +358 -0
- roboticstoolbox/core/Eigen/src/LU/Determinant.h +117 -0
- roboticstoolbox/core/Eigen/src/LU/FullPivLU.h +877 -0
- roboticstoolbox/core/Eigen/src/LU/InverseImpl.h +432 -0
- roboticstoolbox/core/Eigen/src/LU/PartialPivLU.h +624 -0
- roboticstoolbox/core/Eigen/src/LU/PartialPivLU_LAPACKE.h +83 -0
- roboticstoolbox/core/Eigen/src/LU/arch/InverseSize4.h +351 -0
- roboticstoolbox/core/Eigen/src/MetisSupport/MetisSupport.h +137 -0
- roboticstoolbox/core/Eigen/src/OrderingMethods/Amd.h +435 -0
- roboticstoolbox/core/Eigen/src/OrderingMethods/Eigen_Colamd.h +1863 -0
- roboticstoolbox/core/Eigen/src/OrderingMethods/Ordering.h +153 -0
- roboticstoolbox/core/Eigen/src/PaStiXSupport/PaStiXSupport.h +678 -0
- roboticstoolbox/core/Eigen/src/PardisoSupport/PardisoSupport.h +545 -0
- roboticstoolbox/core/Eigen/src/QR/ColPivHouseholderQR.h +674 -0
- roboticstoolbox/core/Eigen/src/QR/ColPivHouseholderQR_LAPACKE.h +97 -0
- roboticstoolbox/core/Eigen/src/QR/CompleteOrthogonalDecomposition.h +635 -0
- roboticstoolbox/core/Eigen/src/QR/FullPivHouseholderQR.h +713 -0
- roboticstoolbox/core/Eigen/src/QR/HouseholderQR.h +434 -0
- roboticstoolbox/core/Eigen/src/QR/HouseholderQR_LAPACKE.h +68 -0
- roboticstoolbox/core/Eigen/src/SPQRSupport/SuiteSparseQRSupport.h +335 -0
- roboticstoolbox/core/Eigen/src/SVD/BDCSVD.h +1366 -0
- roboticstoolbox/core/Eigen/src/SVD/JacobiSVD.h +812 -0
- roboticstoolbox/core/Eigen/src/SVD/JacobiSVD_LAPACKE.h +91 -0
- roboticstoolbox/core/Eigen/src/SVD/SVDBase.h +376 -0
- roboticstoolbox/core/Eigen/src/SVD/UpperBidiagonalization.h +414 -0
- roboticstoolbox/core/Eigen/src/SparseCholesky/SimplicialCholesky.h +697 -0
- roboticstoolbox/core/Eigen/src/SparseCholesky/SimplicialCholesky_impl.h +174 -0
- roboticstoolbox/core/Eigen/src/SparseCore/AmbiVector.h +378 -0
- roboticstoolbox/core/Eigen/src/SparseCore/CompressedStorage.h +274 -0
- roboticstoolbox/core/Eigen/src/SparseCore/ConservativeSparseSparseProduct.h +352 -0
- roboticstoolbox/core/Eigen/src/SparseCore/MappedSparseMatrix.h +67 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseAssign.h +270 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseBlock.h +571 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseColEtree.h +206 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseCompressedBase.h +370 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseCwiseBinaryOp.h +722 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseCwiseUnaryOp.h +150 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseDenseProduct.h +342 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseDiagonalProduct.h +138 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseDot.h +98 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseFuzzy.h +29 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseMap.h +305 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseMatrix.h +1518 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseMatrixBase.h +398 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparsePermutation.h +178 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseProduct.h +181 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseRedux.h +49 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseRef.h +397 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseSelfAdjointView.h +659 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseSolverBase.h +124 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseSparseProductWithPruning.h +198 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseTranspose.h +92 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseTriangularView.h +189 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseUtil.h +186 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseVector.h +478 -0
- roboticstoolbox/core/Eigen/src/SparseCore/SparseView.h +254 -0
- roboticstoolbox/core/Eigen/src/SparseCore/TriangularSolver.h +315 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU.h +923 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLUImpl.h +66 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_Memory.h +226 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_Structs.h +110 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_SupernodalMatrix.h +375 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_Utils.h +80 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_column_bmod.h +181 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_column_dfs.h +179 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_copy_to_ucol.h +107 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_gemm_kernel.h +280 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_heap_relax_snode.h +126 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_kernel_bmod.h +130 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_panel_bmod.h +223 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_panel_dfs.h +258 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_pivotL.h +137 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_pruneL.h +136 -0
- roboticstoolbox/core/Eigen/src/SparseLU/SparseLU_relax_snode.h +83 -0
- roboticstoolbox/core/Eigen/src/SparseQR/SparseQR.h +758 -0
- roboticstoolbox/core/Eigen/src/StlSupport/StdDeque.h +116 -0
- roboticstoolbox/core/Eigen/src/StlSupport/StdList.h +106 -0
- roboticstoolbox/core/Eigen/src/StlSupport/StdVector.h +131 -0
- roboticstoolbox/core/Eigen/src/StlSupport/details.h +84 -0
- roboticstoolbox/core/Eigen/src/SuperLUSupport/SuperLUSupport.h +1025 -0
- roboticstoolbox/core/Eigen/src/UmfPackSupport/UmfPackSupport.h +642 -0
- roboticstoolbox/core/Eigen/src/misc/Image.h +82 -0
- roboticstoolbox/core/Eigen/src/misc/Kernel.h +79 -0
- roboticstoolbox/core/Eigen/src/misc/RealSvd2x2.h +55 -0
- roboticstoolbox/core/Eigen/src/misc/blas.h +440 -0
- roboticstoolbox/core/Eigen/src/misc/lapack.h +152 -0
- roboticstoolbox/core/Eigen/src/misc/lapacke.h +16292 -0
- roboticstoolbox/core/Eigen/src/misc/lapacke_mangling.h +17 -0
- roboticstoolbox/core/Eigen/src/plugins/ArrayCwiseBinaryOps.h +358 -0
- roboticstoolbox/core/Eigen/src/plugins/ArrayCwiseUnaryOps.h +696 -0
- roboticstoolbox/core/Eigen/src/plugins/BlockMethods.h +1442 -0
- roboticstoolbox/core/Eigen/src/plugins/CommonCwiseBinaryOps.h +115 -0
- roboticstoolbox/core/Eigen/src/plugins/CommonCwiseUnaryOps.h +177 -0
- roboticstoolbox/core/Eigen/src/plugins/IndexedViewMethods.h +262 -0
- roboticstoolbox/core/Eigen/src/plugins/MatrixCwiseBinaryOps.h +152 -0
- roboticstoolbox/core/Eigen/src/plugins/MatrixCwiseUnaryOps.h +95 -0
- roboticstoolbox/core/Eigen/src/plugins/ReshapedMethods.h +149 -0
- roboticstoolbox/core/fknm.cpp +1557 -0
- roboticstoolbox/core/fknm.h +55 -0
- roboticstoolbox/core/frne.c +351 -0
- roboticstoolbox/core/frne.h +96 -0
- roboticstoolbox/core/ik.cpp +301 -0
- roboticstoolbox/core/ik.h +59 -0
- roboticstoolbox/core/linalg.cpp +316 -0
- roboticstoolbox/core/linalg.h +64 -0
- roboticstoolbox/core/methods.cpp +372 -0
- roboticstoolbox/core/methods.h +32 -0
- roboticstoolbox/core/ne.c +493 -0
- roboticstoolbox/core/structs.cpp +24 -0
- roboticstoolbox/core/structs.h +62 -0
- roboticstoolbox/core/vmath.c +163 -0
- roboticstoolbox/core/vmath.h +32 -0
- roboticstoolbox/fknm.cp312-win_amd64.pyd +0 -0
- roboticstoolbox/frne.cp312-win_amd64.pyd +0 -0
- roboticstoolbox/mobile/Animations.py +485 -0
- roboticstoolbox/mobile/Bug2.py +455 -0
- roboticstoolbox/mobile/CurvaturePolyPlanner.py +179 -0
- roboticstoolbox/mobile/DistanceTransformPlanner.py +395 -0
- roboticstoolbox/mobile/DstarPlanner.py +591 -0
- roboticstoolbox/mobile/DubinsPlanner.py +474 -0
- roboticstoolbox/mobile/EKF.py +1617 -0
- roboticstoolbox/mobile/LatticePlanner.py +419 -0
- roboticstoolbox/mobile/OccGrid.py +613 -0
- roboticstoolbox/mobile/PRMPlanner.py +348 -0
- roboticstoolbox/mobile/ParticleFilter.py +706 -0
- roboticstoolbox/mobile/PlannerBase.py +1009 -0
- roboticstoolbox/mobile/PoseGraph.py +544 -0
- roboticstoolbox/mobile/QuinticPolyPlanner.py +349 -0
- roboticstoolbox/mobile/RRTPlanner.py +359 -0
- roboticstoolbox/mobile/ReedsSheppPlanner.py +545 -0
- roboticstoolbox/mobile/Vehicle.py +1909 -0
- roboticstoolbox/mobile/__init__.py +193 -0
- roboticstoolbox/mobile/drivers.py +390 -0
- roboticstoolbox/mobile/landmarkmap.py +181 -0
- roboticstoolbox/mobile/sensors.py +771 -0
- roboticstoolbox/models/DH/AL5D.py +121 -0
- roboticstoolbox/models/DH/Ball.py +87 -0
- roboticstoolbox/models/DH/Baxter.py +91 -0
- roboticstoolbox/models/DH/Cobra600.py +63 -0
- roboticstoolbox/models/DH/Coil.py +80 -0
- roboticstoolbox/models/DH/Hyper.py +83 -0
- roboticstoolbox/models/DH/Hyper3d.py +85 -0
- roboticstoolbox/models/DH/IRB140.py +159 -0
- roboticstoolbox/models/DH/Jaco.py +102 -0
- roboticstoolbox/models/DH/KR5.py +112 -0
- roboticstoolbox/models/DH/LWR4.py +85 -0
- roboticstoolbox/models/DH/Mico.py +102 -0
- roboticstoolbox/models/DH/Orion5.py +91 -0
- roboticstoolbox/models/DH/P8.py +80 -0
- roboticstoolbox/models/DH/Panda.py +178 -0
- roboticstoolbox/models/DH/Planar2.py +69 -0
- roboticstoolbox/models/DH/Planar3.py +51 -0
- roboticstoolbox/models/DH/Puma560.py +326 -0
- roboticstoolbox/models/DH/README.md +216 -0
- roboticstoolbox/models/DH/Sawyer.py +85 -0
- roboticstoolbox/models/DH/Stanford.py +147 -0
- roboticstoolbox/models/DH/TwoLink.py +109 -0
- roboticstoolbox/models/DH/UR10.py +124 -0
- roboticstoolbox/models/DH/UR3.py +98 -0
- roboticstoolbox/models/DH/UR5.py +98 -0
- roboticstoolbox/models/DH/Uprighttl.py +24 -0
- roboticstoolbox/models/DH/__init__.py +52 -0
- roboticstoolbox/models/ETS/Frankie.py +90 -0
- roboticstoolbox/models/ETS/GenericSeven.py +54 -0
- roboticstoolbox/models/ETS/Omni.py +74 -0
- roboticstoolbox/models/ETS/Panda.py +69 -0
- roboticstoolbox/models/ETS/Planar2.py +49 -0
- roboticstoolbox/models/ETS/Planar_Y.py +65 -0
- roboticstoolbox/models/ETS/Puma560.py +69 -0
- roboticstoolbox/models/ETS/XYPanda.py +84 -0
- roboticstoolbox/models/ETS/__init__.py +20 -0
- roboticstoolbox/models/README.md +9 -0
- roboticstoolbox/models/URDF/AL5D.py +54 -0
- roboticstoolbox/models/URDF/Fetch.py +70 -0
- roboticstoolbox/models/URDF/FetchCamera.py +71 -0
- roboticstoolbox/models/URDF/Frankie.py +75 -0
- roboticstoolbox/models/URDF/FrankieOmni.py +94 -0
- roboticstoolbox/models/URDF/KinovaGen3.py +71 -0
- roboticstoolbox/models/URDF/LBR.py +59 -0
- roboticstoolbox/models/URDF/Mico.py +68 -0
- roboticstoolbox/models/URDF/PR2.py +64 -0
- roboticstoolbox/models/URDF/Panda.py +67 -0
- roboticstoolbox/models/URDF/Puma560.py +97 -0
- roboticstoolbox/models/URDF/UR10.py +53 -0
- roboticstoolbox/models/URDF/UR3.py +53 -0
- roboticstoolbox/models/URDF/UR5.py +74 -0
- roboticstoolbox/models/URDF/Valkyrie.py +84 -0
- roboticstoolbox/models/URDF/YuMi.py +109 -0
- roboticstoolbox/models/URDF/__init__.py +53 -0
- roboticstoolbox/models/URDF/px100.py +56 -0
- roboticstoolbox/models/URDF/px150.py +56 -0
- roboticstoolbox/models/URDF/rx150.py +56 -0
- roboticstoolbox/models/URDF/rx200.py +56 -0
- roboticstoolbox/models/URDF/vx300.py +56 -0
- roboticstoolbox/models/URDF/vx300s.py +56 -0
- roboticstoolbox/models/URDF/wx200.py +56 -0
- roboticstoolbox/models/URDF/wx250.py +56 -0
- roboticstoolbox/models/URDF/wx250s.py +56 -0
- roboticstoolbox/models/__init__.py +7 -0
- roboticstoolbox/models/list.py +119 -0
- roboticstoolbox/robot/BaseRobot.py +3133 -0
- roboticstoolbox/robot/DHFactor.py +522 -0
- roboticstoolbox/robot/DHLink.py +981 -0
- roboticstoolbox/robot/DHRobot.py +2520 -0
- roboticstoolbox/robot/Dynamics.py +1620 -0
- roboticstoolbox/robot/ELink.py +23 -0
- roboticstoolbox/robot/ERobot.py +25 -0
- roboticstoolbox/robot/ET.py +1097 -0
- roboticstoolbox/robot/ETS.py +3542 -0
- roboticstoolbox/robot/Gripper.py +282 -0
- roboticstoolbox/robot/IK.py +1522 -0
- roboticstoolbox/robot/Link.py +1698 -0
- roboticstoolbox/robot/PoERobot.py +348 -0
- roboticstoolbox/robot/Robot.py +2100 -0
- roboticstoolbox/robot/RobotKinematics.py +1725 -0
- roboticstoolbox/robot/RobotProto.py +92 -0
- roboticstoolbox/robot/__init__.py +54 -0
- roboticstoolbox/tools/DHFactor.py +375 -0
- roboticstoolbox/tools/Ticker.py +53 -0
- roboticstoolbox/tools/__init__.py +54 -0
- roboticstoolbox/tools/data.py +187 -0
- roboticstoolbox/tools/jsingu.py +51 -0
- roboticstoolbox/tools/null.py +48 -0
- roboticstoolbox/tools/numerical.py +96 -0
- roboticstoolbox/tools/p_servo.py +106 -0
- roboticstoolbox/tools/params.py +11 -0
- roboticstoolbox/tools/plot.py +109 -0
- roboticstoolbox/tools/trajectory.py +1152 -0
- roboticstoolbox/tools/types.py +13 -0
- roboticstoolbox/tools/urdf/__init__.py +45 -0
- roboticstoolbox/tools/urdf/tests/data/ur5.urdf +341 -0
- roboticstoolbox/tools/urdf/tests/test_urdf.py +116 -0
- roboticstoolbox/tools/urdf/urdf.py +1976 -0
- roboticstoolbox/tools/urdf/utils.py +50 -0
- roboticstoolbox/tools/xacro/__init__.py +1148 -0
- roboticstoolbox/tools/xacro/cli.py +128 -0
- roboticstoolbox/tools/xacro/color.py +66 -0
- roboticstoolbox/tools/xacro/tests/CMakeLists.txt +4 -0
- roboticstoolbox/tools/xacro/tests/broken.xacro +1 -0
- roboticstoolbox/tools/xacro/tests/emoji.xacro +5 -0
- roboticstoolbox/tools/xacro/tests/include1.xacro +4 -0
- roboticstoolbox/tools/xacro/tests/include1.xml +1 -0
- roboticstoolbox/tools/xacro/tests/include2.xacro +4 -0
- roboticstoolbox/tools/xacro/tests/include2.xml +1 -0
- roboticstoolbox/tools/xacro/tests/robots/README +4 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/base_v0/base.gazebo.xacro +59 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/base_v0/base.transmission.xacro +24 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/base_v0/base.urdf.xacro +264 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/common.xacro +71 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/forearm_v0/forearm.gazebo.xacro +36 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/forearm_v0/forearm.transmission.xacro +20 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/forearm_v0/forearm.urdf.xacro +130 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/gazebo/gazebo.urdf.xacro +24 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/gripper_v0/gripper.gazebo.xacro +288 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/gripper_v0/gripper.transmission.xacro +50 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/gripper_v0/gripper.urdf.xacro +374 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/head_v0/head.gazebo.xacro +16 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/head_v0/head.transmission.xacro +34 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/head_v0/head.urdf.xacro +147 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/materials.urdf.xacro +52 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/pr2.urdf.xacro +157 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/pr2_1.11.4.xml +3781 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/double_stereo_camera.gazebo.xacro +16 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/double_stereo_camera.urdf.xacro +61 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/head_sensor_package.gazebo.xacro +20 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/head_sensor_package.urdf.xacro +63 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/hokuyo_lx30_laser.gazebo.xacro +39 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/hokuyo_lx30_laser.urdf.xacro +27 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/kinect_camera.gazebo.xacro +87 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/kinect_camera.urdf.xacro +55 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/kinect_prosilica_camera.gazebo.xacro +193 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/kinect_prosilica_camera.urdf.xacro +181 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/microstrain_3dmgx2_imu.gazebo.xacro +20 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/microstrain_3dmgx2_imu.urdf.xacro +25 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/projector_wg6802418.gazebo.xacro +31 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/projector_wg6802418.urdf.xacro +42 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/prosilica_gc2450_camera.gazebo.xacro +43 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/prosilica_gc2450_camera.urdf.xacro +49 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/stereo_camera.gazebo.xacro +23 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/stereo_camera.urdf.xacro +71 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/wge100_camera.gazebo.xacro +46 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/sensors/wge100_camera.urdf.xacro +47 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/shoulder_v0/shoulder.gazebo.xacro +40 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/shoulder_v0/shoulder.transmission.xacro +35 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/shoulder_v0/shoulder.urdf.xacro +167 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/tilting_laser_v0/tilting_laser.gazebo.xacro +11 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/tilting_laser_v0/tilting_laser.transmission.xacro +14 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/tilting_laser_v0/tilting_laser.urdf.xacro +60 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/torso_v0/torso.gazebo.xacro +37 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/torso_v0/torso.transmission.xacro +22 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/torso_v0/torso.urdf.xacro +122 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/upper_arm_v0/upper_arm.gazebo.xacro +39 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/upper_arm_v0/upper_arm.transmission.xacro +28 -0
- roboticstoolbox/tools/xacro/tests/robots/pr2/upper_arm_v0/upper_arm.urdf.xacro +173 -0
- roboticstoolbox/tools/xacro/tests/settings.yaml +9 -0
- roboticstoolbox/tools/xacro/tests/subdir/foo.xacro +3 -0
- roboticstoolbox/tools/xacro/tests/subdir/include-recursive.xacro +5 -0
- roboticstoolbox/tools/xacro/tests/subdir/include1.xml +1 -0
- roboticstoolbox/tools/xacro/tests/test_xacro.py +1418 -0
- roboticstoolbox/tools/xacro/xmlutils.py +152 -0
- roboticstoolbox_python-1.3.0.dist-info/METADATA +552 -0
- roboticstoolbox_python-1.3.0.dist-info/RECORD +673 -0
- roboticstoolbox_python-1.3.0.dist-info/WHEEL +5 -0
- roboticstoolbox_python-1.3.0.dist-info/entry_points.txt +6 -0
- roboticstoolbox_python-1.3.0.dist-info/licenses/LICENSE +21 -0
- spatialgeometry/__init__.py +32 -0
- spatialgeometry/geom/CollisionShape.py +419 -0
- spatialgeometry/geom/SceneGroup.py +26 -0
- spatialgeometry/geom/SceneNode.py +315 -0
- spatialgeometry/geom/Shape.py +420 -0
- spatialgeometry/geom/__init__.py +26 -0
- spatialgeometry/scene.py +107 -0
- spatialgeometry/tools/__init__.py +0 -0
- spatialgeometry/tools/stdout_supress.py +302 -0
|
@@ -0,0 +1,36 @@
|
|
|
1
|
+
<?xml version="1.0"?>
|
|
2
|
+
<robot xmlns:sensor="http://playerstage.sourceforge.net/gazebo/xmlschema/#sensor"
|
|
3
|
+
xmlns:controller="http://playerstage.sourceforge.net/gazebo/xmlschema/#controller"
|
|
4
|
+
xmlns:interface="http://playerstage.sourceforge.net/gazebo/xmlschema/#interface"
|
|
5
|
+
xmlns:xacro="http://ros.org/wiki/xacro">
|
|
6
|
+
|
|
7
|
+
<xacro:macro name="pr2_forearm_gazebo_v0" params="side">
|
|
8
|
+
|
|
9
|
+
<gazebo reference="${side}_forearm_link">
|
|
10
|
+
<turnGravityOff>true</turnGravityOff>
|
|
11
|
+
</gazebo>
|
|
12
|
+
|
|
13
|
+
<!-- Wrist flex -->
|
|
14
|
+
|
|
15
|
+
<gazebo reference="${side}_wrist_flex_link">
|
|
16
|
+
<turnGravityOff>true</turnGravityOff>
|
|
17
|
+
</gazebo>
|
|
18
|
+
<gazebo reference="${side}_wrist_flex_joint">
|
|
19
|
+
<stopKd value="1.0" />
|
|
20
|
+
<stopKp value="1000000.0" />
|
|
21
|
+
</gazebo>
|
|
22
|
+
|
|
23
|
+
<!-- Wrist roll -->
|
|
24
|
+
|
|
25
|
+
<gazebo reference="${side}_wrist_roll_link">
|
|
26
|
+
<turnGravityOff>true</turnGravityOff>
|
|
27
|
+
<material value="PR2/RollLinks" />
|
|
28
|
+
</gazebo>
|
|
29
|
+
<gazebo reference="${side}_wrist_roll_joint">
|
|
30
|
+
<fudgeFactor value="0.5" />
|
|
31
|
+
</gazebo>
|
|
32
|
+
|
|
33
|
+
</xacro:macro>
|
|
34
|
+
|
|
35
|
+
</robot>
|
|
36
|
+
|
|
@@ -0,0 +1,20 @@
|
|
|
1
|
+
<?xml version="1.0"?>
|
|
2
|
+
<robot xmlns:sensor="http://playerstage.sourceforge.net/gazebo/xmlschema/#sensor"
|
|
3
|
+
xmlns:controller="http://playerstage.sourceforge.net/gazebo/xmlschema/#controller"
|
|
4
|
+
xmlns:interface="http://playerstage.sourceforge.net/gazebo/xmlschema/#interface"
|
|
5
|
+
xmlns:xacro="http://ros.org/wiki/xacro">
|
|
6
|
+
|
|
7
|
+
<xacro:macro name="pr2_forearm_transmission_v0" params="side">
|
|
8
|
+
|
|
9
|
+
<!-- Wrist flex , Wrist roll -->
|
|
10
|
+
|
|
11
|
+
<transmission type="pr2_mechanism_model/WristTransmission" name="${side}_wrist_trans">
|
|
12
|
+
<rightActuator name="${side}_wrist_r_motor" mechanicalReduction="${624/35*54/16}"/>
|
|
13
|
+
<leftActuator name="${side}_wrist_l_motor" mechanicalReduction="${624/35*54/16}"/>
|
|
14
|
+
<flexJoint name="${side}_wrist_flex_joint" mechanicalReduction="-1.0" />
|
|
15
|
+
<rollJoint name="${side}_wrist_roll_joint" mechanicalReduction="1.0" />
|
|
16
|
+
</transmission>
|
|
17
|
+
|
|
18
|
+
</xacro:macro>
|
|
19
|
+
</robot>
|
|
20
|
+
|
|
@@ -0,0 +1,130 @@
|
|
|
1
|
+
<?xml version="1.0"?>
|
|
2
|
+
|
|
3
|
+
<!-- XML namespaces -->
|
|
4
|
+
<robot xmlns:sensor="http://playerstage.sourceforge.net/gazebo/xmlschema/#sensor"
|
|
5
|
+
xmlns:controller="http://playerstage.sourceforge.net/gazebo/xmlschema/#controller"
|
|
6
|
+
xmlns:interface="http://playerstage.sourceforge.net/gazebo/xmlschema/#interface"
|
|
7
|
+
xmlns:xacro="http://ros.org/wiki/xacro">
|
|
8
|
+
|
|
9
|
+
<!-- Things that are needed only for Gazebo (not the physical robot). These include
|
|
10
|
+
sensor and controller plugin specifications -->
|
|
11
|
+
<xacro:include filename="forearm.gazebo.xacro" />
|
|
12
|
+
<xacro:include filename="forearm.transmission.xacro" />
|
|
13
|
+
<xacro:include filename="../common.xacro" />
|
|
14
|
+
|
|
15
|
+
<!-- ============================ Forearm ============================ -->
|
|
16
|
+
|
|
17
|
+
<xacro:macro name="pr2_forearm_v0" params="side parent reflect *origin">
|
|
18
|
+
|
|
19
|
+
<joint name="${side}_forearm_joint" type="fixed">
|
|
20
|
+
<xacro:insert_block name="origin" /> <!-- transform from parent link to this joint frame -->
|
|
21
|
+
<parent link="${parent}"/>
|
|
22
|
+
<child link="${side}_forearm_link"/>
|
|
23
|
+
</joint>
|
|
24
|
+
<link name="${side}_forearm_link">
|
|
25
|
+
|
|
26
|
+
<inertial>
|
|
27
|
+
<mass value="2.57968" />
|
|
28
|
+
<origin xyz="0.18791 -0.00017 -0.00912" />
|
|
29
|
+
<inertia ixx="0.00364857222" ixy="0.00005215877" ixz="0.00071534842"
|
|
30
|
+
iyy="0.01507736897" iyz="-0.00001310770"
|
|
31
|
+
izz="0.01659310749" />
|
|
32
|
+
</inertial>
|
|
33
|
+
|
|
34
|
+
<visual>
|
|
35
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
36
|
+
<geometry>
|
|
37
|
+
<mesh filename="package://pr2_description/meshes/forearm_v0/forearm.dae" />
|
|
38
|
+
</geometry>
|
|
39
|
+
|
|
40
|
+
<material name="Grey" />
|
|
41
|
+
</visual>
|
|
42
|
+
|
|
43
|
+
<collision>
|
|
44
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
45
|
+
<geometry>
|
|
46
|
+
<mesh filename="package://pr2_description/meshes/forearm_v0/forearm.stl" />
|
|
47
|
+
</geometry>
|
|
48
|
+
</collision>
|
|
49
|
+
</link>
|
|
50
|
+
|
|
51
|
+
<!-- Wrist flex -->
|
|
52
|
+
<joint name="${side}_wrist_flex_joint" type="revolute">
|
|
53
|
+
<axis xyz="0 1 0" />
|
|
54
|
+
<limit upper="0.0" lower="-2.18" effort="10" velocity="${VELOCITY_LIMIT_SCALE*5.13}" /> <!-- alpha tested velocity and effort limits -->
|
|
55
|
+
<safety_controller k_position="20" k_velocity="4" soft_upper_limit="${0.0 - 0.10}" soft_lower_limit="${-2.18 + 0.18}" />
|
|
56
|
+
<dynamics damping="0.1" />
|
|
57
|
+
<calibration falling="${-0.5410521 + cal_r_wrist_flex_flag}" />
|
|
58
|
+
<origin xyz="0.321 0 0" rpy="0 0 0" />
|
|
59
|
+
<parent link="${side}_forearm_link"/>
|
|
60
|
+
<child link="${side}_wrist_flex_link"/>
|
|
61
|
+
</joint>
|
|
62
|
+
<link name="${side}_wrist_flex_link">
|
|
63
|
+
|
|
64
|
+
<inertial>
|
|
65
|
+
<mass value="0.61402" />
|
|
66
|
+
<origin xyz="-0.00157 0.0 -0.00075" />
|
|
67
|
+
<inertia ixx="0.00065165722" ixy="0.00000028864" ixz="0.00000303477"
|
|
68
|
+
iyy="0.00019824443" iyz="-0.00000022645"
|
|
69
|
+
izz="0.00064450498" />
|
|
70
|
+
</inertial>
|
|
71
|
+
|
|
72
|
+
<visual>
|
|
73
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
74
|
+
<geometry>
|
|
75
|
+
<mesh filename="package://pr2_description/meshes/forearm_v0/wrist_flex.dae" />
|
|
76
|
+
</geometry>
|
|
77
|
+
|
|
78
|
+
<material name="Grey" />
|
|
79
|
+
</visual>
|
|
80
|
+
|
|
81
|
+
<collision>
|
|
82
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
83
|
+
<geometry>
|
|
84
|
+
<mesh filename="package://pr2_description/meshes/forearm_v0/wrist_flex.stl" />
|
|
85
|
+
</geometry>
|
|
86
|
+
</collision>
|
|
87
|
+
</link>
|
|
88
|
+
|
|
89
|
+
<!-- Wrist roll -->
|
|
90
|
+
<joint name="${side}_wrist_roll_joint" type="continuous">
|
|
91
|
+
<axis xyz="1 0 0" />
|
|
92
|
+
<limit effort="10" velocity="${VELOCITY_LIMIT_SCALE*6}" /> <!-- alpha tested velocity and effort limits -->
|
|
93
|
+
<safety_controller k_velocity="2" />
|
|
94
|
+
<dynamics damping="0.1" />
|
|
95
|
+
<calibration rising="${-M_PI / 2 + cal_r_wrist_roll_flag}" />
|
|
96
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
97
|
+
<parent link="${side}_wrist_flex_link"/>
|
|
98
|
+
<child link="${side}_wrist_roll_link"/>
|
|
99
|
+
</joint>
|
|
100
|
+
<link name="${side}_wrist_roll_link">
|
|
101
|
+
<inertial>
|
|
102
|
+
<!-- dummy masses, to be removed. wrist roll masses are on "gripper_palm" -->
|
|
103
|
+
<mass value="0.1" />
|
|
104
|
+
<origin xyz="0 0 0" />
|
|
105
|
+
<inertia ixx="0.01" ixy="0" ixz="0"
|
|
106
|
+
iyy="0.01" iyz="0"
|
|
107
|
+
izz="0.01" />
|
|
108
|
+
</inertial>
|
|
109
|
+
<visual>
|
|
110
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
111
|
+
<geometry>
|
|
112
|
+
<mesh filename="package://pr2_description/meshes/forearm_v0/wrist_roll.stl" />
|
|
113
|
+
</geometry>
|
|
114
|
+
|
|
115
|
+
<material name="RollLinks" />
|
|
116
|
+
</visual>
|
|
117
|
+
<collision>
|
|
118
|
+
<origin xyz="0 0 0" rpy="0 0 0" />
|
|
119
|
+
<geometry>
|
|
120
|
+
<mesh filename="package://pr2_description/meshes/forearm_v0/wrist_roll_L.stl" />
|
|
121
|
+
</geometry>
|
|
122
|
+
</collision>
|
|
123
|
+
</link>
|
|
124
|
+
<!-- extensions-->
|
|
125
|
+
<xacro:pr2_forearm_gazebo_v0 side="${side}" />
|
|
126
|
+
<xacro:pr2_forearm_transmission_v0 side="${side}" />
|
|
127
|
+
|
|
128
|
+
</xacro:macro>
|
|
129
|
+
|
|
130
|
+
</robot>
|
|
@@ -0,0 +1,24 @@
|
|
|
1
|
+
<?xml version="1.0"?>
|
|
2
|
+
<robot xmlns:xacro="http://ros.org/wiki/xacro">
|
|
3
|
+
|
|
4
|
+
<gazebo>
|
|
5
|
+
<plugin name="gazebo_ros_controller_manager" filename="libgazebo_ros_controller_manager.so">
|
|
6
|
+
<alwaysOn>true</alwaysOn>
|
|
7
|
+
<updateRate>1000.0</updateRate>
|
|
8
|
+
</plugin>
|
|
9
|
+
|
|
10
|
+
<plugin name="gazebo_ros_power_monitor_controller" filename="libgazebo_ros_power_monitor.so">
|
|
11
|
+
<alwaysOn>true</alwaysOn>
|
|
12
|
+
<updateRate>1.0</updateRate>
|
|
13
|
+
<timeout>5</timeout>
|
|
14
|
+
<powerStateTopic>power_state</powerStateTopic>
|
|
15
|
+
<powerStateRate>10.0</powerStateRate>
|
|
16
|
+
<fullChargeCapacity>87.78</fullChargeCapacity>
|
|
17
|
+
<dischargeRate>-474</dischargeRate>
|
|
18
|
+
<chargeRate>525</chargeRate>
|
|
19
|
+
<dischargeVoltage>15.52</dischargeVoltage>
|
|
20
|
+
<chargeVoltage>16.41</chargeVoltage>
|
|
21
|
+
</plugin>
|
|
22
|
+
</gazebo>
|
|
23
|
+
|
|
24
|
+
</robot>
|
|
@@ -0,0 +1,288 @@
|
|
|
1
|
+
<?xml version="1.0"?>
|
|
2
|
+
<robot xmlns:xacro="http://ros.org/wiki/xacro">
|
|
3
|
+
|
|
4
|
+
<xacro:property name="finger_stop_kd" value="1.0" />
|
|
5
|
+
<xacro:property name="finger_stop_kp" value="10000000.0" />
|
|
6
|
+
<xacro:property name="finger_fudge_factor" value="1.0" />
|
|
7
|
+
|
|
8
|
+
<xacro:property name="finger_kp" value="0.0" />
|
|
9
|
+
<xacro:property name="finger_kd" value="0.0" />
|
|
10
|
+
<xacro:property name="finger_fm" value="0.0" />
|
|
11
|
+
|
|
12
|
+
<xacro:property name="finger_tip_kp" value="0.0" />
|
|
13
|
+
<xacro:property name="finger_tip_kd" value="0.0" />
|
|
14
|
+
<xacro:property name="finger_tip_fm" value="0.0" />
|
|
15
|
+
|
|
16
|
+
<xacro:property name="finger_tip_mu" value="500.0" />
|
|
17
|
+
<xacro:property name="finger_mu" value="500.0" />
|
|
18
|
+
|
|
19
|
+
<xacro:property name="parallel_link_x_offset" value="-0.018" />
|
|
20
|
+
<xacro:property name="parallel_link_y_offset" value="0.021" />
|
|
21
|
+
|
|
22
|
+
<xacro:macro name="pr2_finger_gazebo_v0" params="prefix reflect">
|
|
23
|
+
|
|
24
|
+
<!-- Finger proximal digit -->
|
|
25
|
+
|
|
26
|
+
<gazebo reference="${prefix}_l_finger_link">
|
|
27
|
+
<turnGravityOff>true</turnGravityOff>
|
|
28
|
+
<mu1 value="${finger_mu}" />
|
|
29
|
+
<mu2 value="${finger_mu}" />
|
|
30
|
+
<kp value="1000000.0" />
|
|
31
|
+
<kd value="1.0" />
|
|
32
|
+
<!-- for "${prefix}_l_finger_joint"-->
|
|
33
|
+
</gazebo>
|
|
34
|
+
<gazebo reference="${prefix}_l_finger_joint">
|
|
35
|
+
<stopKd value="${finger_stop_kd}" />
|
|
36
|
+
<stopKp value="${finger_stop_kp}" />
|
|
37
|
+
<fudgeFactor value="${finger_fudge_factor}" />
|
|
38
|
+
<provideFeedback value="true"/>
|
|
39
|
+
</gazebo>
|
|
40
|
+
|
|
41
|
+
<!-- Finger proximal digit -->
|
|
42
|
+
|
|
43
|
+
<gazebo reference="${prefix}_r_finger_link">
|
|
44
|
+
<turnGravityOff>true</turnGravityOff>
|
|
45
|
+
<mu1 value="${finger_mu}" />
|
|
46
|
+
<mu2 value="${finger_mu}" />
|
|
47
|
+
<kp value="1000000.0" />
|
|
48
|
+
<kd value="1.0" />
|
|
49
|
+
</gazebo>
|
|
50
|
+
<gazebo reference="${prefix}_r_finger_joint">
|
|
51
|
+
<stopKd value="${finger_stop_kd}" />
|
|
52
|
+
<stopKp value="${finger_stop_kp}" />
|
|
53
|
+
<fudgeFactor value="${finger_fudge_factor}" />
|
|
54
|
+
<provideFeedback value="true"/>
|
|
55
|
+
</gazebo>
|
|
56
|
+
|
|
57
|
+
<!-- Finger tip -->
|
|
58
|
+
|
|
59
|
+
<gazebo reference="${prefix}_l_finger_tip_link">
|
|
60
|
+
<turnGravityOff>true</turnGravityOff>
|
|
61
|
+
<selfCollide>false</selfCollide>
|
|
62
|
+
<sensor type="contact" name="${prefix}_l_finger_tip_contact_sensor">
|
|
63
|
+
<update_rate>100.0</update_rate>
|
|
64
|
+
<contact>
|
|
65
|
+
<collision>${prefix}_l_finger_tip_link_geom</collision>
|
|
66
|
+
</contact>
|
|
67
|
+
<plugin name="${prefix}_l_finger_tip_gazebo_ros_bumper_controller" filename="libgazebo_ros_bumper.so">
|
|
68
|
+
<alwaysOn>true</alwaysOn>
|
|
69
|
+
<frameName>${prefix}_l_finger_tip_link</frameName>
|
|
70
|
+
<updateRate>100.0</updateRate>
|
|
71
|
+
<bumperTopicName>${prefix}_l_finger_tip_bumper</bumperTopicName>
|
|
72
|
+
</plugin>
|
|
73
|
+
</sensor>
|
|
74
|
+
<mu1 value="${finger_tip_mu}" />
|
|
75
|
+
<mu2 value="${finger_tip_mu}" />
|
|
76
|
+
<kp value="10000000.0" />
|
|
77
|
+
<kd value="1.0" />
|
|
78
|
+
</gazebo>
|
|
79
|
+
<gazebo reference="${prefix}_l_finger_tip_joint">
|
|
80
|
+
<stopKd value="${finger_stop_kd}" />
|
|
81
|
+
<stopKp value="${finger_stop_kp}" />
|
|
82
|
+
<fudgeFactor value="${finger_fudge_factor}" />
|
|
83
|
+
<provideFeedback value="true"/>
|
|
84
|
+
</gazebo>
|
|
85
|
+
|
|
86
|
+
<!-- Finger tip -->
|
|
87
|
+
|
|
88
|
+
<gazebo reference="${prefix}_r_finger_tip_link">
|
|
89
|
+
<turnGravityOff>true</turnGravityOff>
|
|
90
|
+
<selfCollide>false</selfCollide>
|
|
91
|
+
<sensor type="contact" name="${prefix}_r_finger_tip_contact_sensor">
|
|
92
|
+
<update_rate>100.0</update_rate>
|
|
93
|
+
<contact>
|
|
94
|
+
<collision>${prefix}_r_finger_tip_link_geom</collision>
|
|
95
|
+
</contact>
|
|
96
|
+
<plugin name="${prefix}_r_finger_tip_gazebo_ros_bumper_controller" filename="libgazebo_ros_bumper.so">
|
|
97
|
+
<alwaysOn>true</alwaysOn>
|
|
98
|
+
<frameName>${prefix}_r_finger_tip_link</frameName>
|
|
99
|
+
<updateRate>100.0</updateRate>
|
|
100
|
+
<bumperTopicName>${prefix}_r_finger_tip_bumper</bumperTopicName>
|
|
101
|
+
</plugin>
|
|
102
|
+
</sensor>
|
|
103
|
+
<mu1 value="${finger_tip_mu}" />
|
|
104
|
+
<mu2 value="${finger_tip_mu}" />
|
|
105
|
+
<kp value="10000000.0" />
|
|
106
|
+
<kd value="1.0" />
|
|
107
|
+
</gazebo>
|
|
108
|
+
<gazebo>
|
|
109
|
+
<plugin name="p3d_${prefix}_l_finger_controller" filename="libgazebo_ros_p3d.so">
|
|
110
|
+
<alwaysOn>true</alwaysOn>
|
|
111
|
+
<updateRate>100.0</updateRate>
|
|
112
|
+
<bodyName>${prefix}_l_finger_link</bodyName>
|
|
113
|
+
<topicName>${prefix}_l_finger_pose_ground_truth</topicName>
|
|
114
|
+
<gaussianNoise>0.0</gaussianNoise>
|
|
115
|
+
<frameName>base_link</frameName>
|
|
116
|
+
</plugin>
|
|
117
|
+
<plugin name="f3d_${prefix}_l_finger_controller" filename="libgazebo_ros_f3d.so">
|
|
118
|
+
<alwaysOn>true</alwaysOn>
|
|
119
|
+
<updateRate>100.0</updateRate>
|
|
120
|
+
<bodyName>${prefix}_l_finger_link</bodyName>
|
|
121
|
+
<topicName>${prefix}_l_finger_force_ground_truth</topicName>
|
|
122
|
+
</plugin>
|
|
123
|
+
</gazebo>
|
|
124
|
+
<gazebo reference="${prefix}_r_finger_tip_joint">
|
|
125
|
+
<stopKd value="${finger_stop_kd}" />
|
|
126
|
+
<stopKp value="${finger_stop_kp}" />
|
|
127
|
+
<fudgeFactor value="${finger_fudge_factor}" />
|
|
128
|
+
<provideFeedback value="true"/>
|
|
129
|
+
</gazebo>
|
|
130
|
+
|
|
131
|
+
<!-- parallel link for simulating gripper constraints -->
|
|
132
|
+
<gazebo>
|
|
133
|
+
<link name="${prefix}_l_parallel_link">
|
|
134
|
+
<inertial>
|
|
135
|
+
<mass>0.17126</mass>
|
|
136
|
+
<inertia>
|
|
137
|
+
<ixx>7.7562e-05</ixx>
|
|
138
|
+
<ixy>1.49095e-06</ixy>
|
|
139
|
+
<ixz>-9.83385e-06</ixz>
|
|
140
|
+
<iyy>0.000197083</iyy>
|
|
141
|
+
<iyz>-3.06125e-06</iyz>
|
|
142
|
+
<izz>0.000181054</izz>
|
|
143
|
+
</inertia>
|
|
144
|
+
<pose>0.03598 0.0173 -0.00164 0 0 0</pose>
|
|
145
|
+
</inertial>
|
|
146
|
+
<pose>0.82991 ${0.188*reflect+0.031} 0.790675 0 -0 0</pose>
|
|
147
|
+
<gravity>false</gravity>
|
|
148
|
+
</link>
|
|
149
|
+
<link name="${prefix}_r_parallel_link">
|
|
150
|
+
<inertial>
|
|
151
|
+
<mass>0.17389</mass>
|
|
152
|
+
<inertia>
|
|
153
|
+
<ixx>7.73841e-05</ixx>
|
|
154
|
+
<ixy>-2.09309e-06</ixy>
|
|
155
|
+
<ixz>-8.36228e-06</ixz>
|
|
156
|
+
<iyy>0.000198474</iyy>
|
|
157
|
+
<iyz>2.4611e-06</iyz>
|
|
158
|
+
<izz>0.00018107</izz>
|
|
159
|
+
</inertia>
|
|
160
|
+
<pose>0.03576 -0.01736 -0.00095 0 0 0</pose>
|
|
161
|
+
</inertial>
|
|
162
|
+
<pose>0.82991 ${0.188*reflect-0.031} 0.790675 0 0 0</pose>
|
|
163
|
+
<gravity>false</gravity>
|
|
164
|
+
</link>
|
|
165
|
+
</gazebo>
|
|
166
|
+
<gazebo>
|
|
167
|
+
<joint type="screw" name="${prefix}_r_screw_screw_joint">
|
|
168
|
+
<child>${prefix}_motor_screw_link</child>
|
|
169
|
+
<parent>${prefix}_r_finger_tip_link</parent>
|
|
170
|
+
<thread_pitch>-3141.6</thread_pitch>
|
|
171
|
+
<axis>
|
|
172
|
+
<xyz>0 1 0</xyz>
|
|
173
|
+
</axis>
|
|
174
|
+
</joint>
|
|
175
|
+
<joint type="screw" name="${prefix}_l_screw_screw_joint">
|
|
176
|
+
<parent>${prefix}_l_finger_tip_link</parent>
|
|
177
|
+
<child>${prefix}_motor_screw_link</child>
|
|
178
|
+
<thread_pitch>3141.6</thread_pitch>
|
|
179
|
+
<axis>
|
|
180
|
+
<xyz>0 1 0</xyz>
|
|
181
|
+
</axis>
|
|
182
|
+
</joint>
|
|
183
|
+
</gazebo>
|
|
184
|
+
|
|
185
|
+
|
|
186
|
+
<gazebo>
|
|
187
|
+
<joint type="revolute" name="${prefix}_r_parallel_root_joint">
|
|
188
|
+
<parent>${prefix}_r_parallel_link</parent>
|
|
189
|
+
<child>${prefix}_palm_link</child>
|
|
190
|
+
<axis>
|
|
191
|
+
<xyz>0 0 -1</xyz>
|
|
192
|
+
<dynamics>
|
|
193
|
+
<damping>0.2</damping>
|
|
194
|
+
</dynamics>
|
|
195
|
+
</axis>
|
|
196
|
+
<pose>${0.07691+parallel_link_x_offset} ${-0.01-parallel_link_y_offset} 0 0 0 0</pose>
|
|
197
|
+
</joint>
|
|
198
|
+
<joint type="revolute" name="${prefix}_l_parallel_root_joint">
|
|
199
|
+
<parent>${prefix}_l_parallel_link</parent>
|
|
200
|
+
<child>${prefix}_palm_link</child>
|
|
201
|
+
<axis>
|
|
202
|
+
<xyz>0 0 1</xyz>
|
|
203
|
+
<dynamics>
|
|
204
|
+
<damping>0.2</damping>
|
|
205
|
+
</dynamics>
|
|
206
|
+
</axis>
|
|
207
|
+
<pose>${0.07691+parallel_link_x_offset} ${0.01+parallel_link_y_offset} 0 0 0 0</pose>
|
|
208
|
+
</joint>
|
|
209
|
+
<joint type="revolute" name="${prefix}_r_parallel_tip_joint">
|
|
210
|
+
<parent>${prefix}_r_parallel_link</parent>
|
|
211
|
+
<child>${prefix}_r_finger_tip_link</child>
|
|
212
|
+
<axis>
|
|
213
|
+
<xyz>0 0 1</xyz>
|
|
214
|
+
</axis>
|
|
215
|
+
<pose>${parallel_link_x_offset} ${-parallel_link_y_offset} 0 0 0 0</pose>
|
|
216
|
+
</joint>
|
|
217
|
+
<joint type="revolute" name="${prefix}_l_parallel_tip_joint">
|
|
218
|
+
<parent>${prefix}_l_parallel_link</parent>
|
|
219
|
+
<child>${prefix}_l_finger_tip_link</child>
|
|
220
|
+
<axis>
|
|
221
|
+
<xyz>0 0 1</xyz>
|
|
222
|
+
</axis>
|
|
223
|
+
<pose>${parallel_link_x_offset} ${parallel_link_y_offset} 0 0 0 0</pose>
|
|
224
|
+
</joint>
|
|
225
|
+
<joint type="prismatic" name="${prefix}_joint">
|
|
226
|
+
<parent>${prefix}_r_finger_tip_link</parent>
|
|
227
|
+
<child>${prefix}_l_finger_tip_link</child>
|
|
228
|
+
<axis>
|
|
229
|
+
<xyz>0 1 0</xyz>
|
|
230
|
+
</axis>
|
|
231
|
+
</joint>
|
|
232
|
+
</gazebo>
|
|
233
|
+
<gazebo reference="${prefix}_motor_slider_link">
|
|
234
|
+
<turnGravityOff>true</turnGravityOff>
|
|
235
|
+
<material value="PR2/Red" />
|
|
236
|
+
</gazebo>
|
|
237
|
+
<gazebo reference="${prefix}_motor_screw_link">
|
|
238
|
+
<turnGravityOff>true</turnGravityOff>
|
|
239
|
+
<material value="PR2/Red" />
|
|
240
|
+
</gazebo>
|
|
241
|
+
<gazebo reference="${prefix}_l_parallel_link">
|
|
242
|
+
<turnGravityOff>true</turnGravityOff>
|
|
243
|
+
<material value="PR2/Red" />
|
|
244
|
+
</gazebo>
|
|
245
|
+
<gazebo reference="${prefix}_r_parallel_link">
|
|
246
|
+
<turnGravityOff>true</turnGravityOff>
|
|
247
|
+
<material value="PR2/Red" />
|
|
248
|
+
</gazebo>
|
|
249
|
+
|
|
250
|
+
</xacro:macro>
|
|
251
|
+
|
|
252
|
+
|
|
253
|
+
|
|
254
|
+
<xacro:macro name="pr2_gripper_gazebo_v0" params="side">
|
|
255
|
+
|
|
256
|
+
<gazebo reference="${side}_gripper_palm_link">
|
|
257
|
+
<turnGravityOff>true</turnGravityOff>
|
|
258
|
+
</gazebo>
|
|
259
|
+
|
|
260
|
+
<gazebo>
|
|
261
|
+
<plugin name="p3d_${side}_gripper_palm_controller" filename="libgazebo_ros_p3d.so">
|
|
262
|
+
<alwaysOn>true</alwaysOn>
|
|
263
|
+
<updateRate>100.0</updateRate>
|
|
264
|
+
<bodyName>${side}_gripper_palm_link</bodyName>
|
|
265
|
+
<topicName>${side}_gripper_palm_pose_ground_truth</topicName>
|
|
266
|
+
<xyzOffsets>0 0 0</xyzOffsets>
|
|
267
|
+
<rpyOffsets>0 0 0</rpyOffsets>
|
|
268
|
+
<gaussianNoise>0.0</gaussianNoise>
|
|
269
|
+
<frameName>map</frameName>
|
|
270
|
+
</plugin>
|
|
271
|
+
|
|
272
|
+
<!-- a formal implementation of grasp hack in gazebo with fixed joint -->
|
|
273
|
+
<gripper name="${side}_grasp_hack">
|
|
274
|
+
<grasp_check>
|
|
275
|
+
<attach_steps>20</attach_steps>
|
|
276
|
+
<detach_steps>40</detach_steps>
|
|
277
|
+
<min_contact_count>2</min_contact_count>
|
|
278
|
+
</grasp_check>
|
|
279
|
+
<gripper_link>${side}_gripper_r_finger_tip_link</gripper_link>
|
|
280
|
+
<gripper_link>${side}_gripper_l_finger_tip_link</gripper_link>
|
|
281
|
+
<palm_link>${side}_gripper_palm_link</palm_link>
|
|
282
|
+
</gripper>
|
|
283
|
+
</gazebo>
|
|
284
|
+
|
|
285
|
+
</xacro:macro>
|
|
286
|
+
|
|
287
|
+
|
|
288
|
+
</robot>
|
|
@@ -0,0 +1,50 @@
|
|
|
1
|
+
<?xml version="1.0"?>
|
|
2
|
+
<robot xmlns:sensor="http://playerstage.sourceforge.net/gazebo/xmlschema/#sensor"
|
|
3
|
+
xmlns:controller="http://playerstage.sourceforge.net/gazebo/xmlschema/#controller"
|
|
4
|
+
xmlns:joint="http://playerstage.sourceforge.net/gazebo/xmlschema/#slider"
|
|
5
|
+
xmlns:interface="http://playerstage.sourceforge.net/gazebo/xmlschema/#interface"
|
|
6
|
+
xmlns:xacro="http://ros.org/wiki/xacro">
|
|
7
|
+
|
|
8
|
+
<xacro:macro name="pr2_gripper_transmission_v0" params="side screw_reduction gear_ratio theta0 phi0 t0 L0 h a b r">
|
|
9
|
+
<!-- [lr]_gripper_joint is a fictitious joint, used by transmission for controller gap -->
|
|
10
|
+
<!-- [lr]_gripper_joint is not attached to any link -->
|
|
11
|
+
<!-- [lr]_gripper_joint position is the gap_size -->
|
|
12
|
+
<!-- [lr]_gripper_joint velocity is the gap linear velocity -->
|
|
13
|
+
<!-- [lr]_gripper_joint effort is the gap linear force -->
|
|
14
|
+
<!-- Please refer to function engineering spreadsheet 090224_link_data.xls for -->
|
|
15
|
+
<!-- the transmission function. -->
|
|
16
|
+
<!-- Please refer to mechanism_model/src/pr2_gripper_transmission.cpp for implementation.-->
|
|
17
|
+
<!-- gazebo_mimic_pid is for sim only. -->
|
|
18
|
+
<transmission type="pr2_mechanism_model/PR2GripperTransmission" name="${side}_gripper_trans" >
|
|
19
|
+
<actuator name="${side}_gripper_motor" />
|
|
20
|
+
<gap_joint name="${side}_gripper_joint"
|
|
21
|
+
mechanical_reduction="1.0"
|
|
22
|
+
screw_reduction="${screw_reduction}"
|
|
23
|
+
gear_ratio="${gear_ratio}"
|
|
24
|
+
theta0="${theta0}"
|
|
25
|
+
phi0="${phi0}"
|
|
26
|
+
t0="${t0}"
|
|
27
|
+
L0="${L0}"
|
|
28
|
+
h="${h}"
|
|
29
|
+
a="${a}"
|
|
30
|
+
b="${b}"
|
|
31
|
+
r="${r}"
|
|
32
|
+
/>
|
|
33
|
+
<!-- if a gazebo joint exists as [l|r]_gripper_joint, use this tag to have
|
|
34
|
+
gripper transmission apply torque directly to prismatic joint
|
|
35
|
+
this should be the default behavior in diamondback, deprecating this flag -->
|
|
36
|
+
<use_simulated_gripper_joint/>
|
|
37
|
+
<!-- set passive joint angles so things look nice in rviz -->
|
|
38
|
+
<passive_joint name="${side}_gripper_l_finger_joint" />
|
|
39
|
+
<passive_joint name="${side}_gripper_r_finger_joint" />
|
|
40
|
+
<passive_joint name="${side}_gripper_r_finger_tip_joint" />
|
|
41
|
+
<passive_joint name="${side}_gripper_l_finger_tip_joint" />
|
|
42
|
+
<!-- screw joint to capture gripper "dynamics" -->
|
|
43
|
+
<simulated_actuated_joint name="${side}_gripper_motor_screw_joint"
|
|
44
|
+
passive_actuated_joint="${side}_gripper_motor_slider_joint"
|
|
45
|
+
simulated_reduction="3141.6" />
|
|
46
|
+
</transmission>
|
|
47
|
+
</xacro:macro>
|
|
48
|
+
|
|
49
|
+
|
|
50
|
+
</robot>
|