LIPM Walking Controller

Trying the controller | Logs | Dependencies | Usage | Known bugs | Thanks

Source code of the walking and stair climbing controller used in the experiments of Stair Climbing Stabilization of the HRP-4 Humanoid Robot using Whole-body Admittance Control, as well as in an industrial demonstrator at the Airbus Saint-Nazaire factory.

This repository is meant for learning and sharing of experimental knowledge. It keeps walking components in the same place, and in their state from 2019. Ask any question you may have in the discussions forum, after checking of course that they are not already answered in the frequently asked questions. If you are looking for follow-up developments, go to jrl-umi3218/lipm_walking_controller or mehdi-benallegue/lipm_walking_controller.

Trying the controller

You can try a snapshot of the controller directly by running its Docker image:

xhost +local:docker
docker run -it --rm --user ayumi -e DISPLAY=${DISPLAY} -v /tmp/.X11-unix:/tmp/.X11-unix:rw \
    stephanecaron/lipm_walking_controller \
    lipm_walking --floor

This image runs the exact controller we used in 2019 during experiments and industrial demonstrations. Replace --floor with --staircase for stair climbing.

Checking the logs

You can check a log file from HRP-4 climbing stairs during the industrial demonstrator by running:

python ./logs/display_logs.py

Check out the pre-defined plots from the "User plots" menu. The ones we use the most are Tracking DCM-ZMP X/Y, Foot force both and Swing foot Z.

Dependencies

The controller has been tested on Ubuntu 14.04 with ROS Indigo and Ubuntu 16.04 with ROS Kinetic. It builds on the shoulders of the following software:

• ROS: robotics middleware
• Eigen: linear algebra
• Eigen3ToPython: Python bindings for Eigen
• SpaceVecAlg: spatial vector algebra
• RBDyn: rigid body dynamics
• eigen-qld: quadratic programming
• eigen-quadprog: quadratic programming
• sch-core: collision detection
• sch-core-python: Python bindings for sch-core
• Tasks: inverse kinematics
• mc_rbdyn_urdf: robot model loader
• copra: linear model predictive control
• mc_rtc: robot controller library

Instructions to build a more recent version of the controller from source are available from the jrl-umi3218 fork.

Usage

The lipm_walking script in the Docker images starts two processes. First, it launches RViz for visualization and interaction with the controller:

roslaunch lipm_walking_controller display.launch robot:=jvrc1

Second, it starts the controller itself in a Choreonoid simulation:

cd /usr/local/share/hrpsys/samples/JVRC1
choreonoid --start-simulation sim_mc.cnoid

We end up with three windows: one for RViz (left), one for Choreonoid (top right) and one for the terminal (bottom right) where the controller logs information and debug messages.

See the Graphical user interface page of the wiki for further instructions on how to interact with the controller in RViz.

Known bugs

This repository is an archive of the code as it ran in 2019, bugs included. Here is a non-exhaustive list of the big ones that have been found since then:

• Swing foot velocities and accelerations computed in incorrect frames #29
• Missing transformation in foot force difference control #72
• Missing contact reference velocity update #37
• Overwritten swing foot task velocities #41

Head over to jrl-umi3218/lipm_walking_controller or mehdi-benallegue/lipm_walking_controller for follow-up developments.

Thanks

Thanks to:

• @gergondet for developing and helping with mc_rtc
• @arntanguy for developing and helping with mc_rtc
• @Saeed-Mansouri for bug hunting and discussion around the project - Best Debugger Award 🏅
• @mmurooka for bug hunting and discussion around the project