First we used the gyroscope and can determine and align the robot to a set angle
We also attempted to choreograph the robot into a square, which still needs work