def dynamicalModelTest(self): w = World() add_human36(w) w.update_dynamic() self.assertEqual(w.mass[5,5], 73.000000000000014) self.assertEqual(w.mass[41, 41], 0.10208399155688053) # neck self.assertEqual(w.mass[40,40], 0.020356790291165189) # neck self.assertEqual(w.mass[39, 39], 0.10430013572386694) # neck self.assertEqual(w.mass[16, 16], 0.0093741757009949949) # foot self.assertEqual(w.mass[17, 17], 0.001397215796713388) # foot self.assertEqual(w.mass[10, 10], 0.0093741757009949949) # foot self.assertEqual(w.mass[11, 11], 0.001397215796713388) # foot
#!/urs/bin/python #coding=utf-8 #author=joseph salini #date=24 jan 2010 from arboris.core import World, simulate, NamedObjectsList from numpy import array, arange import os ######################################################## ## WORLD BUILDING ######################################################## w = World() from arboris.robots import human36 human36.add_human36(w) w.update_dynamic() ######################################################## ## INIT ######################################################## joints = w.getjoints() bodies = w.getbodies() frames = w.getframes() shapes = w.getshapes() joints[0].gpos[0:3,3] = array([.1, .2, .3])
#!/urs/bin/python #coding=utf-8 #author=joseph salini #date=24 jan 2010 from arboris.core import World, simulate, NamedObjectsList from numpy import array, arange import os ######################################################## ## WORLD BUILDING ######################################################## w = World() from arboris.robots import human36 human36.add_human36(w) w.update_dynamic() ######################################################## ## INIT ######################################################## joints = w.getjoints() bodies = w.getbodies() frames = w.getframes() shapes = w.getshapes() joints[0].gpos[0:3, 3] = array([.1, .2, .3]) w.update_dynamic()