Skip to content

iCubGenova11 add files for fineCalibrationChecker #748

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.

Sign up for GitHub

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

Draft
wants to merge 10 commits into
base: devel
Choose a base branch
from
Draft

iCubGenova11 add files for fineCalibrationChecker #748

Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
10 commits
Select commit Hold shift + click to select a range
e0650c8
Conf files for fineCalibrator demo
MSECode Jul 22, 2025
d0115b4
Remove not needed files
MSECode Jul 28, 2025
b83aae5
Fix typos and filenames
MSECode Jul 28, 2025
55e5043
Update CMakeLists.txt
pattacini Jul 28, 2025
377af47
Re-enable 15th arm joint (left and right)
MSECode Jul 28, 2025
53a625c
Update schema, change paramlist to param for raw values wrapper, disa…
MSECode Jul 29, 2025
4251455
Update nws wrapper using param instead of paramlist
MSECode Jul 29, 2025
6316828
Fix tag mismatch
MSECode Jul 29, 2025
c66c296
Check Ci with re-generated docker
MSECode Jul 30, 2025
f4a722c
trigger build
pattacini Jul 31, 2025
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
3 changes: 2 additions & 1 deletion iCubGenova11/CMakeLists.txt
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -10,4 +10,5 @@ yarp_install(DIRECTORY cartesian DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/$
yarp_install(DIRECTORY wrappers DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/${appname})
yarp_install(DIRECTORY hardware DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/${appname})
yarp_install(DIRECTORY camera DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/${appname})
yarp_install(DIRECTORY estimators DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/${appname})
yarp_install(DIRECTORY estimators DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/${appname})
yarp_install(DIRECTORY checker DESTINATION ${ICUBCONTRIB_ROBOTS_INSTALL_DIR}/${appname})
2 changes: 1 addition & 1 deletion iCubGenova11/calibrators/left_arm-calib.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -31,7 +31,7 @@
<param name="startupPosThreshold"> 2 2 2 2 90 90 90 90 90 90 90 90 90 90 90 90 </param>
</group>

<param name="CALIB_ORDER">(0 1 2 3) (4) (5 6 7) (8 9 11 13) (10 12 14 15)</param>
<param name="CALIB_ORDER">(0 1 2 3) (4) (5 6 7) (8 9 11 13) (10 12 14)</param>
Copy link
Member

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

@MSECode, was this change intended?

Copy link
Contributor Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

First commit I did was from the robot. Thus it might be due to changes left there that I took when checking out. I know that lately there were some problems with the finger. Thus I'm not sure if it was due to that to remove the last joint. Anyway I can remove that change from this PR and we can double check that directly on the robot.

Copy link
Member

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Anyway I can remove that change from this PR and we can double check that directly on the robot.

Yep, thanks! I'd go with this solution.

Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

I can confirm, they are disabled due to:

Copy link
Member

@pattacini pattacini Jul 29, 2025 •
edited
Loading

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

The fact that they're disabled locally to the robot doesn't imply that they should be upstream in the repo. Something to consider with care, I'd say.

I would still keep 15 upstream.
iCubGenova11 follows a different workflow/pace wrt ergCubs.

<!-- <param name="CALIB_ORDER">(0 1 2 3) (4) (5 6 7) (8 9 11 13) (10 12 14 15)</param> -->
<action phase="startup" level="10" type="calibrate">
<param name="target">left_arm-mc_remapper</param>
Expand Down
3 changes: 1 addition & 2 deletions iCubGenova11/calibrators/right_arm-calib.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -33,7 +33,7 @@
</group>


<param name="CALIB_ORDER">(0 1 2 3) (4) (5 6) (8 9 11 13) (10 12 14 15)</param>
<param name="CALIB_ORDER">(0 1 2 3) (4) (5 6) (8 9 11 13) (10 12 14)</param>
<!-- <param name="CALIB_ORDER">(0 1 2 3) (4) (5 6 7) (8 9 11 13) (10 12 14 15)</param> -->

<action phase="startup" level="10" type="calibrate">
Expand All @@ -47,4 +47,3 @@
<action phase="interrupt3" level="1" type="abort" />

</device>

27 changes: 27 additions & 0 deletions iCubGenova11/checker/fineCalibrationCheckerConfig.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
@@ -0,0 +1,27 @@
<?xml version="1.0" encoding="UTF-8" ?>
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">


<device xmlns:xi="http://www.w3.org/2001/XInclude" name="fineCalibrationChecker" type="fineCalibrationChecker">
<param name="devicename">fineCalibrationChecker</param>
<param name="robotname">iCubGenova11</param>
<param name="remoteRawValuesPort">/left_arm/raw_data</param> <!--right_arm/raw_data if needed other control board-->
<!-- <param name="axesNamesList">(r_shoulder_pitch, r_shoulder_roll, r_shoulder_yaw, r_elbow)</param> -->
<param name="axesNamesList">(l_shoulder_pitch, l_shoulder_roll, l_shoulder_yaw, l_elbow)</param>
<!-- <param name="goldPositions">(35535, 33135, 24960, 25983)</param> --> <!--right_arm-->
<param name="goldPositions">(58559, 22639, 48830, 51983)</param> <!--left_arm-->
<!--<param name="calibrationDeltas">(1.0, -9.2, -14.2, 0 )</param> --> <!--right_arm-->
<param name="calibrationDeltas">(0, -9.2, -17.1, -2.7 )</param> <!--left_arm-->
<param name="encoderResolutions">(262144, 262144, 262144, 262144)</param> <!--2^18 raw encoder resolution-->


<action phase="startup" level="15" type="attach">
<paramlist name="networks">
<elem name="setup_joint_0">left_arm-eb1-j0_3-mc</elem>
<!-- <elem name="setup_joint_0">right_arm-eb3-j0_3-mc</elem> --> <!--right_arm -->
</paramlist>
</action>

<action phase="shutdown" level="2" type="detach" />

</device>
4 changes: 4 additions & 0 deletions iCubGenova11/icub_all_no_legs.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -95,5 +95,9 @@
<xi:include href="calibrators/head-calib.xml" />
<xi:include href="calibrators/face-calib.xml" />

<!-- FINE CALIBRATOR CHECKER DEMO and TEST -->
<xi:include href="wrappers/motorControl/left_arm-mc-rawval-nws_wrapper.xml" />
<!-- <xi:include href="wrappers/motorControl/right_arm-mc-rawval-nws_wrapper.xml" /> -->
<xi:include href="checker/fineCalibrationCheckerConfig.xml" />
</devices>
</robot>
11 changes: 11 additions & 0 deletions iCubGenova11/wrappers/motorControl/left_arm-mc-rawval-nws_wrapper.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
@@ -0,0 +1,11 @@
<?xml version="1.0" encoding="UTF-8"?>
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_arm-rawval_nws_yarp" type="rawValuesPublisherServer">
<param name="name"> /left_arm/raw_data </param>
<param name="period"> 2 </param>
<action phase="startup" level="10" type="attach">
<param name="device"> left_arm-eb1-j0_3-mc </param>
</action>
<action phase="shutdown" level="15" type="detach" />
</device>
11 changes: 11 additions & 0 deletions iCubGenova11/wrappers/motorControl/right_arm-mc-rawval-nws_wrapper.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
@@ -0,0 +1,11 @@
<?xml version="1.0" encoding="UTF-8"?>
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_arm-rawval_nws_yarp" type="rawValuesPublisherServer">
<param name="name"> /right_arm/raw_data </param>
<param name="period"> 2 </param>
<action phase="startup" level="10" type="attach">
<param name="device"> right_arm-eb3-j0_3-mc </param>
</action>
<action phase="shutdown" level="15" type="detach" />
</device>
1 change: 1 addition & 0 deletions tests/dry-run/check-xml/schemas/wrapper.xsd
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -75,6 +75,7 @@
<xs:enumeration value="controlBoard_nws_yarp" />
<xs:enumeration value="controlBoard_nws_ros" />
<xs:enumeration value="controlBoard_nws_ros2" />
<xs:enumeration value="rawValuesPublisherServer"/>
</xs:restriction>
</xs:simpleType>

Expand Down
Loading