Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Devel ergo cub sn002 #682

Closed
wants to merge 7 commits into from
Closed
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
8 changes: 4 additions & 4 deletions ergoCubSN002/calibrators/left_arm-calib.xml
Original file line number Diff line number Diff line change
Expand Up @@ -17,11 +17,11 @@
</group>
<group name="CALIBRATION">
<param name="calibrationType"> 10 10 10 10 12 12 12 12 14 12 14 14 14 </param>
<param name="calibration1"> 4000 -3000 -3000 4000 11385 11761 7561 0 300 0 300 300 300 </param>
<param name="calibration1"> 4000 -3000 -3000 4000 11385 11761 7561 0 300 0 300 300 300 </param>
<param name="calibration2"> 0 0 0 0 0 0 0 0 0 0 0 0 0 </param>
<param name="calibration3"> 0 0 0 0 0 0 0 0 0 0 0 0 1 </param>
<param name="calibration4"> 0 0 0 0 0 0 0 0 0 0 0 0 0 </param>
<param name="calibration5"> 0 0 0 0 0 0 0 0 49961 0 22173 46002 14200 </param>
<param name="calibration4"> 0 0 0 0 0 0 0 0 32768 0 0 0 32768 </param>
<param name="calibration5"> 0 0 0 0 0 0 0 0 50800 0 22173 46002 14200 </param>
<param name="calibrationZero"> 35 -15 -52 -5 0 0 0 0 0 0 0 0 0 </param>
<param name="calibrationDelta"> 0 0 0 0 0 0 0 0 0 0 0 0 0 </param>
<param name="startupPosition"> 34 50 -10 90 0.0 0.0 0.0 0.0 5.0 5.0 5.0 5.0 5.0 </param>
Expand All @@ -31,7 +31,7 @@
</group>

<!-- <param name="CALIB_ORDER"> (4 5 6) (3) (2) (0) (1) (7 8) (9) (10 11 12) </param> --> <!-- Don't remove this line -->
<param name="CALIB_ORDER"> (4 5 6) (3) (2) (0) (1) (7 8) (9) (10 11 12) </param>
<param name="CALIB_ORDER"> (4 5 6) (3) (2) (0) (1) (7 8) (10 11 12) </param>

<action phase="startup" level="10" type="calibrate">
<param name="target">left_arm-mc_remapper</param>
Expand Down
6 changes: 3 additions & 3 deletions ergoCubSN002/calibrators/right_arm-calib.xml
Original file line number Diff line number Diff line change
Expand Up @@ -18,11 +18,11 @@
</group>
<group name="CALIBRATION">
<param name="calibrationType"> 10 10 10 10 12 12 12 12 14 12 14 14 14 </param>
<param name="calibration1"> -4000 3000 3000 -4000 4617 8371 2523 0 300 0 300 300 300 </param>
<param name="calibration1"> -4000 3000 3000 -4000 4617 8371 2523 0 300 0 300 300 300 </param>
<param name="calibration2"> 0 0 0 0 0 0 0 0 0 0 0 0 0 </param>
<param name="calibration3"> 0 0 0 0 0 0 0 0 0 0 1 0 0 </param>
<param name="calibration4"> 0 0 0 0 0 0 0 0 0 0 0 0 0 </param>
<param name="calibration5"> 0 0 0 0 0 0 0 0 15700 0 51500 37150 16511 </param>
<param name="calibration5"> 0 0 0 0 0 0 0 0 16800 0 51500 37150 16511 </param>
<param name="calibrationZero"> 35 -15 -52 -5 0 0 0 0 0 0 0 0 0 </param>
<param name="calibrationDelta"> 0 0 0 0 0 0 0 0 0 0 0 0 0 </param>
<param name="startupPosition"> 34 50 -10 90 0.0 0.0 0.0 0.0 5.0 5.0 5.0 5.0 5.0 </param>
Expand All @@ -32,7 +32,7 @@
</group>

<!-- <param name="CALIB_ORDER"> (4 5 6) (3) (2) (0) (1) (7 8) (9) (10 11 12) </param> --> <!-- Don't remove this line -->
<param name="CALIB_ORDER"> (4 5 6) (3) (2) (0) (1) (7 8) (9) (10 11 12) </param>
<param name="CALIB_ORDER"> (4 5 6) (3) (2) (0) (1) (7 8) (10 11 12) </param>


<action phase="startup" level="10" type="calibrate">
Expand Down
9 changes: 9 additions & 0 deletions ergoCubSN002/extra/scripts/additionalCommands.sh
Original file line number Diff line number Diff line change
Expand Up @@ -40,6 +40,12 @@ test-microphone() {
arecord -vvv -f dat /dev/null
}

alias trigger-click='DISPLAY=:0 xdotool click 1'

alias list-windows='DISPLAY=:0 wmctrl -lp'

alias close-window='DISPLAY=:0 wmctrl -c'

GREEN='\033[0;32m'
NC='\033[0m' # No Color
## Alias for displaying info messages about the other aliases
Expand All @@ -50,6 +56,9 @@ ${GREEN}configurationSourceInstallDiff${NC} Performs a diff between the source a
${GREEN}connectToJoypad${NC} To reconnect the bluetooth connection of the robot joypad.
${GREEN}test-speaker${NC} Test if the speaker is working.
${GREEN}test-microphone${NC} Test if the micorphone is working.
${GREEN}trigger-click${NC} Emulates a mouse click to make banners disappear on the ergoCub screen.
${GREEN}list-windows${NC} List the open windows. The first output is the window ID. The third value is the ID of the process owning the window.
${GREEN}close-window${NC} Close a window given the Window ID.
${GREEN}dcmFolder${NC} Go to the robot walking configuration files.
${GREEN}goToBuildSuperbuild${NC} Go to the corresponding build folder of the robotology superbuild."'

Expand Down
29 changes: 29 additions & 0 deletions ergoCubSN002/extra/skinGuiConf/left_hand_V2_2.ini
Original file line number Diff line number Diff line change
@@ -0,0 +1,29 @@
cardid 2
#CanDeviceName cfw2can
#CanDeviceNum 7
robotPart left_hand
width 1000
height 1000
xpos 32
ypos 32

#placements are
#
# 1 2
# 0 3
#
# 10
# 4 8
# 9
# 11

# x y th gain leftright LayoutNum

[SENSORS]
fakePalm 8 -30.0 0.0 0.0 4.0 0 0
fingertip3L 4 20.0 30.0 -30.0 4.0 0 0
fingertip3L 3 -5.0 40.0 -15.0 4.0 0 0
fingertip3L 2 -30.0 40.0 15.0 4.0 0 0
fingertip3L 1 -55.0 30.0 30.0 4.0 0 0
fingertip3L 0 -40.0 -40.0 90.0 4.0 0 0

29 changes: 29 additions & 0 deletions ergoCubSN002/extra/skinGuiConf/right_hand_V2_2.ini
Original file line number Diff line number Diff line change
@@ -0,0 +1,29 @@
cardid 2
#CanDeviceName cfw2can
#CanDeviceNum 7
robotPart left_hand
width 1000
height 1000
xpos 32
ypos 32

#placements are
#
# 1 2
# 0 3
#
# 10
# 4 8
# 9
# 11

# x y th gain leftright LayoutNum

[SENSORS]
fakePalm 8 -30.0 0.0 0.0 4.0 0 0
fingertip3L 4 -20.0 30.0 30.0 4.0 0 0
fingertip3L 3 5.0 40.0 15.0 4.0 0 0
fingertip3L 2 30.0 40.0 -15.0 4.0 0 0
fingertip3L 1 55.0 30.0 -30.0 4.0 0 0
fingertip3L 0 40.0 -40.0 -90.0 4.0 0 0

6 changes: 3 additions & 3 deletions ergoCubSN002/hardware/POS/left_hand-pos2.xml
Original file line number Diff line number Diff line change
Expand Up @@ -40,9 +40,9 @@
<group name="CALIBRATION">
<!-- it is not mandatory. if not present, sensors have defaults: TYPE:decideg, ROT:zero, 0.0, false -->
<param name="type"> TYPE:decideg TYPE:decideg </param>
<param name="rotation"> ROT:zero ROT:zero </param>
<param name="offset"> -98.0 -111.0 </param>
<param name="invertDirection"> true true </param>
<param name="rotation"> ROT:plus180 ROT:zero </param>
<param name="offset"> -230.0 -111.0 </param>
<param name="invertDirection"> true true </param>
</group>

</group>
Expand Down
4 changes: 2 additions & 2 deletions ergoCubSN002/hardware/POS/right_hand-pos2.xml
Original file line number Diff line number Diff line change
Expand Up @@ -40,8 +40,8 @@
<group name="CALIBRATION">
<!-- it is not mandatory. if not present, sensors have defaults: TYPE:decideg, ROT:zero, 0.0, false -->
<param name="type"> TYPE:decideg TYPE:decideg </param>
<param name="rotation"> ROT:plus180 ROT:zero </param>
<param name="offset"> -171.0 -293.0 </param>
<param name="rotation"> ROT:zero ROT:zero </param>
<param name="offset"> -233.0 -293.0 </param>
<param name="invertDirection"> false false </param>
</group>

Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -14,7 +14,7 @@
<!-- joint name thumb index medium pinky -->
<group name="LIMITS">
<param name="jntPosMin"> 0 0 0 0 </param>
<param name="jntPosMax"> 90 90 90 90 </param>
<param name="jntPosMax"> 90 90 90 80 </param>
<param name="jntVelMax"> 1000 1000 1000 1000 </param>
<param name="motorOverloadCurrents"> 2000 2000 2000 2000 </param>
<param name="motorNominalCurrents"> 1100 1100 1100 1100 </param>
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -14,7 +14,7 @@
<!-- joint name thumb index medium pinky -->
<group name="LIMITS">
<param name="jntPosMin"> 0 0 0 0 </param>
<param name="jntPosMax"> 90 90 90 90 </param>
<param name="jntPosMax"> 90 90 90 80 </param>
<param name="jntVelMax"> 1000 1000 1000 1000 </param>
<param name="motorOverloadCurrents"> 2000 2000 2000 2000 </param>
<param name="motorNominalCurrents"> 1100 1100 1100 1100 </param>
Expand Down
6 changes: 3 additions & 3 deletions ergoCubSN002/hardware/skin/left_arm-eb4-j2_3-skinSpec.xml
Original file line number Diff line number Diff line change
Expand Up @@ -19,20 +19,20 @@
-->
<param name="numOfSets"> 1 </param>
<!-- CAN BUS = patch adr start adr end period type no_load -->
<param name="boardSetCfg1"> 2 2 2 50 1 0xc8 </param>
<param name="boardSetCfg1"> 2 2 2 50 1 0xe8 </param>

</group>


<group name="defaultCfgTriangle">
<param name="enabled"> false </param>
<param name="shift"> 1 </param>
<param name="cdcOffset"> 0x0000 </param>
<param name="cdcOffset"> 0x2200 </param>
</group>

<group name="specialCfgTriangles">
<param name="numOfSets"> 1 </param>
<param name="triangleSetCfg1"> 2 2 0 15 1 1 0x0000 </param>
<param name="triangleSetCfg1"> 2 2 0 4 1 1 0x0000 </param>
<param name="triangleSetCfg2"> 2 2 0 15 1 1 0x0000 </param>
<param name="triangleSetCfg3"> 2 2 8 8 1 1 0x0000 </param>
<param name="triangleSetCfg4"> 2 2 12 12 1 1 0x0000 </param>
Expand Down
6 changes: 3 additions & 3 deletions ergoCubSN002/hardware/skin/right_arm-eb3-j2_3-skinSpec.xml
Original file line number Diff line number Diff line change
Expand Up @@ -20,20 +20,20 @@
-->
<param name="numOfSets"> 1 </param>
<!-- CAN BUS = patch adr start adr end period type no_load -->
<param name="boardSetCfg1"> 2 2 2 50 1 0xc8 </param>
<param name="boardSetCfg1"> 2 2 2 50 1 0xe8 </param>

</group>


<group name="defaultCfgTriangle">
<param name="enabled"> false </param>
<param name="shift"> 1 </param>
<param name="cdcOffset"> 0x0000 </param>
<param name="cdcOffset"> 0x2200 </param>
</group>
<!-- for now (jan 2024) we put a unique set of parameters activating all 16 I2C addr -->
<group name="specialCfgTriangles">
<param name="numOfSets"> 1 </param>
<param name="triangleSetCfg1"> 2 2 0 15 1 1 0x0000 </param>
<param name="triangleSetCfg1"> 2 2 0 4 1 1 0x0000 </param>
<param name="triangleSetCfg2"> 2 2 0 15 1 1 0x0000 </param>
<param name="triangleSetCfg3"> 2 2 8 8 1 1 0x0000 </param>
<param name="triangleSetCfg4"> 2 2 12 12 1 1 0x0000 </param>
Expand Down
16 changes: 8 additions & 8 deletions ergoCubSN002/network.ergoCubSN002.xml
Original file line number Diff line number Diff line change
Expand Up @@ -102,9 +102,9 @@
<connected bus="CAN" />
</board>

<board type='mtb4' name="mtb4.1">
<board type='mtb4c' name="mtb4.1">
<ondevice>ETH</ondevice>
<ataddress ip="10.0.1.4" canbus="2" canadr="1" />
<ataddress ip="10.0.1.4" canbus="2" canadr="2" />
<connected bus="CAN" />
</board>

Expand All @@ -120,13 +120,13 @@
<connected bus="ETH" prev="10.0.1.23" next="10.0.1.31" />
</board>

<board type='mtb4' name="mtb4.1">
<board type='mtb4c' name="mtb4.1">
<ondevice>ETH</ondevice>
<ataddress ip="10.0.1.25" canbus="1" canadr="1" />
<connected bus="CAN" />
</board>

<board type='mtb4' name="mtb4.2">
<board type='mtb4c' name="mtb4.2">
<ondevice>ETH</ondevice>
<ataddress ip="10.0.1.25" canbus="1" canadr="2" />
<connected bus="CAN" />
Expand Down Expand Up @@ -202,9 +202,9 @@
<connected bus="CAN" />
</board>

<board type='mtb4' name="mtb4.1">
<board type='mtb4c' name="mtb4.1">
<ondevice>ETH</ondevice>
<ataddress ip="10.0.1.3" canbus="2" canadr="1" />
<ataddress ip="10.0.1.3" canbus="2" canadr="2" />
<connected bus="CAN" />
</board>

Expand All @@ -220,13 +220,13 @@
<connected bus="ETH" prev="10.0.1.22" next="10.0.1.30" />
</board>

<board type='mtb4' name="mtb4.1">
<board type='mtb4c' name="mtb4.1">
<ondevice>ETH</ondevice>
<ataddress ip="10.0.1.24" canbus="1" canadr="1" />
<connected bus="CAN" />
</board>

<board type='mtb4' name="mtb4.2">
<board type='mtb4c' name="mtb4.2">
<ondevice>ETH</ondevice>
<ataddress ip="10.0.1.24" canbus="1" canadr="2" />
<connected bus="CAN" />
Expand Down