loco-3d/whole_body_state_rviz_plugin

Rviz plugins to display whole-body states and trajectories

Whole-body state Rviz plugins

Introduction

This repository includes Rviz plugins to display the whole-body state and trajectory of a robot. These plugins use dedicated ROS messages defined in whole_body_state_msgs package. To process efficiently the messages, e.g. robot display without TF broadcasting, the plugins use Pinocchio library.

The whole-body state plugin displays

1. the position and velocity of center of mass,
2. the contact forces,
3. the center of pressure,
4. the instantaneous capture point,
5. the friction cone, and
6. the support polygon.

Instead, the whole-body trajectory plugin displays

1. the center of mass trajectory and body orientation,
2. the swing trajectory and its orientation, and
3. the target posture and contact forces.

In the whole-body state plugin is possible to configure the diplay of the center of mass information in such a way that is projected in the support polygon. In both plugins, the contact forces are normalized according to the robot's weights. Furthermore, it is possible

All visuals are configurable through Rviz GUI. For example, the user can configure the color and the dimension of points, arrows and cones. Additionally, the user can select different lines style display.

🐧 Building

1. Installation pinocchio from any source (ros / robotpkg binaries or source)

2. Building the whole_body_state_msgs and these packages in your catkin workspace:

   cd your_ros_ws/
   catkin build #catkin_make

Formatting

Run the following in the root of the project:

clang-format-6.0 -i $(find . -path ./cmake -prune -o -iregex '.*\.\(h\|c\|hh\|cc\|hpp\|cpp\|hxx\|cxx\)$' -print)

©️ Credits

✍️ Written by

• Carlos Mastalli Heriot-Watt University 🇬🇧

👷 With contributions from

• Wolfgang Merkt, University of Oxford 🇬🇧
• James Foster, Institute for Human and Machine Cognition 🇺🇸

and maintained by the Robot Motor Intelligence (RoMI) lab.