Skip to content

Commit

Permalink
🤖 [ergoCubGazeboV1_1] Add configuration files for data logging (#806)
Browse files Browse the repository at this point in the history
  • Loading branch information
isorrentino authored Feb 8, 2024
1 parent d8ba5ff commit 76d6256
Show file tree
Hide file tree
Showing 8 changed files with 253 additions and 1 deletion.
3 changes: 2 additions & 1 deletion CHANGELOG.md
Original file line number Diff line number Diff line change
Expand Up @@ -5,6 +5,7 @@ All notable changes to this project are documented in this file.
### Added
- Set submodel states from IMUs in RDE and add friction torques as measurement (https://github.com/ami-iit/bipedal-locomotion-framework/pull/793)
- Add streaming of arm fts in YarpRobotLoggerDevice (https://github.com/ami-iit/bipedal-locomotion-framework/pull/803)
- Add configuration files to log data from `ergoCubGazeboV1_1` (https://github.com/ami-iit/bipedal-locomotion-framework/pull/806)

### Changed
### Fixed
Expand Down Expand Up @@ -555,4 +556,4 @@ All notable changes to this project are documented in this file.
[0.3.0]: https://github.com/ami-iit/bipedal-locomotion-framework/compare/v0.2.0...v0.3.0
[0.2.0]: https://github.com/ami-iit/bipedal-locomotion-framework/compare/v0.1.1...v0.2.0
[0.1.1]: https://github.com/ami-iit/bipedal-locomotion-framework/compare/v0.1.0...v0.1.1
[0.1.0]: https://github.com/ami-iit/bipedal-locomotion-framework/releases/tag/v0.1.0
[0.1.0]: https://github.com/ami-iit/bipedal-locomotion-framework/releases/tag/v0.1.0
Original file line number Diff line number Diff line change
@@ -0,0 +1,13 @@
<!-- Copyright (C) 2019 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
BSD-3-Clause license. -->
<?xml version="1.0" encoding="UTF-8" ?>
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="all_joints_mc" type="remotecontrolboardremapper">
<param name="remoteControlBoards">("/ergocubSim/head", "/ergocubSim/torso", "/ergocubSim/left_arm", "/ergocubSim/right_arm", "/ergocubSim/left_leg", "/ergocubSim/right_leg")</param>
<param name="axesNames">("neck_pitch", "neck_roll", "neck_yaw", "camera_tilt", "torso_roll", "torso_yaw", "l_shoulder_pitch", "l_shoulder_roll", "l_shoulder_yaw", "l_elbow", "l_wrist_roll", "l_wrist_pitch", "l_wrist_yaw", "r_shoulder_pitch", "r_shoulder_roll", "r_shoulder_yaw", "r_elbow", "r_wrist_roll", "r_wrist_pitch", "r_wrist_yaw", "l_hip_pitch", "l_hip_roll", "l_hip_yaw", "l_knee", "l_ankle_pitch", "l_ankle_roll", "r_hip_pitch", "r_hip_roll", "r_hip_yaw", "r_knee", "r_ankle_pitch", "r_ankle_roll")</param>
<param name="localPortPrefix">/yarp_robot_logger/joints</param>

<group name="REMOTE_CONTROLBOARD_OPTIONS">
<param name="carrier">udp</param>
</group>
</device>
Original file line number Diff line number Diff line change
@@ -0,0 +1,36 @@
<!-- Copyright (C) 2022 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
BSD-3-Clause license. -->
<?xml version="1.0" encoding="UTF-8" ?>

<devices>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_arm_ft_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocubSim/left_arm/FT</param>
<param name="local">/yarp_robot_logger/left_arm</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_arm_ft_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocubSim/right_arm/FT</param>
<param name="local">/yarp_robot_logger/right_arm</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_leg_ft_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocubSim/left_leg/FT</param>
<param name="local">/yarp_robot_logger/left_leg</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_leg_ft_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocubSim/right_leg/FT</param>
<param name="local">/yarp_robot_logger/right_leg</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

</devices>
Original file line number Diff line number Diff line change
@@ -0,0 +1,43 @@
<!-- Copyright (C) 2019 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
GNU Lesser General Public License v2.1 or any later version. -->
<?xml version="1.0" encoding="UTF-8" ?>

<devices>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="head_imu_acc" type="multipleanalogsensorsclient">
<param name="remote">/ergocub/head/inertials</param>
<param name="local">/yarp_robot_logger/head/inertials</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_arm_imu_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocub/left_arm/imu</param>
<param name="local">/yarp_robot_logger/left_arm/imu</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_arm_imu_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocub/right_arm/imu</param>
<param name="local">/yarp_robot_logger/right_arm/imu</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_foot_imu_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocub/left_foot/imu</param>
<param name="local">/yarp_robot_logger/left_foot/imu</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_foot_imu_client" type="multipleanalogsensorsclient">
<param name="remote">/ergocub/right_foot/imu</param>
<param name="local">/yarp_robot_logger/right_foot/imu</param>
<param name="timeout">0.5</param>
<param name="carrier">fast_tcp</param>
</device>

</devices>
Original file line number Diff line number Diff line change
@@ -0,0 +1,26 @@
<!-- Copyright (C) 2019-2021 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
BSD-3-Clause license. -->

<?xml version="1.0" encoding="UTF-8" ?>
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="mas-remapper" type="multipleanalogsensorsremapper">
<param name="period">10</param>
<param name="SixAxisForceTorqueSensorsNames">
(l_arm_ft, r_arm_ft, l_leg_ft, l_foot_front_ft, l_foot_rear_ft, r_leg_ft, r_foot_front_ft, r_foot_rear_ft)
</param>

<param name="TemperatureSensorsNames">
(l_arm_ft, r_arm_ft, l_leg_ft, l_foot_front_ft, l_foot_rear_ft, r_leg_ft, r_foot_front_ft, r_foot_rear_ft)
</param>

<action phase="startup" level="5" type="attach">
<paramlist name="networks">
<elem name="left_arm_ft_client">left_arm_ft_client</elem>
<elem name="right_arm_ft_client">right_arm_ft_client</elem>
<elem name="left_leg_ft_client">left_leg_ft_client</elem>
<elem name="right_leg_ft_client">right_leg_ft_client</elem>
</paramlist>
</action>

<action phase="shutdown" level="5" type="detach" />
</device>
Original file line number Diff line number Diff line change
@@ -0,0 +1,44 @@
<!-- Copyright (C) 2022 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
BSD-3-Clause license. -->
<?xml version="1.0" encoding="UTF-8" ?>

<devices>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_arm_wrench_client" type="genericSensorClient">
<param name="remote">/wholeBodyDynamics/left_arm/cartesianEndEffectorWrench:o</param>
<param name="local">/yarp_robot_logger/left_arm_wrench</param>
<param name="carrier">udp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_arm_wrench_client" type="genericSensorClient">
<param name="remote">/wholeBodyDynamics/right_arm/cartesianEndEffectorWrench:o</param>
<param name="local">/yarp_robot_logger/right_arm_wrench</param>
<param name="carrier">udp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_front_wrench_client" type="genericSensorClient">
<param name="remote">/wholeBodyDynamics/left_foot_front/cartesianEndEffectorWrench:o</param>
<param name="local">/yarp_robot_logger/left_front_wrench</param>
<param name="carrier">udp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="left_rear_wrench_client" type="genericSensorClient">
<param name="remote">/wholeBodyDynamics/left_foot_rear/cartesianEndEffectorWrench:o</param>
<param name="local">/yarp_robot_logger/left_rear_wrench</param>
<param name="carrier">udp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_front_wrench_client" type="genericSensorClient">
<param name="remote">/wholeBodyDynamics/right_foot_front/cartesianEndEffectorWrench:o</param>
<param name="local">/yarp_robot_logger/right_front_wrench</param>
<param name="carrier">udp</param>
</device>

<device xmlns:xi="http://www.w3.org/2001/XInclude" name="right_rear_wrench_client" type="genericSensorClient">
<param name="remote">/wholeBodyDynamics/right_foot_rear/cartesianEndEffectorWrench:o</param>
<param name="local">/yarp_robot_logger/right_rear_wrench</param>
<param name="carrier">udp</param>
</device>

</devices>
Original file line number Diff line number Diff line change
@@ -0,0 +1,16 @@
<!-- Copyright (C) 2019-2022 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
BSD-3-Clause license. -->

<?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="ergoCubGazeboV1_1" portprefix="YarpRobotLogger" build="1" xmlns:xi="http://www.w3.org/2001/XInclude">
<devices>
<!-- interface -->
<xi:include href="blf-yarp-robot-logger-interfaces/all_joints_mc.xml" />
<xi:include href="blf-yarp-robot-logger-interfaces/ft_clients.xml" />
<xi:include href="blf-yarp-robot-logger-interfaces/mas-remapper.xml" />
<xi:include href="./yarp-robot-logger.xml" />
</devices>
</robot>
Original file line number Diff line number Diff line change
@@ -0,0 +1,73 @@
<!-- Copyright (C) 2019-2021 Istituto Italiano di Tecnologia (IIT). All rights reserved.
This software may be modified and distributed under the terms of the
BSD-3-Clause license. -->

<?xml version="1.0" encoding="UTF-8" ?>
<device xmlns:xi="http://www.w3.org/2001/XInclude" name="yarp-robot-logger" type="YarpRobotLoggerDevice">
<param name="robot">ergocubSim</param>
<param name="sampling_period_in_s">0.002</param>
<param name="rgb_cameras_fps">(30)</param>
<param name="video_codec_code">mp4v</param>
<param name="port_prefix">/yarp-robot-logger</param>
<param name="text_logging_subnames">("ergoCubGazeboV1/yarprobotinterface")</param>

<group name="Telemetry">
<param name="save_period">600.0</param>
</group>

<group name="ExogenousSignals">
<param name="vectors_collection_exogenous_inputs">("Walking")</param>
<param name="vectors_exogenous_inputs">()</param>

<group name="Walking">
<param name="local">"/yarp-robot-logger/exogenous_signals/walking"</param>
<param name="remote">"/walking-coordinator/logger"</param>
<param name="signal_name">"walking"</param>
<param name="carrier">"udp"</param>
</group>
</group>

<group name="RobotCameraBridge">
<param name="stream_cameras">false</param>
<group name="Cameras">
<param name="rgb_cameras_list">()</param>
</group>
</group>

<group name="RobotSensorBridge">
<param name="check_for_nan">false</param>
<param name="stream_joint_states">true</param>
<param name="stream_inertials">false</param>
<param name="stream_cartesian_wrenches">false</param>
<param name="stream_forcetorque_sensors">true</param>
<param name="stream_pids">false</param>
<param name="stream_motor_PWM">false</param>
<param name="stream_temperatures">true</param>

<group name="RemoteControlBoardRemapper">
<param name="joints_list">("neck_pitch", "neck_roll", "neck_yaw", "camera_tilt", "torso_roll", "torso_yaw", "l_shoulder_pitch", "l_shoulder_roll", "l_shoulder_yaw", "l_elbow", "l_wrist_roll", "l_wrist_pitch", "l_wrist_yaw", "r_shoulder_pitch", "r_shoulder_roll", "r_shoulder_yaw", "r_elbow", "r_wrist_roll", "r_wrist_pitch", "r_wrist_yaw", "l_hip_pitch", "l_hip_roll", "l_hip_yaw", "l_knee", "l_ankle_pitch", "l_ankle_roll", "r_hip_pitch", "r_hip_roll", "r_hip_yaw", "r_knee", "r_ankle_pitch", "r_ankle_roll")</param>
</group>

<group name="SixAxisForceTorqueSensors">
<param name="sixaxis_forcetorque_sensors_list">("l_arm_ft", "r_arm_ft", "l_leg_ft", "l_foot_front_ft", "l_foot_rear_ft", "r_leg_ft", "r_foot_front_ft", "r_foot_rear_ft")</param>
</group>

<group name="TemperatureSensors">
<param name="temperature_sensors_list">("l_arm_ft", "r_arm_ft", "l_leg_ft", "l_foot_front_ft", "l_foot_rear_ft", "r_leg_ft", "r_foot_front_ft", "r_foot_rear_ft")</param>
</group>

</group>

<!-- ATTACH -->
<action phase="startup" level="15" type="attach">
<paramlist name="networks">
<elem name="all_joints">all_joints_mc</elem>
<elem name="mas-remapper">mas-remapper</elem>

</paramlist>
</action>

<action phase="shutdown" level="2" type="detach" />
<!-- FINISH ATTACH-->

</device>

0 comments on commit 76d6256

Please sign in to comment.