Fix PostureGenerator::q that alway return first robot configuration.