talos-simulation Namespace Reference

Functions
def	squashing (model, data, q_in)

Variables
list	constraint_datas = [cm.createData() for cm in constraint_models]
	constraint_dim = sum([cm.size() for cm in constraint_models])
list	constraint_models = []
	contact_model_lf1
	data = robot.data
int	eps = 1e-10
list	foot_frame_ids = [robot.model.getFrameId(frame_name) for frame_name in foot_frames]
list	foot_frames = [lfFoot, rfFoot, lhFoot, rhFoot]
list	foot_joint_ids
	gui = robot.viewer.gui
	joint2_placement
	kkt_constraint = pinocchio.ContactCholeskyDecomposition(model, constraint_models)
	lfFoot
	lhFoot
	mass = data.mass[0]
	model = robot.model
int	mu = 1e-8
int	N = 100000
	q = robot.q0.copy()
	q0
def	q_new = squashing(model, data, robot.q0)
	q_sol = q.copy()
	rfFoot
	rhFoot
	robot = example_robot_data.load("talos")
string	state_name = "half_sitting"
	window_id = robot.viewer.gui.getWindowID("python-pinocchio")

Function Documentation

squashing()

def talos-simulation.squashing	(		model,
			data,
			q_in
	)

Definition at line 93 of file talos-simulation.py.

Variable Documentation

constraint_datas

list talos-simulation.constraint_datas = [cm.createData() for cm in constraint_models]

Definition at line 74 of file talos-simulation.py.

constraint_dim

talos-simulation.constraint_dim = sum([cm.size() for cm in constraint_models])

Definition at line 80 of file talos-simulation.py.

constraint_models

list talos-simulation.constraint_models = []

Definition at line 34 of file talos-simulation.py.

contact_model_lf1

talos-simulation.contact_model_lf1

Initial value:

=  pinocchio.RigidConstraintModel(
        pinocchio.ContactType.CONTACT_6D,
        robot.model,
        foot_joint_ids[j],
        robot.model.frames[frame_id].placement,
        0,
        data.oMf[frame_id],
    )

Definition at line 37 of file talos-simulation.py.

data

talos-simulation.data = robot.data

Definition at line 10 of file talos-simulation.py.

eps

int talos-simulation.eps = 1e-10

Definition at line 82 of file talos-simulation.py.

foot_frame_ids

list talos-simulation.foot_frame_ids = [robot.model.getFrameId(frame_name) for frame_name in foot_frames]

Definition at line 26 of file talos-simulation.py.

foot_frames

list talos-simulation.foot_frames = [lfFoot, rfFoot, lhFoot, rhFoot]

Definition at line 25 of file talos-simulation.py.

foot_joint_ids

list talos-simulation.foot_joint_ids

Initial value:

=  [
    robot.model.frames[robot.model.getFrameId(frame_name)].parent
    for frame_name in foot_frames
]

Definition at line 27 of file talos-simulation.py.

gui

talos-simulation.gui = robot.viewer.gui

Definition at line 60 of file talos-simulation.py.

joint2_placement

talos-simulation.joint2_placement

Definition at line 48 of file talos-simulation.py.

kkt_constraint

talos-simulation.kkt_constraint = pinocchio.ContactCholeskyDecomposition(model, constraint_models)

Definition at line 79 of file talos-simulation.py.

lfFoot

talos-simulation.lfFoot

Definition at line 18 of file talos-simulation.py.

lhFoot

talos-simulation.lhFoot

Definition at line 18 of file talos-simulation.py.

mass

talos-simulation.mass = data.mass[0]

Definition at line 90 of file talos-simulation.py.

model

talos-simulation.model = robot.model

Definition at line 9 of file talos-simulation.py.

mu

int talos-simulation.mu = 1e-8

Definition at line 83 of file talos-simulation.py.

N

int talos-simulation.N = 100000

Definition at line 81 of file talos-simulation.py.

q

talos-simulation.q = robot.q0.copy()

Definition at line 76 of file talos-simulation.py.

q0

talos-simulation.q0

Definition at line 14 of file talos-simulation.py.

q_new

def talos-simulation.q_new = squashing(model, data, robot.q0)

Definition at line 157 of file talos-simulation.py.

q_sol

talos-simulation.q_sol = q.copy()

Definition at line 85 of file talos-simulation.py.

rfFoot

talos-simulation.rfFoot

Definition at line 18 of file talos-simulation.py.

rhFoot

talos-simulation.rhFoot

Definition at line 18 of file talos-simulation.py.

robot

talos-simulation.robot = example_robot_data.load("talos")

Definition at line 8 of file talos-simulation.py.

state_name

string talos-simulation.state_name = "half_sitting"

Definition at line 12 of file talos-simulation.py.

window_id

talos-simulation.window_id = robot.viewer.gui.getWindowID("python-pinocchio")

Definition at line 62 of file talos-simulation.py.