rviz-viewer.py
Go to the documentation of this file.
1 # NOTE: this example needs RViz to be installed
2 # usage: start ROS master (roscore) and then run this test
3 
4 import pinocchio as pin
5 from os.path import dirname, join, abspath
6 
7 from pinocchio.visualize import RVizVisualizer
8 
9 # Load the URDF model.
10 # Conversion with str seems to be necessary when executing this file with ipython
11 pinocchio_model_dir = join(dirname(dirname(str(abspath(__file__)))), "models")
12 
13 model_path = join(pinocchio_model_dir, "example-robot-data/robots")
14 mesh_dir = pinocchio_model_dir
15 urdf_filename = "talos_reduced.urdf"
16 urdf_model_path = join(join(model_path, "talos_data/robots"), urdf_filename)
17 
18 model, collision_model, visual_model = pin.buildModelsFromUrdf(
19  urdf_model_path, mesh_dir, pin.JointModelFreeFlyer()
20 )
21 viz = RVizVisualizer(model, collision_model, visual_model)
22 
23 # Initialize the viewer.
24 viz.initViewer()
25 viz.loadViewerModel("pinocchio")
26 
27 # Display a robot configuration.
28 q0 = pin.neutral(model)
29 viz.display(q0)
30 
31 # Display another robot.
32 viz2 = RVizVisualizer(model, collision_model, visual_model)
33 viz2.initViewer(viz.viewer)
34 viz2.loadViewerModel(rootNodeName="pinocchio2")
35 q = q0.copy()
36 q[1] = 1.0
37 viz2.display(q)
38 
39 input("Press enter to exit...")
40 
41 viz.clean()
sample-model-viewer.input
input
Definition: sample-model-viewer.py:8
pinocchio.visualize
Definition: bindings/python/pinocchio/visualize/__init__.py:1
pinocchio.visualize.rviz_visualizer.RVizVisualizer
Definition: rviz_visualizer.py:57
path


pinocchio
Author(s):
autogenerated on Sun Jun 16 2024 02:43:12