CodecOpus.h

#pragma once
 
#include "AudioCodecs/AudioEncoded.h"
#include "Print.h"
#include "opus.h"
 
#ifndef OPUS_ENC_MAX_BUFFER_SIZE 
#define OPUS_ENC_MAX_BUFFER_SIZE 2048
#endif
 
#ifndef OPUS_DEC_MAX_BUFFER_SIZE
#define OPUS_DEC_MAX_BUFFER_SIZE 4*1024
#endif
 
 
namespace audio_tools {
 
struct OpusSettings : public AudioInfo {
  OpusSettings() {
    sample_rate = 48000;
    channels = 2;
    bits_per_sample = 16;
  }
  int max_buffer_size = OPUS_DEC_MAX_BUFFER_SIZE;
  int max_buffer_write_size = 512;
 
};
 
struct OpusEncoderSettings : public OpusSettings {
  OpusEncoderSettings() : OpusSettings() {
    max_buffer_size = OPUS_ENC_MAX_BUFFER_SIZE;
  }
  int application = OPUS_APPLICATION_AUDIO;
  int bitrate = -1;
  int force_channel = -1;
  int vbr = -1;
  int vbr_constraint = -1;
  int complexity = -1;
  int max_bandwidth = -1;
  int singal = -1;
  int inband_fec = -1;
  int packet_loss_perc = -1;
  int lsb_depth = -1;
  int prediction_disabled = -1;
  int use_dtx = -1;
  int frame_sizes_ms_x2 = -1; /* x2 to avoid 2.5 ms */
};
 
class OpusAudioDecoder : public AudioDecoder {
 public:
  OpusAudioDecoder() = default;
 
  OpusAudioDecoder(Print &out_stream) {
    TRACED();
    setOutput(out_stream);
  }
 
  void setOutput(Print &out_stream) override { p_print = &out_stream; }
 
  AudioInfo audioInfo() override { return cfg; }
 
  OpusSettings &config() { return cfg; }
  OpusSettings &defaultConfig() { return cfg; }
 
  bool begin(OpusSettings settings) {
    TRACED();
    AudioDecoder::setAudioInfo(settings);
    cfg = settings;
    notifyAudioChange(cfg);
    return begin();
  }
 
  bool begin() override {
    TRACED();
    if (!isValidRate(cfg.sample_rate)){
      LOGE("Sample rate not supported: %d", cfg.sample_rate);
      return false;
    }
    outbuf.resize(cfg.max_buffer_size);
    assert(outbuf.data() != nullptr);
    
    // int err;
    // dec = opus_decoder_create(cfg.sample_rate, cfg.channels, &err);
   
    size_t size = opus_decoder_get_size(cfg.channels);
    decbuf.resize(size);
    assert(decbuf.data() != nullptr);
    dec = (OpusDecoder*)decbuf.data();
    int err = opus_decoder_init(dec, cfg.sample_rate, cfg.channels);
  
 
    if (err != OPUS_OK) {
      LOGE("opus_decoder_create: %s for sample_rate: %d, channels:%d",
           opus_strerror(err), cfg.sample_rate, cfg.channels);
      return false;
    }
    active = true;
    return true;
  }
 
  void end() override {
    TRACED();
    if (dec) {
      opus_decoder_destroy(dec);
      dec = nullptr;
    }
    outbuf.resize(0);
    decbuf.resize(0);
    active = false;
  }
 
  void setAudioInfo(AudioInfo from) override {
    AudioDecoder::setAudioInfo(from);
    info = from;
    cfg.sample_rate = from.sample_rate;
    cfg.channels = from.channels;
    cfg.bits_per_sample = from.bits_per_sample;
  }
 
  size_t write(const void *in_ptr, size_t in_size) override {
    if (!active || p_print == nullptr) return 0;
    // decode data
    LOGD("OpusAudioDecoder::write: %d", (int)in_size);
    int in_band_forward_error_correction = 0;
    int frame_count = cfg.max_buffer_size / cfg.channels / sizeof(opus_int16);
    int out_samples = opus_decode(
        dec, (uint8_t *)in_ptr, in_size, (opus_int16 *)outbuf.data(),
        frame_count, in_band_forward_error_correction);
    if (out_samples < 0) {
      LOGW("opus-decode: %s", opus_strerror(out_samples));
    } else if (out_samples > 0) {
      // write data to final destination
      int out_bytes = out_samples * cfg.channels * sizeof(int16_t);
      LOGD("opus-decode: %d", out_bytes);
      int open = out_bytes;
      int processed = 0;
      while(open>0){
        int to_write = std::min(open, cfg.max_buffer_write_size);
        int written = p_print->write(outbuf.data()+processed, to_write);
        open -= written;
        processed += written;
      }
    }
    return in_size;
  }
 
  operator bool() override { return active; }
 
 protected:
  Print *p_print = nullptr;
  OpusSettings cfg;
  OpusDecoder *dec;
  bool active = false;
  Vector<uint8_t> outbuf{0};
  Vector<uint8_t> decbuf{0};
  const uint32_t valid_rates[5] = {8000, 12000, 16000, 24000,  48000};
 
  bool isValidRate(int rate){
    for (auto &valid : valid_rates){
      if (valid==rate) return true;
    }
    return false;
  }
};
 
class OpusAudioEncoder : public AudioEncoder {
 public:
  // Empty Constructor - the output stream must be provided with begin()
  OpusAudioEncoder() = default;
 
  // Constructor providing the output stream
  OpusAudioEncoder(Print &out) { setOutput(out); }
 
  void setOutput(Print &out_stream) override { p_print = &out_stream; }
 
  const char *mime() override { return "audio/opus"; }
 
  void setAudioInfo(AudioInfo from) override {
    AudioEncoder::setAudioInfo(from);
    cfg.sample_rate = from.sample_rate;
    cfg.channels = from.channels;
    cfg.bits_per_sample = from.bits_per_sample;
  }
 
  bool begin() override {
    int err;
    int size = getFrameSizeSamples(cfg.sample_rate) * 2;
    frame.resize(size);
    assert(frame.data() != nullptr);
    enc = opus_encoder_create(cfg.sample_rate, cfg.channels, cfg.application, &err);
    if (err != OPUS_OK) {
      LOGE("opus_encoder_create: %s for sample_rate: %d, channels:%d",
           opus_strerror(err), cfg.sample_rate, cfg.channels);
      return false;
    }
    is_open = settings();
    return true;
  }
 
  OpusEncoderSettings &config() { return cfg; }
 
  OpusEncoderSettings &defaultConfig() { return cfg; }
 
  bool begin(OpusEncoderSettings settings) {
    cfg = settings;
    return begin();
  }
 
  void end() override {
    // flush buffered data
    encodeFrame();
    // release memory
    opus_encoder_destroy(enc);
    is_open = false;
  }
 
  size_t write(const void *in_ptr, size_t in_size) override {
    if (!is_open || p_print == nullptr) return 0;
    LOGD("OpusAudioEncoder::write: %d", (int)in_size);
 
    // fill frame
    uint8_t *p_byte = (uint8_t *)in_ptr;
    for (int j = 0; j < in_size; j++) {
      encodeByte(p_byte[j]);
    }
    return in_size;
  }
 
  operator bool() override { return is_open; }
 
  bool isOpen() { return is_open; }
 
 protected:
  Print *p_print = nullptr;
  OpusEncoder *enc = nullptr;
  OpusEncoderSettings cfg;
  bool is_open = false;
  Vector<uint8_t> frame{0};
  int frame_pos = 0;
 
  void encodeByte(uint8_t data) {
    // add byte to frame
    frame[frame_pos++] = data;
 
    // if frame is complete -> encode
    if (frame_pos >= frame.size()) {
      encodeFrame();
      frame_pos = 0;
    }
  }
 
  void encodeFrame() {
    if (frame.size() > 0) {
      // allocate temp buffer on stack
      int packet_len = OPUS_ENC_MAX_BUFFER_SIZE > 0 ? OPUS_ENC_MAX_BUFFER_SIZE : 512;
      uint8_t packet[packet_len];
 
      int frames = frame.size() / cfg.channels / sizeof(int16_t);
      LOGD("opus_encode - frame_size: %d", frames);
      int len = opus_encode(enc, (opus_int16 *)frame.data(), frames,
                            packet, packet_len);
      if (len < 0) {
        LOGE("opus_encode: %s", opus_strerror(len));
      } else if (len > 0) {
        LOGD("opus-encode: %d", len);
        int eff = p_print->write(packet, len);
        if (eff!=len){
          LOGE("encodeFrame data lost: %d->%d", len, eff);
        }
      }
    }
  }
 
  int getFrameSizeSamples(int sampling_rate) {
    switch (cfg.frame_sizes_ms_x2) {
      case OPUS_FRAMESIZE_2_5_MS:
        return sampling_rate / 400;
      case OPUS_FRAMESIZE_5_MS:
        return sampling_rate / 200;
      case OPUS_FRAMESIZE_10_MS:
        return sampling_rate / 100;
      case OPUS_FRAMESIZE_20_MS:
        return sampling_rate / 50;
      case OPUS_FRAMESIZE_40_MS:
        return sampling_rate / 25;
      case OPUS_FRAMESIZE_60_MS:
        return 3 * sampling_rate / 50;
      case OPUS_FRAMESIZE_80_MS:
        return 4 * sampling_rate / 50;
      case OPUS_FRAMESIZE_100_MS:
        return 5 * sampling_rate / 50;
      case OPUS_FRAMESIZE_120_MS:
        return 6 * sampling_rate / 50;
    }
    return sampling_rate / 100;
  }
 
  bool settings() {
    bool ok = true;
    if (cfg.bitrate >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_BITRATE(cfg.bitrate)) != OPUS_OK) {
      LOGE("invalid bitrate: %d", cfg.bitrate);
      ok = false;
    }
    if (cfg.force_channel >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_FORCE_CHANNELS(cfg.force_channel)) !=
            OPUS_OK) {
      LOGE("invalid force_channel: %d", cfg.force_channel);
      ok = false;
    };
    if (cfg.vbr >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_VBR(cfg.vbr)) != OPUS_OK) {
      LOGE("invalid vbr: %d", cfg.vbr);
      ok = false;
    }
    if (cfg.vbr_constraint >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_VBR_CONSTRAINT(cfg.vbr_constraint)) !=
            OPUS_OK) {
      LOGE("invalid vbr_constraint: %d", cfg.vbr_constraint);
      ok = false;
    }
    if (cfg.complexity >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_COMPLEXITY(cfg.complexity)) != OPUS_OK) {
      LOGE("invalid complexity: %d", cfg.complexity);
      ok = false;
    }
    if (cfg.max_bandwidth >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_MAX_BANDWIDTH(cfg.max_bandwidth)) !=
            OPUS_OK) {
      LOGE("invalid max_bandwidth: %d", cfg.max_bandwidth);
      ok = false;
    }
    if (cfg.singal >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_SIGNAL(cfg.singal)) != OPUS_OK) {
      LOGE("invalid singal: %d", cfg.singal);
      ok = false;
    }
    if (cfg.inband_fec >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_INBAND_FEC(cfg.inband_fec)) != OPUS_OK) {
      LOGE("invalid inband_fec: %d", cfg.inband_fec);
      ok = false;
    }
    if (cfg.packet_loss_perc >= 0 &&
        opus_encoder_ctl(
            enc, OPUS_SET_PACKET_LOSS_PERC(cfg.packet_loss_perc)) != OPUS_OK) {
      LOGE("invalid pkt_loss: %d", cfg.packet_loss_perc);
      ok = false;
    }
    if (cfg.lsb_depth >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_LSB_DEPTH(cfg.lsb_depth)) != OPUS_OK) {
      LOGE("invalid lsb_depth: %d", cfg.lsb_depth);
      ok = false;
    }
    if (cfg.prediction_disabled >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_PREDICTION_DISABLED(
                                  cfg.prediction_disabled)) != OPUS_OK) {
      LOGE("invalid pred_disabled: %d", cfg.prediction_disabled);
      ok = false;
    }
    if (cfg.use_dtx >= 0 &&
        opus_encoder_ctl(enc, OPUS_SET_DTX(cfg.use_dtx)) != OPUS_OK) {
      LOGE("invalid use_dtx: %d", cfg.use_dtx);
      ok = false;
    }
    if (cfg.frame_sizes_ms_x2 > 0 &&
        opus_encoder_ctl(enc, OPUS_SET_EXPERT_FRAME_DURATION(
                                  cfg.frame_sizes_ms_x2)) != OPUS_OK) {
      LOGE("invalid frame_sizes_ms_x2: %d", cfg.frame_sizes_ms_x2);
      ok = false;
    }
    return ok;
  }
};
 
}  // namespace audio_tools