Skip to content

Commit f594039

Browse files
Add alljoints-inertials_wrapper/remapper to expose IMU orientation measurements (#632)
1 parent 2ec40fb commit f594039

24 files changed

+396
-2
lines changed
Lines changed: 23 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,23 @@
1+
<?xml version="1.0" encoding="UTF-8" ?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
5+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_remapper" type="multipleanalogsensorsremapper">
6+
<param name="OrientationSensorsNames">
7+
(head_imu_0 l_arm_ft l_leg_ft l_foot_rear_ft l_foot_front_ft r_arm_ft r_leg_ft r_foot_rear_ft r_foot_front_ft waist_imu_0)
8+
</param>
9+
<action phase="startup" level="5" type="attach">
10+
<paramlist name="networks">
11+
<elem name="head_imu"> head-inertial </elem>
12+
<elem name="l_arm_imu"> left_arm-eb2-j0_1-inertial </elem>
13+
<elem name="l_leg_imu"> left_leg-eb8-j0_3-inertial </elem>
14+
<elem name="l_foot_imu"> left_leg-eb9-j4_5-inertial </elem>
15+
<elem name="r_arm_imu"> right_arm-eb1-j0_1-inertial </elem>
16+
<elem name="r_leg_imu"> right_leg-eb6-j0_3-inertial </elem>
17+
<elem name="r_foot_imu"> right_leg-eb7-j4_5-inertial </elem>
18+
<elem name="waist_imu"> waist_inertial </elem>
19+
</paramlist>
20+
</action>
21+
22+
<action phase="shutdown" level="20" type="detach" />
23+
</device>
Lines changed: 15 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,15 @@
1+
<?xml version="1.0" encoding="UTF-8"?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_wrapper" type="multipleanalogsensorsserver">
5+
<param name="period"> 10 </param>
6+
<param name="name"> /${portprefix}/alljoints/inertials </param>
7+
8+
<action phase="startup" level="15" type="attach">
9+
<paramlist name="networks">
10+
<elem name="FirstStrain"> alljoints-inertials_remapper </elem>
11+
</paramlist>
12+
</action>
13+
14+
<action phase="shutdown" level="15" type="detach" />
15+
</device>
Lines changed: 23 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,23 @@
1+
<?xml version="1.0" encoding="UTF-8" ?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
5+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_remapper" type="multipleanalogsensorsremapper">
6+
<param name="OrientationSensorsNames">
7+
(head_imu_0 l_arm_ft l_leg_ft l_foot_rear_ft l_foot_front_ft r_arm_ft r_leg_ft r_foot_rear_ft r_foot_front_ft waist_imu_0)
8+
</param>
9+
<action phase="startup" level="5" type="attach">
10+
<paramlist name="networks">
11+
<elem name="head_imu"> head-inertial </elem>
12+
<elem name="l_arm_imu"> left_arm-eb2-j0_1-inertial </elem>
13+
<elem name="l_leg_imu"> left_leg-eb8-j0_3-inertial </elem>
14+
<elem name="l_foot_imu"> left_leg-eb9-j4_5-inertial </elem>
15+
<elem name="r_arm_imu"> right_arm-eb1-j0_1-inertial </elem>
16+
<elem name="r_leg_imu"> right_leg-eb6-j0_3-inertial </elem>
17+
<elem name="r_foot_imu"> right_leg-eb7-j4_5-inertial </elem>
18+
<elem name="waist_imu"> waist_inertial </elem>
19+
</paramlist>
20+
</action>
21+
22+
<action phase="shutdown" level="20" type="detach" />
23+
</device>
Lines changed: 15 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,15 @@
1+
<?xml version="1.0" encoding="UTF-8"?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_wrapper" type="multipleanalogsensorsserver">
5+
<param name="period"> 10 </param>
6+
<param name="name"> /${portprefix}/alljoints/inertials </param>
7+
8+
<action phase="startup" level="15" type="attach">
9+
<paramlist name="networks">
10+
<elem name="FirstStrain"> alljoints-inertials_remapper </elem>
11+
</paramlist>
12+
</action>
13+
14+
<action phase="shutdown" level="15" type="detach" />
15+
</device>
Lines changed: 23 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,23 @@
1+
<?xml version="1.0" encoding="UTF-8" ?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
5+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_remapper" type="multipleanalogsensorsremapper">
6+
<param name="OrientationSensorsNames">
7+
(head_imu_0 l_arm_ft l_leg_ft l_foot_rear_ft l_foot_front_ft r_arm_ft r_leg_ft r_foot_rear_ft r_foot_front_ft waist_imu_0)
8+
</param>
9+
<action phase="startup" level="5" type="attach">
10+
<paramlist name="networks">
11+
<elem name="head_imu"> head-inertial </elem>
12+
<elem name="l_arm_imu"> left_arm-eb2-j0_1-inertial </elem>
13+
<elem name="l_leg_imu"> left_leg-eb8-j0_3-inertial </elem>
14+
<elem name="l_foot_imu"> left_leg-eb9-j4_5-inertial </elem>
15+
<elem name="r_arm_imu"> right_arm-eb1-j0_1-inertial </elem>
16+
<elem name="r_leg_imu"> right_leg-eb6-j0_3-inertial </elem>
17+
<elem name="r_foot_imu"> right_leg-eb7-j4_5-inertial </elem>
18+
<elem name="waist_imu"> waist_inertial </elem>
19+
</paramlist>
20+
</action>
21+
22+
<action phase="shutdown" level="20" type="detach" />
23+
</device>
Lines changed: 15 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,15 @@
1+
<?xml version="1.0" encoding="UTF-8"?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_wrapper" type="multipleanalogsensorsserver">
5+
<param name="period"> 10 </param>
6+
<param name="name"> /${portprefix}/alljoints/inertials </param>
7+
8+
<action phase="startup" level="15" type="attach">
9+
<paramlist name="networks">
10+
<elem name="FirstStrain"> alljoints-inertials_remapper </elem>
11+
</paramlist>
12+
</action>
13+
14+
<action phase="shutdown" level="15" type="detach" />
15+
</device>
Lines changed: 20 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,20 @@
1+
<?xml version="1.0" encoding="UTF-8" ?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
5+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_remapper" type="multipleanalogsensorsremapper">
6+
<param name="OrientationSensorsNames">
7+
(head_imu_0 l_leg_ft l_foot_ft r_leg_ft r_foot_ft)
8+
</param>
9+
<action phase="startup" level="5" type="attach">
10+
<paramlist name="networks">
11+
<elem name="head_imu"> head-inertial </elem>
12+
<elem name="l_upper_leg_imu"> left_leg-eb6-imu </elem>
13+
<elem name="l_lower_leg_imu"> left_leg-eb7-imu </elem>
14+
<elem name="r_upper_leg_imu"> right_leg-eb8-imu </elem>
15+
<elem name="r_lower_leg_imu"> right_leg-eb9-imu </elem>
16+
</paramlist>
17+
</action>
18+
19+
<action phase="shutdown" level="20" type="detach" />
20+
</device>
Lines changed: 15 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,15 @@
1+
<?xml version="1.0" encoding="UTF-8"?>
2+
<!DOCTYPE devices PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">
3+
4+
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="alljoints-inertials_wrapper" type="multipleanalogsensorsserver">
5+
<param name="period"> 10 </param>
6+
<param name="name"> /${portprefix}/alljoints/inertials </param>
7+
8+
<action phase="startup" level="15" type="attach">
9+
<paramlist name="networks">
10+
<elem name="FirstStrain"> alljoints-inertials_remapper </elem>
11+
</paramlist>
12+
</action>
13+
14+
<action phase="shutdown" level="15" type="detach" />
15+
</device>

iCubGenova11/wrappers/inertials/alljoints-inertials_remapper.xml

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -6,7 +6,7 @@
66
<param name="OrientationSensorsNames">
77
(l_arm_ft r_arm_ft head_imu_0)
88
</param>
9-
<action phase="startup" level="10" type="attach">
9+
<action phase="startup" level="5" type="attach">
1010
<paramlist name="networks">
1111
<elem name="head_imu"> head-inertial </elem>
1212
<elem name="left_arm_imu"> left_arm-eb1-imu </elem>

iCubGenova11/wrappers/inertials/alljoints-inertials_wrapper.xml

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -11,5 +11,5 @@
1111
</paramlist>
1212
</action>
1313

14-
<action phase="shutdown" level="20" type="detach" />
14+
<action phase="shutdown" level="15" type="detach" />
1515
</device>

0 commit comments

Comments
 (0)