dartpy 6.16.5__cp313-cp313-manylinux_2_27_x86_64.manylinux_2_28_x86_64.whl

dartpy-6.16.5.dist-info/METADATA

@@ -0,0 +1,146 @@
+Metadata-Version: 2.4
+Name: dartpy
+Version: 6.16.5
+Summary: Python API of Dynamic Animation and Robotics Toolkit.
+Home-page: https://github.com/dartsim/dart.git
+Author: Jeongseok Lee
+Author-email: jslee02@gmail.com
+License: BSD 2-Clause
+Keywords: dartsim robotics
+Classifier: Development Status :: 2 - Pre-Alpha
+Classifier: Framework :: Robot Framework
+Classifier: Intended Audience :: Science/Research
+Classifier: License :: OSI Approved :: BSD License
+Classifier: Topic :: Scientific/Engineering
+Classifier: Operating System :: Microsoft :: Windows
+Classifier: Operating System :: MacOS
+Classifier: Operating System :: POSIX :: Linux
+Requires-Python: >=3.7
+Description-Content-Type: text/markdown
+License-File: LICENSE
+Requires-Dist: numpy
+Provides-Extra: test
+Requires-Dist: pytest>=6.0; extra == "test"
+Dynamic: author
+Dynamic: author-email
+Dynamic: classifier
+Dynamic: description
+Dynamic: description-content-type
+Dynamic: home-page
+Dynamic: keywords
+Dynamic: license
+Dynamic: license-file
+Dynamic: provides-extra
+Dynamic: requires-dist
+Dynamic: requires-python
+Dynamic: summary
+
+# DART
+
+<br>
+<p align="center">
+  <img src="https://raw.githubusercontent.com/dartsim/dart/master/docs/dart_logo_377x107.jpg" alt="DART: Dynamic Animation and Robotics Toolkit">
+</p>
+
+DART (Dynamic Animation and Robotics Toolkit) is an open-source library that
+provides data structures and algorithms for kinematic and dynamic applications
+in robotics and computer animation. Renowned for its accuracy and stability,
+DART utilizes generalized coordinates to represent articulated rigid body
+systems and employs Featherstone's Articulated Body Algorithm to compute motion
+dynamics.
+
+## Getting Started
+
+DART provides both C++ and Python interfaces, which can be installed using
+various package managers. For cross-platform compatibility, we recommend using
+Conda or Pixi.
+
+### C++
+
+#### Cross-Platform (Recommended)
+
+Conda:
+
+```shell
+conda install -c conda-forge dartsim-cpp
+```
+
+Pixi:
+
+```shell
+pixi add dartsim-cpp
+```
+
+#### Linux
+
+Ubuntu:
+
+```shell
+sudo apt install libdart-all-dev
+```
+
+Arch Linux:
+
+```shell
+yay -S libdart
+```
+
+FreeBSD:
+
+```shell
+pkg install dartsim
+```
+
+#### macOS (Homebrew)
+
+```shell
+brew install dartsim
+```
+
+#### Windows (Vcpkg)
+
+```shell
+vcpkg install dartsim:x64-windows
+```
+
+### Python
+
+For the Python interface, we recommend using Conda or Pixi. Note that the PyPI
+package is being deprecated to reduce maintenance—contributions are welcome!
+
+Conda:
+
+```shell
+conda install -c conda-forge dartpy
+```
+
+Pixi:
+
+```shell
+pixi add dartpy
+```
+
+PyPI (deprecated):
+
+```shell
+pip install dartpy
+```
+
+## Documentation
+
+For more information on DART, please visit the DART documentation: [English](https://dart.readthedocs.io/) | [한국어](https://dart-ko.readthedocs.io/) (WIP)
+
+An overview of DART is also available on [DeepWiki](https://deepwiki.com/dartsim/dart).
+
+## Project Status
+
+| Item                  | Status |
+| --------------------- | ------ |
+| Build                 | [![CI Ubuntu](https://github.com/dartsim/dart/actions/workflows/ci_ubuntu.yml/badge.svg)](https://github.com/dartsim/dart/actions/workflows/ci_ubuntu.yml) [![CI macOS](https://github.com/dartsim/dart/actions/workflows/ci_macos.yml/badge.svg)](https://github.com/dartsim/dart/actions/workflows/ci_macos.yml) [![CI Windows](https://github.com/dartsim/dart/actions/workflows/ci_windows.yml/badge.svg)](https://github.com/dartsim/dart/actions/workflows/ci_windows.yml) |
+| Doc, Coverage, Linter | [![API Documentation](https://github.com/dartsim/dart/actions/workflows/api_doc.yml/badge.svg)](https://github.com/dartsim/dart/actions/workflows/api_doc.yml)  [![Documentation Status](https://readthedocs.org/projects/dart/badge/?version=latest)](https://dart.readthedocs.io/en/latest/?badge=latest) [![codecov](https://codecov.io/gh/dartsim/dart/branch/main/graph/badge.svg)](https://codecov.io/gh/dartsim/dart)   [![Codacy Badge](https://app.codacy.com/project/badge/Grade/2d95a9b951be4b73a71097670ec351e8)](https://www.codacy.com/gh/dartsim/dart/dashboard?utm_source=github.com&amp;utm_medium=referral&amp;utm_content=dartsim/dart&amp;utm_campaign=Badge_Grade) |
+| Packages              | [![Packaging status](https://repology.org/badge/vertical-allrepos/dart-sim.svg)](https://repology.org/project/dart-sim/versions) [![Anaconda-Server Badge](https://anaconda.org/conda-forge/dartsim/badges/version.svg)](https://anaconda.org/conda-forge/dartsim) [![PyPI Version](https://img.shields.io/pypi/v/dartpy)](https://pypi.org/project/dartpy/) |
+| Maintenance           | [![Average time to resolve an issue](http://isitmaintained.com/badge/resolution/dartsim/dart.svg)](http://isitmaintained.com/project/dartsim/dart "Average time to resolve an issue") [![Percentage of issues still open](http://isitmaintained.com/badge/open/dartsim/dart.svg)](http://isitmaintained.com/project/dartsim/dart "Percentage of issues still open") |
+
+## Citation
+
+If you use DART in an academic publication, please consider citing this [JOSS Paper](https://doi.org/10.21105/joss.00500) [[BibTeX](https://gist.github.com/jslee02/998b8809e3ae1b7aef6ef04dd2ad5e27)]

dartpy-6.16.5.dist-info/RECORD

@@ -0,0 +1,64 @@
+dartpy.cpython-313-x86_64-linux-gnu.so,sha256=OTgyGC_cXMKNohF1HOvjmqMVffuQATgu6UdiNN3Xs9Y,16634585
+dartpy.libs/libGLU-ff1477cc.so.1.3.1,sha256=BGOW9YiNDomfWCJJH2rKOuL4T6HRsibrN3JsfbJdZbc,506529
+dartpy.libs/libOpenThreads-40f1b21a.so.3.3.1,sha256=5XTb9_ZN88CRLyaVE5j1qV5yjIgsvs2BQj1elGOZ_Xc,55873
+dartpy.libs/libXi-9178a6bd.so.6.1.0,sha256=d7hu2oSLjfb-sHACSGBU4z13CnBF0RP11fwKXIw6qdY,76633
+dartpy.libs/libXxf86vm-8446c95f.so.1.0.0,sha256=qLhK_XFE5RAwCLqEmtHH3Y_-5PjYy9H2Ihvm3fTSJE4,25777
+dartpy.libs/libassimp-6dbf32af.so.5.4.3,sha256=QPIZoW9l7GKAm0PzvBqOY-9msy4e1i8u5vdhGYDf-h0,14026641
+dartpy.libs/libccd-252352d2.so.2.0,sha256=X_z9C2Q_PIRXJPZrrUOxL5HKrMIM67o7llZTEfHjQpM,49945
+dartpy.libs/libconsole_bridge-74a7293d.so.1.0,sha256=clcatrhQCAgpHo1GxPdW2JuCprqzLiqWvRUzKBOQSdk,35337
+dartpy.libs/libfcl-e62f87aa.so.0.7.0,sha256=zUCe91Kvi5SQyD209TzEP5CMz50NiP0LHeVJHNQ7qs8,14943025
+dartpy.libs/libglut-a761335e.so.3.10.0,sha256=I7zh1lntjQxOksji062y6rx1O0-E3PXhbgvBOxarax8,373457
+dartpy.libs/liboctomap-f33cbde0.so.1.10.0,sha256=WxUQrA6cuiExgSleXVjePJ8T_LRvmYQnidB_gkSze_Y,595265
+dartpy.libs/liboctomath-f45b7699.so.1.10.0,sha256=Bmvrm5guWBLHQwB4LcntbTpucx_INeZOymTA_G0WKq4,44329
+dartpy.libs/libosg-918cf1aa.so.3.7.0,sha256=iqd3ChAifBquYmG6xMFjuXK4MLmY_H-YLqr643CDn1o,5504105
+dartpy.libs/libosgDB-d5a653a6.so.3.7.0,sha256=cWe_1ay4QQn5N-uVVBxhFPk8ht1OLxNqXiMXijXoOrw,2204817
+dartpy.libs/libosgGA-92a7c57e.so.3.7.0,sha256=hC7eQXhXOHcwsVOZkIHaExI_Wu1eKJS35Eb9MC20_H8,1239097
+dartpy.libs/libosgManipulator-f07690ad.so.3.7.0,sha256=rvg4NmxD1BeJ-4PWuC3ldwv2y27QM3vqgGVd7sFrWLE,512873
+dartpy.libs/libosgShadow-2d57b09e.so.3.7.0,sha256=84LumZMS74wvzLIpIcqE-Eiw-Pd4PhwzKT8c5QOXZoE,938713
+dartpy.libs/libosgText-b23e4e3d.so.3.7.0,sha256=-pse8TGRfogRHnoUt3VQHgKPxzbmDcy0zCrQTz0SwYQ,646641
+dartpy.libs/libosgUtil-5431abc7.so.3.7.0,sha256=qHQwTpvTZxPD-ZnOrwJkpgsKmAIOBlVCEOzOH798tro,2980609
+dartpy.libs/libosgViewer-6e464f80.so.3.7.0,sha256=oUf9MdUJz9EaPweVnasY5vJChfPPBWosZWJj_S38V8w,1755065
+dartpy.libs/liburdfdom_model-c401d788.so.4.0,sha256=oiELxNxAnH2hdJrQm6yFa2P4ZPfHR7xf0Z_RoFwEuc4,357609
+dartpy.libs/liburdfdom_model_state-9c22f9db.so.4.0,sha256=uoN91CKisAmSzSxl2L-TZeEC74f90qvyjO_tcY0LuZ4,197841
+dartpy.libs/liburdfdom_sensor-ef1de772.so.4.0,sha256=H8Ig53s_ri_5tXB9DWir8sYLCOB7U1P6cWGN4cSVgBE,55705
+dartpy.libs/liburdfdom_world-cc923b78.so.4.0,sha256=G_1xNSQ_pLky_H-dqkbHmdG4fHDVPFxMVAdLLSgriDk,357609
+tests/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/util.py,sha256=Yy24PPwQfjBe-qsWxA8FApawuWHDpKKPGJD1eAzUAJo,472
+tests/integration/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/integration/test_joint_force_torque.py,sha256=7taMgLk2d1rdGZhYw7G2OZK822TuxylKzrI5rF4MYqc,10246
+tests/unit/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/collision/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/collision/test_collision.py,sha256=snHrpbht3tIm9dOlNoaGr7FTRH6uDCJzsYizieNHChg,7551
+tests/unit/common/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/common/test_logging.py,sha256=Fggqt5BI1CW2zmcZ_4pbwgZ73gmuuToFZaJ7-gU-gac,415
+tests/unit/common/test_stopwatch.py,sha256=QVUK7BHPHbatPQU0b_LRowFRAmtyzC84ld_Nv80YS9c,1230
+tests/unit/common/test_string.py,sha256=qkW39bDG_d1BG4GJHFcwkDAkJOazu3ap51RvxpkkKNU,1515
+tests/unit/common/test_uri.py,sha256=eZJZj8MQplyTogNAsZJwBkb9mrjnuvLz0BLxD_UvVrw,745
+tests/unit/constraint/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/constraint/test_constraint.py,sha256=-CTSY8Aeyhwxvqnw3GtroUt6_RYfwgD7v_cU0ZeQZtA,1361
+tests/unit/dynamics/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/dynamics/test_aspect.py,sha256=IUTexMqGy_3qxrJGUteGXLmKsU4I2tRuuI-AYu34j90,380
+tests/unit/dynamics/test_body_node.py,sha256=QBz453qGtzlzC56a4118jtrJ4h-I_eU4U00VSRF9sO8,2132
+tests/unit/dynamics/test_inertia.py,sha256=SdAT2KNQ3fW27x8pgq13T9dXyQIcZ1CEvH8b1A55acg,2202
+tests/unit/dynamics/test_inverse_kinematics.py,sha256=xghfdaUs1VUTUfWaciA5mneHCDJnu_Hm5dvGH3hZ6KA,2700
+tests/unit/dynamics/test_joint.py,sha256=8S5ujxUVvuIjiAa4iNPGBOg4aNBvyGnPLR4Uewuvp1A,4439
+tests/unit/dynamics/test_meta_skeleton.py,sha256=TAVYQEPOhUKacjgGo926Z6hBucFU0NHnVLsIiq1FdhA,1058
+tests/unit/dynamics/test_simple_frame.py,sha256=IKVXgckdy9OfZ8T1F51WR2mgQpmdRLhd1KemlGIgivk,1937
+tests/unit/dynamics/test_skeleton.py,sha256=gJoT3CvYX1eXfXdHT2m5Yth15DFG6VlnNuK0iZLLwz4,525
+tests/unit/math/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/math/test_random.py,sha256=GgA8UR0Q_9IE4fr46nmvAeugtXSNLUZ0_V8CrOo7f0I,788
+tests/unit/optimizer/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/optimizer/test_optimizer.py,sha256=CyEdYosTjyjzZZfO_KRUJJ2ZE-6I6xub7Wc7AHpb1SE,2491
+tests/unit/simulation/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/simulation/test_world.py,sha256=YhAyLATFmp7EaPKha9vBSyzxMk_UhHaLHdIf7WWEIl8,1317
+tests/unit/utils/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
+tests/unit/utils/test_dart_loader.py,sha256=gvJFiZmSak_82DtjurKUhWhvd5w-liZGtmxvZQuOnxs,2216
+tests/unit/utils/test_mjcf_parser.py,sha256=IUekER9GvMf_3H89Uy85vINdfYGvkyIYC6y7Gk4TnOM,338
+tests/unit/utils/test_sdf_parser.py,sha256=hHUQbo6IkyAtKyOprkjEYhUW0Ked9_7YiINedVSU_sk,465
+tests/unit/utils/test_skel_parser.py,sha256=AlZJ9_bL6ynfqUROK4UHPsHGYBzFLCqL-xl9KnwPGsI,550
+dartpy-6.16.5.dist-info/METADATA,sha256=WHrB4JU7jU0tuCT6uu50hAae9fmBzdNwa8-TUXFNyaI,5124
+dartpy-6.16.5.dist-info/WHEEL,sha256=bcNxuezh3cUsuVGxaomPMuC1AJzl68d75GNJI4GyHpg,153
+dartpy-6.16.5.dist-info/top_level.txt,sha256=uS54APWVBb-a3RHZ0OUaZMgYA3_YFTZ-6m_1uYJFlls,18
+dartpy-6.16.5.dist-info/RECORD,,
+dartpy-6.16.5.dist-info/licenses/LICENSE,sha256=LcwntAgtV7ppDmVvgqFClYONBGCg1sReCTwCqQp-npk,1740
+dartpy-6.16.5.dist-info/sboms/auditwheel.cdx.json,sha256=NerWP0MZpkfHjZRWrLFMIcOaFS2lkIPPQY7xck4wtkE,2762

dartpy-6.16.5.dist-info/WHEEL

@@ -0,0 +1,6 @@
+Wheel-Version: 1.0
+Generator: setuptools (80.10.1)
+Root-Is-Purelib: false
+Tag: cp313-cp313-manylinux_2_27_x86_64
+Tag: cp313-cp313-manylinux_2_28_x86_64
+

dartpy-6.16.5.dist-info/licenses/LICENSE

@@ -0,0 +1,31 @@
+BSD 2-Clause License
+
+Copyright (c) 2011-2016, Humanoid Lab, Georgia Tech Research Corporation
+Copyright (c) 2016-2017, Personal Robotics Lab, Carnegie Mellon University
+Copyright (c) 2011-2019, Graphics Lab, Georgia Tech Research Corporation
+Copyright (c) 2017-2019, Personal Robotics Lab, University of Washington
+Copyright (c) 2017-2019, Open Source Robotics Foundation
+Copyright (c) 2019-2024, The Movement Lab, Stanford University
+Copyright (c) 2019-2025, Jeongseok Lee
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+
+* Redistributions of source code must retain the above copyright notice, this
+  list of conditions and the following disclaimer.
+
+* Redistributions in binary form must reproduce the above copyright notice,
+  this list of conditions and the following disclaimer in the documentation
+  and/or other materials provided with the distribution.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

dartpy-6.16.5.dist-info/sboms/auditwheel.cdx.json

@@ -0,0 +1 @@
+{"bomFormat": "CycloneDX", "specVersion": "1.4", "version": 1, "metadata": {"component": {"type": "library", "bom-ref": "pkg:pypi/dartpy@6.16.5?file_name=dartpy-6.16.5-cp313-cp313-manylinux_2_27_x86_64.manylinux_2_28_x86_64.whl", "name": "dartpy", "version": "6.16.5", "purl": "pkg:pypi/dartpy@6.16.5?file_name=dartpy-6.16.5-cp313-cp313-manylinux_2_27_x86_64.manylinux_2_28_x86_64.whl"}, "tools": [{"name": "auditwheel", "version": "6.6.0"}]}, "components": [{"type": "library", "bom-ref": "pkg:pypi/dartpy@6.16.5?file_name=dartpy-6.16.5-cp313-cp313-manylinux_2_27_x86_64.manylinux_2_28_x86_64.whl", "name": "dartpy", "version": "6.16.5", "purl": "pkg:pypi/dartpy@6.16.5?file_name=dartpy-6.16.5-cp313-cp313-manylinux_2_27_x86_64.manylinux_2_28_x86_64.whl"}, {"type": "library", "bom-ref": "pkg:rpm/almalinux/mesa-libGLU@9.0.0-15.el8#ae695714a639f13cc22e61484aa0acb772e9d44ce2541675f63920c8f4c5c035", "name": "mesa-libGLU", "version": "9.0.0-15.el8", "purl": "pkg:rpm/almalinux/mesa-libGLU@9.0.0-15.el8"}, {"type": "library", "bom-ref": "pkg:rpm/almalinux/libXxf86vm@1.1.4-9.el8#9208a17911eaf2939c86558cf3acc7ccf58a30315e6e94ebe22741d6fd7e07eb", "name": "libXxf86vm", "version": "1.1.4-9.el8", "purl": "pkg:rpm/almalinux/libXxf86vm@1.1.4-9.el8"}, {"type": "library", "bom-ref": "pkg:rpm/almalinux/freeglut@3.0.0-9.el8#3a2946991d5a7b938e06786497cecaf675a491cbbc47c3d2b89684a9d010a970", "name": "freeglut", "version": "3.0.0-9.el8", "purl": "pkg:rpm/almalinux/freeglut@3.0.0-9.el8"}, {"type": "library", "bom-ref": "pkg:rpm/almalinux/libXi@1.7.10-1.el8#65fc716d38d0bd8ad193d063ce6351a2b30a74e69ab15efa7cc8042cf18d205a", "name": "libXi", "version": "1.7.10-1.el8", "purl": "pkg:rpm/almalinux/libXi@1.7.10-1.el8"}], "dependencies": [{"ref": "pkg:pypi/dartpy@6.16.5?file_name=dartpy-6.16.5-cp313-cp313-manylinux_2_27_x86_64.manylinux_2_28_x86_64.whl", "dependsOn": ["pkg:rpm/almalinux/mesa-libGLU@9.0.0-15.el8#ae695714a639f13cc22e61484aa0acb772e9d44ce2541675f63920c8f4c5c035", "pkg:rpm/almalinux/libXxf86vm@1.1.4-9.el8#9208a17911eaf2939c86558cf3acc7ccf58a30315e6e94ebe22741d6fd7e07eb", "pkg:rpm/almalinux/freeglut@3.0.0-9.el8#3a2946991d5a7b938e06786497cecaf675a491cbbc47c3d2b89684a9d010a970", "pkg:rpm/almalinux/libXi@1.7.10-1.el8#65fc716d38d0bd8ad193d063ce6351a2b30a74e69ab15efa7cc8042cf18d205a"]}, {"ref": "pkg:rpm/almalinux/mesa-libGLU@9.0.0-15.el8#ae695714a639f13cc22e61484aa0acb772e9d44ce2541675f63920c8f4c5c035"}, {"ref": "pkg:rpm/almalinux/libXxf86vm@1.1.4-9.el8#9208a17911eaf2939c86558cf3acc7ccf58a30315e6e94ebe22741d6fd7e07eb"}, {"ref": "pkg:rpm/almalinux/freeglut@3.0.0-9.el8#3a2946991d5a7b938e06786497cecaf675a491cbbc47c3d2b89684a9d010a970"}, {"ref": "pkg:rpm/almalinux/libXi@1.7.10-1.el8#65fc716d38d0bd8ad193d063ce6351a2b30a74e69ab15efa7cc8042cf18d205a"}]}

dartpy-6.16.5.dist-info/top_level.txt

@@ -0,0 +1,2 @@
+dartpy_math
+tests

tests/integration/test_joint_force_torque.py

@@ -0,0 +1,305 @@
+import math
+
+import dartpy as dart
+import numpy as np
+import pytest
+
+
+def read_world(uri: dart.common.Uri):
+    options = dart.utils.SdfParser.Options()
+    options.mDefaultRootJointType = dart.utils.SdfParser.RootJointType.FIXED
+    world = dart.utils.SdfParser.readWorld(uri, options)
+    for i in range(world.getNumSkeletons()):
+        skel = world.getSkeleton(i)
+        for j in range(skel.getNumJoints()):
+            joint = skel.getJoint(j)
+            joint.setLimitEnforcement(True)
+    return world
+
+
+def test_static():
+    # Load world
+    world = read_world("dart://sample/sdf/test/force_torque_test.world")
+    assert world is not None
+    assert world.getNumSkeletons() == 1
+
+    # Check if the world is correctly loaded
+    model_1 = world.getSkeleton(0)
+    assert model_1 is not None
+    assert model_1.getName() == "model_1"
+    assert model_1.getNumBodyNodes() == 2
+    assert model_1.getNumJoints() == 2
+
+    world.setGravity([0, 0, -50])
+
+    # Simulate 1 step
+    world.step()
+    t = world.getTime()
+
+    # Get time step size
+    dt = world.getTimeStep()
+    assert dt > 0
+    assert t == pytest.approx(dt)
+
+    # Get joint and get force torque
+    link_1 = model_1.getBodyNode("link_1")
+    assert link_1 is not None
+    link_2 = model_1.getBodyNode("link_2")
+    assert link_2 is not None
+    joint_01 = model_1.getJoint("joint_01")
+    assert joint_01 is not None
+    joint_12 = model_1.getJoint("joint_12")
+    assert joint_12 is not None
+
+    tf = dart.math.Isometry3()
+
+    # Run 10 steps
+    for _ in range(10):
+        world.step()
+
+        # ----------------------
+        # Test joint_01 wrench
+        # ----------------------
+
+        # Reference adjustment for the difference of the joint frame conventions
+        # between Gazebo and DART
+        tf.set_identity()
+        tf.set_translation(joint_01.getTransformFromParentBodyNode().translation())
+        parent_frame01 = dart.dynamics.SimpleFrame(
+            dart.dynamics.Frame.World(), "parent_frame01", tf
+        )
+        tf.set_identity()
+        tf.set_translation(joint_01.getTransformFromChildBodyNode().translation())
+        child_frame01 = dart.dynamics.SimpleFrame(link_1, "child_frame01", tf)
+
+        parent_f01 = joint_01.getWrenchToParentBodyNode(parent_frame01)
+        assert (parent_f01 == [0, 0, 0, 0, 0, 1000]).all()
+
+        child_f01 = joint_01.getWrenchToChildBodyNode(child_frame01)
+        assert (child_f01 == -parent_f01).all()
+
+        # ----------------------
+        # Test joint_12 wrench
+        # ----------------------
+
+        # Reference adjustment for the difference of the joint frame conventions
+        # between Gazebo and DART
+        tf.set_identity()
+        tf.set_translation(joint_12.getTransformFromParentBodyNode().translation())
+        parent_frame12 = dart.dynamics.SimpleFrame(link_1, "parent_frame12", tf)
+        tf.set_identity()
+        tf.set_translation(joint_12.getTransformFromChildBodyNode().translation())
+        child_frame12 = dart.dynamics.SimpleFrame(link_2, "child_frame12", tf)
+
+        parent_f12 = joint_12.getWrenchToParentBodyNode(parent_frame12)
+        assert (parent_f12 == [0, 0, 0, 0, 0, 500]).all()
+
+        child_f12 = joint_12.getWrenchToChildBodyNode(child_frame12)
+        assert (child_f12 == -parent_f12).all()
+
+
+def test_force_torque_at_joint_limits():
+    # Load world
+    world = read_world("dart://sample/sdf/test/force_torque_test.world")
+    assert world is not None
+    assert world.getNumSkeletons() == 1
+
+    # Check if the world is correctly loaded
+    model_1 = world.getSkeleton(0)
+    assert model_1 is not None
+    assert model_1.getName() == "model_1"
+    assert model_1.getNumBodyNodes() == 2
+    assert model_1.getNumJoints() == 2
+
+    world.setGravity([0, 0, -50])
+
+    # Simulate 1 step
+    world.step()
+    t = world.getTime()
+
+    # Get time step size
+    dt = world.getTimeStep()
+    assert dt > 0
+    assert t == pytest.approx(dt)
+
+    # Get joint and get force torque
+    link_1 = model_1.getBodyNode("link_1")
+    assert link_1 is not None
+    link_2 = model_1.getBodyNode("link_2")
+    assert link_2 is not None
+    joint_01 = model_1.getJoint("joint_01")
+    assert joint_01 is not None
+    joint_12 = model_1.getJoint("joint_12")
+    assert joint_12 is not None
+
+    # Change gravity so that the top link topples over, then remeasure
+    world.setGravity([-30, 10, -50])
+
+    # Wait for dynamics to be stabilized
+    for i in range(2000):
+        world.step()
+
+    tf = dart.math.Isometry3()
+
+    # Run 5 steps
+    for _ in range(5):
+        world.step()
+
+        # ----------------------
+        # Test joint_01 wrench
+        # ----------------------
+
+        # Reference adjustment for the difference of the joint frame conventions
+        # between Gazebo and DART
+        tf.set_identity()
+        tf.set_translation(joint_01.getTransformFromParentBodyNode().translation())
+        parent_frame01 = dart.dynamics.SimpleFrame(
+            dart.dynamics.Frame.World(), "parent_frame01", tf
+        )
+        tf.set_identity()
+        tf.set_translation(joint_01.getTransformFromChildBodyNode().translation())
+        child_frame01 = dart.dynamics.SimpleFrame(link_1, "child_frame01", tf)
+
+        parent_f01 = joint_01.getWrenchToParentBodyNode(parent_frame01)
+        assert np.isclose(
+            parent_f01, [750, 0, -450, 600, -200, 1000], rtol=0.1, atol=4.5
+        ).all()
+
+        child_f01 = joint_01.getWrenchToChildBodyNode(child_frame01)
+        assert np.isclose(
+            child_f01, [-750, -450, 0, -600, 1000, 200], rtol=0.1, atol=4.5
+        ).all()
+
+        # ----------------------
+        # Test joint_12 wrench
+        # ----------------------
+
+        # Reference adjustment for the difference of the joint frame conventions
+        # between Gazebo and DART
+        tf.set_identity()
+        tf.set_translation(joint_12.getTransformFromParentBodyNode().translation())
+        parent_frame12 = dart.dynamics.SimpleFrame(link_1, "parent_frame12", tf)
+        tf.set_identity()
+        tf.set_translation(joint_12.getTransformFromChildBodyNode().translation())
+        child_frame12 = dart.dynamics.SimpleFrame(link_2, "child_frame12", tf)
+
+        parent_f12 = joint_12.getWrenchToParentBodyNode(parent_frame12)
+        assert np.isclose(
+            parent_f12, [250, 150, 0, 300, -500, -100], rtol=0.1, atol=0.1
+        ).all()
+
+        child_f12 = joint_12.getWrenchToChildBodyNode(child_frame12)
+        assert np.isclose(
+            child_f12, [-250, -150, 0, -300, 500, 100], rtol=0.1, atol=0.1
+        ).all()
+
+
+def test_force_torque_at_joint_limits_with_external_forces():
+    # Load world
+    world = read_world("dart://sample/sdf/test/force_torque_test2.world")
+    assert world is not None
+    assert world.getNumSkeletons() == 1
+
+    # Check if the world is correctly loaded
+    model_1 = world.getSkeleton(0)
+    assert model_1 is not None
+    assert model_1.getName() == "boxes"
+    assert model_1.getNumBodyNodes() == 3
+    assert model_1.getNumJoints() == 3
+    assert model_1.getNumDofs() == 2
+
+    # The first joint is fixed joint
+    assert model_1.getRootJoint().getType() == dart.dynamics.WeldJoint.getStaticType()
+
+    world.setGravity([0, 0, -50])
+
+    # Simulate 1 step
+    world.step()
+    t = world.getTime()
+
+    # Get time step size
+    dt = world.getTimeStep()
+    assert dt > 0
+    assert t == pytest.approx(dt)
+
+    # Get joint and get force torque
+    link_1 = model_1.getBodyNode("link1")
+    assert link_1 is not None
+    link_2 = model_1.getBodyNode("link2")
+    assert link_2 is not None
+    link_3 = model_1.getBodyNode("link3")
+    assert link_3 is not None
+    joint_12 = model_1.getJoint("joint1")
+    assert joint_12 is not None
+    joint_23 = model_1.getJoint("joint2")
+    assert joint_23 is not None
+
+    tf = dart.math.Isometry3()
+
+    # Run 45005 steps
+    kp1 = 5e4
+    kp2 = 1e4
+    target1 = 0
+    target2 = -0.25 * math.pi
+    steps = 4500
+    for _ in range(steps):
+        # PD control
+        j1_state = joint_12.getPosition(0)
+        j2_state = joint_23.getPosition(0)
+        p1_error = target1 - j1_state
+        p2_error = target2 - j2_state
+        effort1 = kp1 * p1_error
+        effort2 = kp2 * p2_error
+        joint_12.setForce(0, effort1)
+        joint_23.setForce(0, effort2)
+
+        world.step()
+
+    assert joint_12.getPosition(0) == pytest.approx(target1, abs=1e-1)
+    assert joint_23.getPosition(0) == pytest.approx(target2, abs=1e-1)
+
+    tol = 2
+
+    # ----------------------
+    # Test joint_12 wrench
+    # ----------------------
+
+    # Reference adjustment for the difference of the joint frame conventions
+    # between Gazebo and DART
+    tf.set_identity()
+    tf.set_translation(joint_12.getTransformFromParentBodyNode().translation())
+    parent_frame01 = dart.dynamics.SimpleFrame(link_1, "parent_frame01", tf)
+    tf.set_identity()
+    tf.set_translation(joint_12.getTransformFromChildBodyNode().translation())
+    child_frame01 = dart.dynamics.SimpleFrame(link_2, "child_frame01", tf)
+
+    parent_f01 = joint_12.getWrenchToParentBodyNode(parent_frame01)
+    assert np.isclose(parent_f01, [25, -175, 0, 0, 0, 300], rtol=0.01, atol=tol).all()
+
+    child_f01 = joint_12.getWrenchToChildBodyNode(child_frame01)
+    assert np.isclose(child_f01, [-25, 175, 0, 0, 0, -300], rtol=0.01, atol=tol).all()
+
+    # ----------------------
+    # Test joint_23 wrench
+    # ----------------------
+
+    # Reference adjustment for the difference of the joint frame conventions
+    # between Gazebo and DART
+    tf.set_identity()
+    tf.set_translation(joint_23.getTransformFromParentBodyNode().translation())
+    parent_frame12 = dart.dynamics.SimpleFrame(link_2, "parent_frame12", tf)
+    tf.set_identity()
+    tf.set_translation(joint_23.getTransformFromChildBodyNode().translation())
+    child_frame12 = dart.dynamics.SimpleFrame(link_3, "child_frame12", tf)
+
+    parent_f12 = joint_23.getWrenchToParentBodyNode(parent_frame12)
+    assert np.isclose(parent_f12, [25, 0, 0, 0, 0, 50], rtol=0.01, atol=tol).all()
+
+    child_f12 = joint_23.getWrenchToChildBodyNode(child_frame12)
+    assert np.isclose(
+        child_f12, [-17.678, 0, 17.679, -35.355, 0, -35.355], rtol=0.01, atol=tol
+    ).all()
+
+
+if __name__ == "__main__":
+    pytest.main()