HRP2 packages for biped whole body motion planning