Added GetAvgDistance to DriveSubsystem and called it Update Nav