Drive code working. Successfully can turn and push off the brick.