Added a sonar class for the sonar sensor, then added an autonomous turn method and a autonomous move method for the chassis, both of which need to be optimized.