Debian Codegraph @

python/examples/rigid_chain/main.py

raw
1 import numpy as np
2 import dartpy as dart
3
4
5 class MyWorldNode(dart.gui.osg.RealTimeWorldNode):
6 def __init__(self, world):
7 super(MyWorldNode, self).__init__(world)
8
9 def customPreStep(self):
10 pass
11
12
13 def main():
14 world = dart.utils.SkelParser.readWorld("dart://sample/skel/chain.skel")
15 world.setGravity([0, -9.81, 0])
16
17 chain = world.getSkeleton(0)
18 dof = chain.getNumDofs()
19
20 # Set initial pose
21 init_pose = np.zeros(dof)
22 for i in range(dof):
23 init_pose[i] = dart.math.Random.uniform(-0.5, 0.5)
24 chain.setPositions(init_pose)
25
26 # Set joint dampings
27 for i in range(chain.getNumJoints()):
28 joint = chain.getJoint(i)
29 for j in range(joint.getNumDofs()):
30 joint.setDampingCoefficient(j, 0.01)
31
32 node = MyWorldNode(world)
33
34 viewer = dart.gui.osg.Viewer()
35 viewer.addWorldNode(node)
36
37 # Grid settings
38 grid = dart.gui.osg.GridVisual()
39 grid.setPlaneType(dart.gui.osg.GridVisual.PlaneType.ZX)
40 grid.setOffset([0, -0.55, 0])
41 viewer.addAttachment(grid)
42
43 viewer.setUpViewInWindow(0, 0, 640, 480)
44 viewer.setCameraHomePosition([0.8, 0.0, 0.8], [0, -0.25, 0], [0, 0.5, 0])
45 viewer.run()
46
47
48 if __name__== "__main__":
49 main()