Working basic footstep planning with Atlas