Updated FindCan2, DriveSquare, and start of main CanCan code to use
newer state machine style and driving functions.