Add sonar averaging.
Turn off drivetrain safety.