Skip to content
Snippets Groups Projects
Commit 421c787c authored by Francois Keith's avatar Francois Keith Committed by Florent Lamiraux florent@laas.fr
Browse files

Update the kine_romeo sample.

The solver has been moved in sot-application.
parent 71b0eb4d
No related branches found
Tags v2.8
1 merge request!1[major][cpp] starting point to integrate pinocchio
......@@ -29,8 +29,7 @@ from dynamic_graph.ros import *
ros = Ros(robot)
# Create a simple kinematic solver.
from dynamic_graph.sot.dynamics.solver import Solver
solver = Solver(robot)
from dynamic_graph.sot.application.velocity.precomputed_tasks import initialize
# Alternate visualization tool
from dynamic_graph.sot.core.utils.viewer_helper import addRobotViewer
......@@ -63,11 +62,10 @@ taskRH.feature.frame('desired')
# robot.tasks['right-wrist'].add(taskRH.feature.name)
# --- STATIC COM (if not walking)
robot.createCenterOfMassFeatureAndTask(
'featureCom', 'featureComDef', 'comTask',
selec = '011',
gain = 10)
# create the com task and feature tasks.
solver = initialize(robot)
# remove the tasks from the sot (they've been automatically added by previous method).
solver.sot.clear()
# --- CONTACTS
# define contactLF and contactRF
......@@ -91,7 +89,8 @@ gotoNd(taskRH,target,'111',(4.9,0.9,0.01,0.9))
# Fill the stack with some tasks.
solver.push(contactRF.task)
solver.push(contactLF.task)
solver.push(robot.comTask)
solver.push (robot.tasks ['com'])
solver.push(taskRH.task)
# type inc to run one iteration, or go to run indefinitely.
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment