Skip to content
Snippets Groups Projects

Compare revisions

Changes are shown as if the source revision was being merged into the target revision. Learn more about comparing revisions.

Source

Select target project
No results found

Target

Select target project
  • lscherrer/sot-talos-balance
  • imaroger/sot-talos-balance
  • pfernbac/sot-talos-balance
  • ostasse/sot-talos-balance
  • gsaurel/sot-talos-balance
  • loco-3d/sot-talos-balance
6 results
Show changes
Showing
with 1185 additions and 894 deletions
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
This diff is collapsed.
[tool.black]
exclude = "cmake"
This diff is collapsed.
This diff is collapsed.
from math import sqrt
import numpy as np
kp_force = 6*(0.0,)
ki_force = 6*(0.0,)
kp_vel = 32*(0.0,)
ki_vel = 32*(0.0,)
force_integral_saturation = (0.0, 0.0, 160.0, 20.0, 20.0, 0.0)
force_integral_deadzone = (5.0, 5.0, 5.0, 0.5, 0.5, 0.5)
This diff is collapsed.
from balance_ctrl_conf import *
# CONTROLLER GAINS
kp_posture = NJ*(400.0,);
kd_posture = NJ*(sqrt(kp_posture[0]),);
kd_constr = 0.0*2*sqrt(kp_constr); # constraint derivative feedback gain
kd_com = 0.0*2*sqrt(kp_com);
kd_feet = 0.0*2*sqrt(kp_feet);
''' *********************** USER-PARAMETERS OF BASE ESTIMATOR *********************** '''
# K = (4034, 23770, 239018, 707, 502, 936); #HRP2
# K = (1., 1., 1., 1., 1., 1.);
K = (1e6, 1e6, 1e6, 1e6, 1e6, 1e6);
std_dev_zmp = 0.02
std_dev_fz = 50.
normal_force_margin = 30.
zmp_margin = 0.002
w_imu = 0.0;
beta = 0.00329
K_fb_feet_poses = 0.0; # gain used for updating foot positions
RIGHT_FOOT_SIZES = (0.130, -0.100, 0.056, -0.075); # pos x, neg x, pos y, neg y size
LEFT_FOOT_SIZES = (0.130, -0.100, 0.075, -0.056); # pos x, neg x, pos y, neg y size
w_lf_in = 1.
w_rf_in = 1.
#mu = 0.3; # force friction coefficient