Skip to content

Commit

Permalink
Add streaming of ergoCub leg imus (robotology#513)
Browse files Browse the repository at this point in the history
Co-authored-by: icub <[email protected]>
  • Loading branch information
2 people authored and mfussi66 committed Jun 19, 2023
1 parent 33aa281 commit fefc431
Show file tree
Hide file tree
Showing 10 changed files with 147 additions and 11 deletions.
4 changes: 4 additions & 0 deletions ergoCubSN000/ergocub_wbd.xml
Original file line number Diff line number Diff line change
Expand Up @@ -95,12 +95,16 @@
<!-- FT SENSORS - IMU -->
<xi:include href="hardware/inertials/left_arm-eb2-j0_1-inertial.xml" />
<xi:include href="hardware/inertials/right_arm-eb1-j0_1-inertial.xml" />
<xi:include href="hardware/inertials/left_leg-eb8-j0_3-inertial.xml" />
<xi:include href="hardware/inertials/right_leg-eb6-j0_3-inertial.xml" />
<xi:include href="hardware/inertials/left_leg-eb9-j4_5-inertial.xml" />
<xi:include href="hardware/inertials/right_leg-eb7-j4_5-inertial.xml" />

<!-- FT SENSORS - IMU - MULTIPLE ANALOG SENSOR SERVERS -->
<xi:include href="wrappers/inertials/left_arm-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/right_arm-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/left_leg-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/right_leg-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/left_foot-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/right_foot-imu_wrapper.xml" />

Expand Down
2 changes: 1 addition & 1 deletion ergoCubSN000/ft.xml
Original file line number Diff line number Diff line change
Expand Up @@ -12,7 +12,7 @@
<!-- ANALOG SENSORS FT -->


<xi:include href="wrappers/FT/left_arm-FT_wrapper.xml" />
<xi:include href="wrappers/FT/left_arm-FT_wrapper.xml" />
<xi:include href="wrappers/FT/right_arm-FT_wrapper.xml" />

<xi:include href="hardware/FT/left_arm-eb2-j0_1-strain.xml" />
Expand Down
46 changes: 46 additions & 0 deletions ergoCubSN000/hardware/inertials/left_leg-eb8-j0_3-inertial.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,46 @@
<?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_leg-eb8-j0_3-inertial" type="embObjIMU">

<xi:include href="../../general.xml" />

<xi:include href="../../hardware/electronics/left_leg-eb8-j0_3-eln.xml" />

<group name="SERVICE">

<param name="type"> eomn_serv_AS_inertials3 </param>

<group name="PROPERTIES">

<group name="CANBOARDS">
<param name="type"> eobrd_strain2 </param>

<group name="PROTOCOL">
<param name="major"> 0 </param>
<param name="minor"> 0 </param>
</group>

<group name="FIRMWARE">
<param name="major"> 0 </param>
<param name="minor"> 0 </param>
<param name="build"> 0 </param>
</group>
</group>

<group name="SENSORS">
<param name="id"> l_leg_ft_acc l_leg_ft_gyro l_leg_ft_eul l_leg_ft_mag l_leg_ft_stat</param>
<param name="type"> eoas_imu_acc eoas_imu_gyr eoas_imu_eul eoas_imu_mag eoas_imu_status</param>
<param name="boardType"> strain2 strain2 strain2 strain2 strain2</param>
<param name="location"> CAN2:13 CAN2:13 CAN2:13 CAN2:13 CAN2:13 </param>
</group>

</group>

<group name="SETTINGS">
<param name="acquisitionRate"> 10 </param>
<param name="enabledSensors"> l_leg_ft_acc l_leg_ft_gyro l_leg_ft_eul l_leg_ft_mag l_leg_ft_stat </param>
</group>
</group>

</device>
46 changes: 46 additions & 0 deletions ergoCubSN000/hardware/inertials/right_leg-eb6-j0_3-inertial.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,46 @@
<?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_leg-eb6-j0_3-inertial" type="embObjIMU">

<xi:include href="../../general.xml" />

<xi:include href="../../hardware/electronics/right_leg-eb6-j0_3-eln.xml" />

<group name="SERVICE">

<param name="type"> eomn_serv_AS_inertials3 </param>

<group name="PROPERTIES">

<group name="CANBOARDS">
<param name="type"> eobrd_strain2 </param>

<group name="PROTOCOL">
<param name="major"> 0 </param>
<param name="minor"> 0 </param>
</group>

<group name="FIRMWARE">
<param name="major"> 0 </param>
<param name="minor"> 0 </param>
<param name="build"> 0 </param>
</group>
</group>

<group name="SENSORS">
<param name="id"> r_leg_ft_acc r_leg_ft_gyro r_leg_ft_eul r_leg_ft_mag r_leg_ft_stat </param>
<param name="type"> eoas_imu_acc eoas_imu_gyr eoas_imu_eul eoas_imu_mag eoas_imu_status</param>
<param name="boardType"> strain2 strain2 strain2 strain2 strain2 </param>
<param name="location"> CAN2:13 CAN2:13 CAN2:13 CAN2:13 CAN2:13 </param>
</group>

</group>

<group name="SETTINGS">
<param name="acquisitionRate"> 10 </param>
<param name="enabledSensors"> r_leg_ft_acc r_leg_ft_gyro r_leg_ft_eul r_leg_ft_mag r_leg_ft_stat</param>
</group>
</group>

</device>
4 changes: 2 additions & 2 deletions ergoCubSN000/wrappers/FT/right_arm-FT_wrapper.xml
Original file line number Diff line number Diff line change
Expand Up @@ -2,9 +2,9 @@
<!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-FT_wrapper" type="multipleanalogsensorsserver">
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_arm-FT_wrapper" type="multipleanalogsensorsserver">
<param name="period"> 2 </param>
<param name="name"> /ergocub/right_arm </param>
<param name="name"> /ergocub/right_arm/FT </param>

<action phase="startup" level="5" type="attach">
<paramlist name="networks">
Expand Down
2 changes: 1 addition & 1 deletion ergoCubSN000/wrappers/inertials/left_foot-imu_wrapper.xml
Original file line number Diff line number Diff line change
Expand Up @@ -4,7 +4,7 @@

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_foot-imu_wrapper" type="multipleanalogsensorsserver">
<param name="period"> 10 </param>
<param name="name"> /ergocub/left_foot/imu </param>
<param name="name"> /ergocub/left_foot_heel_tiptoe/imu </param>


<action phase="startup" level="5" type="attach">
Expand Down
20 changes: 20 additions & 0 deletions ergoCubSN000/wrappers/inertials/left_leg-imu_wrapper.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,20 @@
<?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_leg-imu_wrapper" type="multipleanalogsensorsserver">
<param name="period"> 10 </param>
<param name="name"> /ergocub/left_leg/imu </param>


<action phase="startup" level="5" type="attach">
<paramlist name="networks">
<!-- The name of the element can be any string (we use SetOfInertials to better express its nature).
Its value must match the device name in the corresponding body_part-jx_y-inertials.xml file
or in body_part-ebX-inertials.xml -->
<elem name="SetOfInertials">left_leg-eb8-j0_3-inertial</elem>
</paramlist>
</action>

<action phase="shutdown" level="5" type="detach" />
</device>
2 changes: 1 addition & 1 deletion ergoCubSN000/wrappers/inertials/right_foot-imu_wrapper.xml
Original file line number Diff line number Diff line change
Expand Up @@ -4,7 +4,7 @@

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_foot-imu_wrapper" type="multipleanalogsensorsserver">
<param name="period"> 10 </param>
<param name="name"> /ergocub/right_foot/imu </param>
<param name="name"> /ergocub/right_foot_heel_tiptoe/imu </param>


<action phase="startup" level="5" type="attach">
Expand Down
20 changes: 20 additions & 0 deletions ergoCubSN000/wrappers/inertials/right_leg-imu_wrapper.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,20 @@
<?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_leg-imu_wrapper" type="multipleanalogsensorsserver">
<param name="period"> 10 </param>
<param name="name"> /ergocub/right_leg/imu </param>


<action phase="startup" level="5" type="attach">
<paramlist name="networks">
<!-- The name of the element can be any string (we use SetOfInertials to better express its nature).
Its value must match the device name in the corresponding body_part-jx_y-inertials.xml file
or in body_part-ebX-inertials.xml -->
<elem name="SetOfInertials">right_leg-eb6-j0_3-inertial</elem>
</paramlist>
</action>

<action phase="shutdown" level="5" type="detach" />
</device>
12 changes: 6 additions & 6 deletions ergoCubSN000/wrappers/motorControl/torso-mc_remapper.xml
Original file line number Diff line number Diff line change
Expand Up @@ -2,13 +2,13 @@
<!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="torso-mc_remapper" type="controlboardremapper">
<!--
These are the regular parameters

<!-- These are the regular parameters -->
<param name="axesNames">(torso_roll,torso_pitch,torso_yaw)</param>
-->
<!-- This are the parametes with torso_pitch not exposed outside of the yarprobotinterface -->
<param name="axesNames">(torso_roll,torso_yaw)</param>
<param name="joints"> 2 </param>

<!-- This are the parametes with torso_pitch not exposed outside of the yarprobotinterface
<param name="axesNames">(torso_roll,torso_yaw)</param> -->
<param name="joints"> 3 </param>
<action phase="startup" level="5" type="attach">
<paramlist name="networks">
<elem name="torso_joints"> torso-eb5-j0_2-mc </elem>
Expand Down

0 comments on commit fefc431

Please sign in to comment.