Code for square, spin, and find ball (motion control side)