Skip to content

Commit

Permalink
Expose BMS on ergoCubSN000 via battery_nws_yarp (#514)
Browse files Browse the repository at this point in the history
  • Loading branch information
martinaxgloria committed May 19, 2023
1 parent 97d7432 commit 2c6dfcc
Show file tree
Hide file tree
Showing 6 changed files with 87 additions and 0 deletions.
11 changes: 11 additions & 0 deletions ergoCubSN000/battery_test.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,11 @@
<?xml version="1.0" encoding="UTF-8" ?>
<!DOCTYPE robot PUBLIC "-//YARP//DTD yarprobotinterface 3.0//EN" "http://www.yarp.it/DTD/yarprobotinterfaceV3.0.dtd">

<robot name="ergoCubSN000" build="1" portprefix="/ergocub" xmlns:xi="http://www.w3.org/2001/XInclude">

<devices>
<xi:include href="hardware/battery/battery.xml" />
<xi:include href="wrappers/battery/battery.xml" />
</devices>

</robot>
4 changes: 4 additions & 0 deletions ergoCubSN000/ergocub_all.xml
Original file line number Diff line number Diff line change
Expand Up @@ -112,6 +112,10 @@
<xi:include href="wrappers/inertials/right_arm-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/left_foot-imu_wrapper.xml" />
<xi:include href="wrappers/inertials/right_foot-imu_wrapper.xml" />

<!-- BATTERY-->
<xi:include href="hardware/battery/battery.xml" />
<xi:include href="wrappers/battery/battery.xml" />

<!-- CALIBRATORS -->
<xi:include href="calibrators/torso-calib.xml" />
Expand Down
5 changes: 5 additions & 0 deletions ergoCubSN000/ergocub_all_ros2.xml
Original file line number Diff line number Diff line change
Expand Up @@ -97,6 +97,11 @@
<xi:include href="wrappers/inertials/head-inertials_wrapper.xml" />
<xi:include href="hardware/inertials/head-inertial.xml" />


<!-- BATTERY-->
<xi:include href="hardware/battery/battery.xml" />
<xi:include href="wrappers/battery/battery.xml" />

<!-- CALIBRATORS -->
<xi:include href="calibrators/torso-calib.xml" />
<xi:include href="calibrators/left_leg-calib.xml" />
Expand Down
4 changes: 4 additions & 0 deletions ergoCubSN000/ergocub_wbd.xml
Original file line number Diff line number Diff line change
Expand Up @@ -109,6 +109,10 @@
<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" />

<!-- BATTERY-->
<xi:include href="hardware/battery/battery.xml" />
<xi:include href="wrappers/battery/battery.xml" />

<!-- CALIBRATORS -->
<xi:include href="calibrators/torso-calib.xml" />
Expand Down
47 changes: 47 additions & 0 deletions ergoCubSN000/hardware/battery/battery.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,47 @@
<?xml version="1.0" encoding="UTF-8"?>
<!DOCTYPE device 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="canbattery" type="embObjBattery">

<xi:include href="../../general.xml" />
<xi:include href="../electronics/left_arm-eb2-j0_1-eln.xml" />

<group name="SERVICE">

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

<group name="PROPERTIES">

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

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

<group name="SENSORS">
<param name="id"> battery1 </param>
<param name="board"> bms </param>
<param name="location"> CAN1:1 </param>
</group>

</group>


<group name="SETTINGS">
<param name="enabledSensors"> battery1 </param>
<param name="acquisitionRate"> 1000 </param> <!-- msec -->
</group>


</group>

</device>

16 changes: 16 additions & 0 deletions ergoCubSN000/wrappers/battery/battery.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,16 @@
<?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="battery_wrapper" type="battery_nws_yarp">
<param name="period"> 1.0 </param>
<param name="name"> /ergocub/battery </param>

<action phase="startup" level="5" type="attach">
<paramlist name="networks">
<!-- The param value must match the device name in the corresponding body_part-ebX-jA_B-strain.xml file -->
<elem name="battery"> canbattery </elem>
</paramlist>
</action>

<action phase="shutdown" level="5" type="detach" />
</device>

0 comments on commit 2c6dfcc

Please sign in to comment.