Skip to content

Commit

Permalink
Merge pull request #85 from robotology/devel
Browse files Browse the repository at this point in the history
Devel
  • Loading branch information
traversaro authored Feb 24, 2021
2 parents 4bf86ba + 192c4a1 commit a83139e
Show file tree
Hide file tree
Showing 35 changed files with 112,164 additions and 97,407 deletions.
14 changes: 14 additions & 0 deletions iCub/conf_icub3/gazebo_icub_chest_inertial.ini
Original file line number Diff line number Diff line change
@@ -0,0 +1,14 @@
[include "gazebo_icub_robotname.ini"]

[WRAPPER]
device multipleanalogsensorsserver
name /${gazeboYarpPluginsRobotName}/chest/inertials
period 10

[ADDITIONAL_WRAPPER]
device inertial
name /${gazeboYarpPluginsRobotName}/chest/inertial
period 0.01

[IMU_DRIVER]
device gazebo_imu
73 changes: 73 additions & 0 deletions iCub/conf_icub3/gazebo_icub_head_without_eyes_V2_7.ini
Original file line number Diff line number Diff line change
@@ -0,0 +1,73 @@
[include "gazebo_icub_robotname.ini"]

[WRAPPER]
# name of the wrapper device to be instatiated by the factory
device controlboardwrapper2
# rate of output streaming from ports in ms
period 10
# output port name (a leading '/' will be added by code)
name /${gazeboYarpPluginsRobotName}/head
# Total number of joints
joints 3
# list of MotorControl device to use
networks ( head )
# for each network specify the joint map
head 0 2 0 2
# Verbose output (on if present, off if commented out)
#verbose

[TRAJECTORY_GENERATION]
trajectory_type minimum_jerk

# Specify configuration of MotorControl devices
[head]
# name of the device to be instatiated by the factory
device gazebo_controlboard
#jointNames list
jointNames neck_pitch neck_roll neck_yaw
name head

min_stiffness 0.0 0.0 0.0
max_stiffness 1000.0 1000.0 1000.0
min_damping 0.0 0.0 0.0
max_damping 100.0 100.0 100.0

#PIDs:
# this information is used to set the PID values in simulation for GAZEBO, we need only the first three values
[POSITION_CONTROL]
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
kp 1.745 1.745 1.745
kd 0.122 0.122 0.122
ki 0.003 0.003 0.003
maxInt 9999 9999 9999
maxOutput 9999 9999 9999
shift 0.0 0.0 0.0
ko 0.0 0.0 0.0
stictionUp 0.0 0.0 0.0
stictionDwn 0.0 0.0 0.0

[VELOCITY_CONTROL]
velocityControlImplementationType integrator_and_position_pid
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
kp 8.726 8.726 8.726
kd 0.035 0.035 0.035
ki 0.003 0.003 0.003
maxInt 9999 9999 9999
maxOutput 9999 9999 9999
shift 0.0 0.0 0.0
ko 0.0 0.0 0.0
stictionUp 0.0 0.0 0.0
stictionDwn 0.0 0.0 0.0

[IMPEDANCE_CONTROL]
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
stiffness 0.0 0.0 0.0
damping 0.0 0.0 0.0

[LIMITS]
jntPosMax 17.0 20.0 45.0
jntPosMin -30.0 -20.0 -45.0
jntVelMax 100.0 100.0 100.0
Original file line number Diff line number Diff line change
Expand Up @@ -38,7 +38,7 @@ max_damping 100.0 100.0 100.0 100.0 100.0 100.0 100.0
[POSITION_CONTROL]
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
kp 1.745 1.745 1.745 1.745 1.745 1.745 1.745
kp 5.745 5.745 5.745 1.745 1.745 1.745 1.745
kd 0.174 0.174 0.174 0.174 0.174 0.174 0.0
ki 0.174 0.174 0.174 0.174 0.174 0.174 0.0
maxInt 9999 9999 9999 9999 9999 9999 9999
Expand Down
4 changes: 2 additions & 2 deletions iCub/conf_icub3/gazebo_icub_left_leg.ini
Original file line number Diff line number Diff line change
Expand Up @@ -37,9 +37,9 @@ max_damping 100.0 100.0 100.0 100.0 100.0 100.0
[POSITION_CONTROL]
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
kp 17.453 17.453 17.453 17.453 17.453 17.453
kp 15.453 22.453 17.453 30.00 25.453 25.453
kd 0.174 0.174 0.174 0.174 0.174 0.174
ki 0.174 0.174 0.174 0.174 0.174 0.174
ki 0.174 0.174 0.174 0.174 0.174 5.174
maxInt 9999 9999 9999 9999 9999 9999
maxOutput 9999 9999 9999 9999 9999 9999
shift 0.0 0.0 0.0 0.0 0.0 0.0
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -38,7 +38,7 @@ max_damping 100.0 100.0 100.0 100.0 100.0 100.0 100.0
[POSITION_CONTROL]
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
kp 1.745 1.745 1.745 1.745 1.745 1.745 1.745
kp 5.745 5.745 5.745 1.745 1.745 1.745 1.745
kd 0.174 0.174 0.174 0.174 0.174 0.174 0.0
ki 0.174 0.174 0.174 0.174 0.174 0.174 0.0
maxInt 9999 9999 9999 9999 9999 9999 9999
Expand Down
4 changes: 2 additions & 2 deletions iCub/conf_icub3/gazebo_icub_right_leg.ini
Original file line number Diff line number Diff line change
Expand Up @@ -37,9 +37,9 @@ max_damping 100.0 100.0 100.0 100.0 100.0 100.0
[POSITION_CONTROL]
controlUnits metric_units
controlLaw joint_pid_gazebo_v1
kp 17.453 17.453 17.453 17.453 17.453 17.453
kp 15.453 22.453 17.453 30.00 25.453 25.453
kd 0.174 0.174 0.174 0.174 0.174 0.174
ki 0.174 0.174 0.174 0.174 0.174 0.174
ki 0.174 0.174 0.174 0.174 0.174 5.174
maxInt 9999 9999 9999 9999 9999 9999
maxOutput 9999 9999 9999 9999 9999 9999
shift 0.0 0.0 0.0 0.0 0.0 0.0
Expand Down
2 changes: 1 addition & 1 deletion iCub/conf_icub3/left_camera.ini
Original file line number Diff line number Diff line change
@@ -1,6 +1,6 @@
[include "gazebo_icub_robotname.ini"]

device grabber
device grabberDual
subdevice gazebo_camera
name /${gazeboYarpPluginsRobotName}/cam/left
freq 30
Expand Down
2 changes: 1 addition & 1 deletion iCub/conf_icub3/right_camera.ini
Original file line number Diff line number Diff line change
@@ -1,6 +1,6 @@
[include "gazebo_icub_robotname.ini"]

device grabber
device grabberDual
subdevice gazebo_camera
name /${gazeboYarpPluginsRobotName}/cam/right
freq 30
Expand Down
58 changes: 29 additions & 29 deletions iCub/meshes/simmechanics/sim_head_head_prt.stl
Original file line number Diff line number Diff line change
Expand Up @@ -75270,14 +75270,14 @@ solid SIM_HEAD_HEAD
vertex -1.149074e+01 -6.387703e+01 -9.537486e+00
endloop
endfacet
facet normal -8.924476e-01 2.190228e-15 -4.511512e-01
facet normal -8.924476e-01 1.537021e-15 -4.511512e-01
outer loop
vertex -1.149074e+01 -6.025000e+01 -9.537486e+00
vertex -1.149074e+01 -6.387703e+01 -9.537486e+00
vertex -1.341455e+01 -5.988877e+01 -5.731897e+00
endloop
endfacet
facet normal -6.008755e-01 1.976345e-15 -7.993426e-01
facet normal -6.008755e-01 1.778710e-15 -7.993426e-01
outer loop
vertex -8.519487e+00 -5.985000e+01 -1.177101e+01
vertex -1.149074e+01 -6.387703e+01 -9.537486e+00
Expand Down Expand Up @@ -75312,7 +75312,7 @@ solid SIM_HEAD_HEAD
vertex -1.495896e+01 -6.387703e+01 -4.335415e-01
endloop
endfacet
facet normal -8.747529e-01 2.373201e-16 4.845693e-01
facet normal -8.747529e-01 -6.195085e-16 4.845693e-01
outer loop
vertex -1.186476e+01 -6.025000e+01 9.171627e+00
vertex -1.406480e+01 -6.387703e+01 5.200077e+00
Expand All @@ -75333,7 +75333,7 @@ solid SIM_HEAD_HEAD
vertex -9.184891e+00 -6.387703e+01 1.187266e+01
endloop
endfacet
facet normal -6.322250e-01 3.794545e-16 7.747848e-01
facet normal -6.322250e-01 -2.398158e-16 7.747848e-01
outer loop
vertex -1.186476e+01 -6.025000e+01 9.171627e+00
vertex -1.186476e+01 -6.387703e+01 9.171627e+00
Expand Down Expand Up @@ -75564,28 +75564,28 @@ solid SIM_HEAD_HEAD
vertex -9.254707e+00 -5.985000e+01 -6.646269e+00
endloop
endfacet
facet normal 1.565685e-15 1.000000e+00 2.246205e-16
facet normal 7.685667e-16 1.000000e+00 1.496756e-15
outer loop
vertex -4.355579e+00 -5.985000e+01 -9.161915e+00
vertex -8.519487e+00 -5.985000e+01 -1.177101e+01
vertex -9.254707e+00 -5.985000e+01 -6.646269e+00
endloop
endfacet
facet normal 4.214210e-14 -1.000000e+00 5.127430e-15
facet normal 0.000000e+00 -1.000000e+00 0.000000e+00
outer loop
vertex -1.000353e+01 -5.985000e+01 -1.877537e+00
vertex -9.254707e+00 -5.985000e+01 -6.646269e+00
vertex -1.017208e+01 -5.985000e+01 -4.922089e-01
endloop
endfacet
facet normal 2.409746e-15 1.000000e+00 1.868398e-15
facet normal 0.000000e+00 1.000000e+00 0.000000e+00
outer loop
vertex -4.355579e+00 -5.985000e+01 -9.161915e+00
vertex -9.254707e+00 -5.985000e+01 -6.646269e+00
vertex -1.000353e+01 -5.985000e+01 -1.877537e+00
endloop
endfacet
facet normal -6.326528e-01 1.153895e-15 -7.744355e-01
facet normal -6.326528e-01 9.989727e-16 -7.744355e-01
outer loop
vertex -6.468591e+00 -6.025000e+01 -1.344644e+01
vertex -6.468591e+00 -6.387703e+01 -1.344644e+01
Expand All @@ -75599,7 +75599,7 @@ solid SIM_HEAD_HEAD
vertex -8.519487e+00 -5.985000e+01 -1.177101e+01
endloop
endfacet
facet normal 4.108949e-16 1.000000e+00 2.067570e-15
facet normal 1.403519e-15 1.000000e+00 4.834247e-16
outer loop
vertex -4.355579e+00 -5.985000e+01 -9.161915e+00
vertex -3.084902e+00 -5.985000e+01 -1.285105e+01
Expand Down Expand Up @@ -75746,7 +75746,7 @@ solid SIM_HEAD_HEAD
vertex 1.012259e+01 -5.985000e+01 -1.106432e+00
endloop
endfacet
facet normal -2.786909e-15 -1.000000e+00 2.633151e-16
facet normal -4.180364e-15 -1.000000e+00 3.949726e-16
outer loop
vertex 4.258407e+00 -5.985000e+01 -9.203567e+00
vertex 1.012259e+01 -5.985000e+01 -1.106432e+00
Expand Down Expand Up @@ -75774,7 +75774,7 @@ solid SIM_HEAD_HEAD
vertex 1.017718e+01 -5.985000e+01 -5.286492e-01
endloop
endfacet
facet normal 1.599822e-15 1.000000e+00 9.202322e-16
facet normal 1.580637e-15 1.000000e+00 2.084594e-15
outer loop
vertex 9.254707e+00 -5.985000e+01 -6.646269e+00
vertex 1.017718e+01 -5.985000e+01 -5.286492e-01
Expand All @@ -75788,7 +75788,7 @@ solid SIM_HEAD_HEAD
vertex 1.017718e+01 -5.985000e+01 -5.286492e-01
endloop
endfacet
facet normal 8.968742e-16 1.000000e+00 1.026230e-15
facet normal 2.526701e-16 1.000000e+00 2.284838e-15
outer loop
vertex 4.258407e+00 -5.985000e+01 -9.203567e+00
vertex 1.017718e+01 -5.985000e+01 -5.286492e-01
Expand Down Expand Up @@ -75858,7 +75858,7 @@ solid SIM_HEAD_HEAD
vertex 9.201405e+00 -6.387703e+01 1.188975e+01
endloop
endfacet
facet normal 1.011438e-15 6.811720e-01 -7.321234e-01
facet normal 5.057190e-16 6.811720e-01 -7.321234e-01
outer loop
vertex 8.830222e-01 -5.318111e+01 1.817284e+01
vertex 3.084902e+00 -5.985000e+01 1.196807e+01
Expand Down Expand Up @@ -80072,28 +80072,28 @@ solid SIM_HEAD_HEAD
vertex 3.192264e+00 -6.188398e+01 -1.108670e+02
endloop
endfacet
facet normal -2.967456e-01 9.353888e-16 -9.549566e-01
facet normal -2.967456e-01 1.325781e-15 -9.549566e-01
outer loop
vertex -2.266963e+00 -6.025000e+01 -1.475206e+01
vertex -2.266963e+00 -6.387703e+01 -1.475206e+01
vertex -6.468591e+00 -6.387703e+01 -1.344644e+01
endloop
endfacet
facet normal -2.967456e-01 8.348448e-16 -9.549566e-01
facet normal -2.967456e-01 7.235322e-16 -9.549566e-01
outer loop
vertex -2.266963e+00 -6.025000e+01 -1.475206e+01
vertex -6.468591e+00 -6.387703e+01 -1.344644e+01
vertex -6.468591e+00 -6.025000e+01 -1.344644e+01
endloop
endfacet
facet normal -4.644213e-03 9.794182e-16 -9.999892e-01
facet normal -4.644213e-03 1.949612e-15 -9.999892e-01
outer loop
vertex 2.295913e+00 -6.025000e+01 -1.477325e+01
vertex -2.266963e+00 -6.387703e+01 -1.475206e+01
vertex -2.266963e+00 -6.025000e+01 -1.475206e+01
endloop
endfacet
facet normal -4.644213e-03 9.857537e-16 -9.999892e-01
facet normal -4.644213e-03 4.971416e-16 -9.999892e-01
outer loop
vertex 2.295913e+00 -6.025000e+01 -1.477325e+01
vertex 2.295913e+00 -6.387703e+01 -1.477325e+01
Expand Down Expand Up @@ -80338,21 +80338,21 @@ solid SIM_HEAD_HEAD
vertex -3.084902e+00 -5.985000e+01 -1.285105e+01
endloop
endfacet
facet normal 3.677316e-15 9.785719e-01 -2.059052e-01
facet normal 1.185649e-16 9.785719e-01 -2.059052e-01
outer loop
vertex 3.084902e+00 -5.985000e+01 -1.285105e+01
vertex -2.266963e+00 -6.025000e+01 -1.475206e+01
vertex -3.084902e+00 -5.985000e+01 -1.285105e+01
endloop
endfacet
facet normal 3.454936e-15 1.000000e+00 -1.111557e-15
facet normal -1.121724e-30 1.000000e+00 1.948037e-15
outer loop
vertex 4.258407e+00 -5.985000e+01 -9.203567e+00
vertex 3.084902e+00 -5.985000e+01 -1.285105e+01
vertex -3.084902e+00 -5.985000e+01 -1.285105e+01
endloop
endfacet
facet normal 1.661823e-15 1.000000e+00 2.498437e-15
facet normal 8.262472e-16 1.000000e+00 2.845906e-16
outer loop
vertex -4.355579e+00 -5.985000e+01 -9.161915e+00
vertex 4.258407e+00 -5.985000e+01 -9.203567e+00
Expand All @@ -80366,7 +80366,7 @@ solid SIM_HEAD_HEAD
vertex 3.084902e+00 -5.985000e+01 -1.285105e+01
endloop
endfacet
facet normal 1.405457e-15 1.000000e+00 -4.521779e-16
facet normal 9.980424e-16 1.000000e+00 1.626937e-15
outer loop
vertex 4.258407e+00 -5.985000e+01 -9.203567e+00
vertex 8.480678e+00 -5.985000e+01 -1.179371e+01
Expand All @@ -80380,7 +80380,7 @@ solid SIM_HEAD_HEAD
vertex 8.480678e+00 -5.985000e+01 -1.179371e+01
endloop
endfacet
facet normal 1.540721e-15 1.000000e+00 -2.316807e-16
facet normal 7.752766e-16 1.000000e+00 1.263800e-15
outer loop
vertex 4.258407e+00 -5.985000e+01 -9.203567e+00
vertex 9.254707e+00 -5.985000e+01 -6.646269e+00
Expand Down Expand Up @@ -80415,7 +80415,7 @@ solid SIM_HEAD_HEAD
vertex 8.480678e+00 -5.985000e+01 -1.179371e+01
endloop
endfacet
facet normal 6.277595e-01 9.161813e-16 -7.784074e-01
facet normal 6.277595e-01 1.156012e-15 -7.784074e-01
outer loop
vertex 6.287995e+00 -6.025000e+01 -1.356204e+01
vertex 8.480678e+00 -5.985000e+01 -1.179371e+01
Expand Down Expand Up @@ -84531,14 +84531,14 @@ solid SIM_HEAD_HEAD
vertex 9.747294e+00 -6.207414e+01 -1.106548e+02
endloop
endfacet
facet normal 2.903347e-01 5.282865e-16 -9.569252e-01
facet normal 2.903347e-01 0.000000e+00 -9.569252e-01
outer loop
vertex 6.287995e+00 -6.025000e+01 -1.356204e+01
vertex 2.295913e+00 -6.387703e+01 -1.477325e+01
vertex 2.295913e+00 -6.025000e+01 -1.477325e+01
endloop
endfacet
facet normal 2.903347e-01 1.008413e-15 -9.569252e-01
facet normal 2.903347e-01 2.423053e-16 -9.569252e-01
outer loop
vertex 6.287995e+00 -6.025000e+01 -1.356204e+01
vertex 6.287995e+00 -6.387703e+01 -1.356204e+01
Expand Down Expand Up @@ -88948,7 +88948,7 @@ solid SIM_HEAD_HEAD
vertex 2.776412e+01 -6.387703e+01 -4.865000e+01
endloop
endfacet
facet normal 6.738782e-01 -1.149188e-15 -7.388425e-01
facet normal 6.738782e-01 -8.191528e-16 -7.388425e-01
outer loop
vertex 1.138725e+01 -6.025000e+01 -9.679486e+00
vertex 1.138725e+01 -6.387703e+01 -9.679486e+00
Expand Down Expand Up @@ -89088,7 +89088,7 @@ solid SIM_HEAD_HEAD
vertex 9.414981e+00 -5.922602e+01 -1.095465e+02
endloop
endfacet
facet normal 7.138384e-01 -6.992113e-16 7.003105e-01
facet normal 7.138384e-01 -6.859606e-16 7.003105e-01
outer loop
vertex 1.197509e+01 -6.025000e+01 9.062485e+00
vertex 9.201405e+00 -6.387703e+01 1.188975e+01
Expand Down Expand Up @@ -94072,14 +94072,14 @@ solid SIM_HEAD_HEAD
vertex 1.138725e+01 -6.387703e+01 -9.679486e+00
endloop
endfacet
facet normal 8.890083e-01 -2.504797e-16 -4.578911e-01
facet normal 8.890083e-01 1.849163e-16 -4.578911e-01
outer loop
vertex 1.138725e+01 -6.025000e+01 -9.679486e+00
vertex 1.338495e+01 -5.988932e+01 -5.800895e+00
vertex 1.138725e+01 -6.387703e+01 -9.679486e+00
endloop
endfacet
facet normal 8.753061e-01 -8.573704e-16 4.835693e-01
facet normal 8.753061e-01 -4.736606e-16 4.835693e-01
outer loop
vertex 1.197509e+01 -6.025000e+01 9.062485e+00
vertex 1.197509e+01 -6.387703e+01 9.062485e+00
Expand Down
Loading

0 comments on commit a83139e

Please sign in to comment.