WM8960Stream.h

Go to the documentation of this file.

#pragma once
 
#include "AudioTools/CoreAudio/AudioI2S/I2SStream.h"
#include "AudioTools/CoreAudio/AudioStreams.h"
#include "mtb_wm8960.h"  // https://github.com/pschatzmann/arduino-wm8960
 
namespace audio_tools {
 
class WM8960Config : public I2SConfig {
 public:
  WM8960Config() : I2SConfig() {}
  WM8960Config(RxTxMode mode) : I2SConfig(mode) {
    sample_rate = 44100;
    channels = 2;
    bits_per_sample = 16;
  }
  float default_volume = 0.6;
  bool vs1053_enable_pll = true;
  uint32_t vs1053_mclk_hz = 0;
  TwoWire* wire = nullptr;
  bool vs1053_dump = false;
  uint32_t i2c_retry_count = 0;
  // optional features: use bitmask with
  // WM8960_FEATURE_MICROPHONE,WM8960_FEATURE_HEADPHONE,WM8960_FEATURE_SPEAKER
  int8_t features = -1;
};
 
class WM8960Stream : public AudioStream {
 public:
  WM8960Stream() = default;
 
  WM8960Config defaultConfig(RxTxMode mode = TX_MODE) {
    TRACED();
    WM8960Config c(mode);
    return c;
  }
 
  void setAudioInfo(WM8960Config c) {
    cfg = c;
    begin(c);
  }
 
  void setAudioInfo(AudioInfo c) {
    cfg.copyFrom(c);
    begin(cfg);
  }
 
  bool begin() { return begin(cfg); }
 
  bool begin(WM8960Config config) {
    TRACEI();
    cfg = config;
 
    // setup wm8960
    if (!init(cfg.rx_tx_mode)) {
      LOGE("init");
      return false;
    }
    setVolume(cfg.default_volume);
    if (!mtb_wm8960_activate()) {
      LOGE("mtb_wm8960_activate");
      return false;
    }
    if (!configure_clocking()) {
      LOGE("configure_clocking");
      return false;
    }
    if (config.vs1053_dump) {
      mtb_wm8960_dump();
    }
 
    // setup output
    i2s.begin(cfg);
 
    return true;
  }
 
  void end() {
    TRACEI();
    i2s.end();
    mtb_wm8960_deactivate();
    mtb_wm8960_free();
  }
 
  bool setVolume(float vol) {
    // make sure that value is between 0 and 1
    setVolumeIn(vol);
    setVolumeOut(vol);
    return true;
  }
 
  void setVolumeIn(float vol) { adjustInputVolume(vol); }
 
  void setVolumeOut(float vol) { setOutputVolume(vol); }
 
  float volumeIn() { return volume_in; }
 
  float volumeOut() { return volume_out; }
 
  size_t readBytes(uint8_t* data, size_t size) override {
    return i2s.readBytes(data, size);
  }
 
  size_t write(const uint8_t* data, size_t size) override {
    return i2s.write(data, size);
  }
 
 protected:
  WM8960Config cfg;
  I2SStream i2s;
  float volume_in;
  float volume_out;
 
  void adjustInputVolume(float vol) {
    if (vol > 1.0f) {
      volume_in = 1.0f;
      volumeError(vol);
    } else if (vol < 0.0f) {
      volume_in = 0.0f;
      volumeError(vol);
    } else {
      volume_in = vol;
    }
    int vol_int = map(volume_in * 100, 0, 100, 0, 30);
    mtb_wm8960_adjust_input_volume(vol_int);
  }
 
  void setOutputVolume(float vol) {
    if (vol > 1.0f) {
      volume_out = 1.0f;
      volumeError(vol);
    } else if (vol < 0.0f) {
      volume_out = 0.0f;
      volumeError(vol);
    } else {
      volume_out = vol;
    }
    int vol_int =
        volume_out == 0.0 ? 0 : map(volume_out * 100, 0, 100, 30, 0x7F);
    mtb_wm8960_set_output_volume(vol_int);
  }
 
  bool init(RxTxMode mode) {
    mtb_wm8960_set_write_retry_count(cfg.i2c_retry_count);
    // define wire object
    mtb_wm8960_set_wire(cfg.wire);
 
    // init features if not defined depending on mode
    if (cfg.features == -1) {
      switch (mode) {
        case RX_MODE:
          cfg.features = WM8960_FEATURE_MICROPHONE1;
          break;
        case TX_MODE:
          cfg.features = WM8960_FEATURE_HEADPHONE | WM8960_FEATURE_SPEAKER;
          break;
        case RXTX_MODE:
          cfg.features = WM8960_FEATURE_MICROPHONE1 | WM8960_FEATURE_HEADPHONE |
                         WM8960_FEATURE_SPEAKER;
          break;
      }
      LOGW("Setup features: %d", cfg.features);
    }
    return mtb_wm8960_init(cfg.features);
  }
 
  bool configure_clocking() {
    if (cfg.vs1053_mclk_hz == 0) {
      // just pick a multiple of the sample rate
      cfg.vs1053_mclk_hz = 512 * cfg.sample_rate;
    }
    if (!mtb_wm8960_configure_clocking(
            cfg.vs1053_mclk_hz, cfg.vs1053_enable_pll,
            sampleRate(cfg.sample_rate), wordLength(cfg.bits_per_sample),
            modeMasterSlave(cfg.is_master))) {
      LOGE("mtb_wm8960_configure_clocking");
      return false;
    }
    return true;
  }
 
  mtb_wm8960_adc_dac_sample_rate_t sampleRate(int rate) {
    switch (rate) {
      case 48000:
        return WM8960_ADC_DAC_SAMPLE_RATE_48_KHZ;
      case 44100:
        return WM8960_ADC_DAC_SAMPLE_RATE_44_1_KHZ;
      case 32000:
        return WM8960_ADC_DAC_SAMPLE_RATE_32_KHZ;
      case 24000:
        return WM8960_ADC_DAC_SAMPLE_RATE_24_KHZ;
      case 22050:
        return WM8960_ADC_DAC_SAMPLE_RATE_22_05_KHZ;
      case 16000:
        return WM8960_ADC_DAC_SAMPLE_RATE_16_KHZ;
      case 12000:
        return WM8960_ADC_DAC_SAMPLE_RATE_12_KHZ;
      case 11025:
        return WM8960_ADC_DAC_SAMPLE_RATE_11_025_KHZ;
      case 8018:
        return WM8960_ADC_DAC_SAMPLE_RATE_8_018_KHZ;
      case 8000:
        return WM8960_ADC_DAC_SAMPLE_RATE_8_KHZ;
      default:
        LOGE("Unsupported rate: %d", rate);
        return WM8960_ADC_DAC_SAMPLE_RATE_44_1_KHZ;
    }
  }
 
  mtb_wm8960_word_length_t wordLength(int bits) {
    switch (bits) {
      case 16:
        return WM8960_WL_16BITS;
      case 20:
        return WM8960_WL_20BITS;
      case 24:
        return WM8960_WL_24BITS;
      case 32:
        return WM8960_WL_32BITS;
      default:
        LOGE("Unsupported bits: %d", bits);
        return WM8960_WL_16BITS;
    }
  }
 
  mtb_wm8960_mode_t modeMasterSlave(bool microcontroller_is_master) {
    return microcontroller_is_master ? WM8960_MODE_SLAVE : WM8960_MODE_MASTER;
  }
 
  void volumeError(float vol) { LOGE("Invalid volume %f", vol); }
};
 
}  // namespace audio_tools