本文整理汇总了Python中hpp.gepetto.Viewer.solveAndDisplay方法的典型用法代码示例。如果您正苦于以下问题:Python Viewer.solveAndDisplay方法的具体用法?Python Viewer.solveAndDisplay怎么用?Python Viewer.solveAndDisplay使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类hpp.gepetto.Viewer
的用法示例。
在下文中一共展示了Viewer.solveAndDisplay方法的2个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。
示例1: print
# 需要导入模块: from hpp.gepetto import Viewer [as 别名]
# 或者: from hpp.gepetto.Viewer import solveAndDisplay [as 别名]
q_goal = q_init [::]
q_goal [0:3] = [5,1, 1]
#v (q_goal)
print("chargement map")
v.loadObstacleModel ("iai_maps", "tunnel", "tunnel")
ps.selectPathPlanner("rrtPerso")
print("Debut motion planning")
ps.setInitialConfig (q_init)
ps.addGoalConfig (q_goal)
v.solveAndDisplay(white,0.02,1,yellow)
ps.solve ()
v.displayRoadmap(white,0.02,1,yellow)
v.client.gui.addXYZaxis("test0",white,0.05,1)
v.client.gui.addToGroup("test0",v.sceneName)
pp = PathPlayer (robot.client, v)
#print("affichage solution")
#pp (0)
示例2: v
# 需要导入模块: from hpp.gepetto import Viewer [as 别名]
# 或者: from hpp.gepetto.Viewer import solveAndDisplay [as 别名]
q_init[0:3] = [6, 7, 0.5] #z=0.4 pour sphere
#6 7 pour en dehors de la zone
v (q_init)
q_goal = q_init [::]
q_goal [0:3] = [-2.5, -3.5, 0.5]
#v (q_goal)
print("chargement map")
v.loadObstacleModel ("iai_maps", "room", "room")
ps.setInitialConfig (q_init)
ps.addGoalConfig (q_goal)
ps.selectPathPlanner("rrtPerso")
v.solveAndDisplay(white,0.02,1,brown)
ps.solve ()
v.displayRoadmap(white,0.02,1,brown)
pp = PathPlayer (robot.client, v)
print("affichage solution")
pp (0)
print("affichage solution optimise")
pp (1)