private void _setDistance(int index) {
        index = index%_distances.length;
        if(index < 0) {
            index += _distances.length;
        }
        _currIndex = index;
        SmartDashboard.putString("Distance", _distances[index].getValue());
    }