Skip to content

Commit

Permalink
Add imu of ergocub legs
Browse files Browse the repository at this point in the history
  • Loading branch information
icub committed May 15, 2023
1 parent 62639b0 commit 352272c
Show file tree
Hide file tree
Showing 9 changed files with 141 additions and 5 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>

0 comments on commit 352272c

Please sign in to comment.