First version of hubo-motion-rt controller, tested in simulation