This is the first revision of the auto-parking code, this still has a few bugs in the code where the robot crashes into the corner because it believes it has to line itself up again to be parallel with the wall, right after the front ultrasonic sensor detects the back wall.

It also takes some time to make itself perfectly center in the gap (a second or two), this will be fixed in future revisions.