Skip to content

Commit

Permalink
Add extra controls for TDA7418
Browse files Browse the repository at this point in the history
  • Loading branch information
@WiseLord
WiseLord committed Apr 2, 2021
1 parent a53d9b7 commit 8149ee6
Show file tree
Hide file tree
Showing 2 changed files with 164 additions and 41 deletions.
204 changes: 164 additions & 40 deletions src/audio/tda7418.c
View file
Expand Up @@ -23,15 +23,18 @@
#define TDA7418_SOFTMUTE 0x0C
#define TDA7418_TESTING_AUDIO 0x0D

// Subaddress bits
// Subaddress
#define TDA7418_TESTING_MODE 0x80
#define TDA7418_AUTO_ZERO_REMAIN 0x40
#define TDA7418_AUTO_INC 0x20

// Input selector / gain bits
// 0: Input selector / gain bits
#define TDA7418_DIFFIN_MODE 0x80

// Loudness bits
// 1: Loudness
#define TDA7418_LOUDNESS_ATT_OFT 0
#define TDA7418_LOUD_FREQ_OFT 4

#define TDA7448_LOUD_ATTN_MASK 0x0F
#define TDA7448_LOUD_ATTN_MASK 0x0F
#define TDA7448_LOUD_FREQ_OFF 0x00
Expand All @@ -43,27 +46,39 @@
#define TDA7448_LOUD_SOFTSTEP_ON 0x00
#define TDA7448_LOUD_SOFTSTEP_OFF 0x80

// Treble bits
// 3: Treble
#define TDA7418_TREBLE_ATT_OFT 0
#define TDA7418_TREBLE_FREQ_OFT 5

#define TDA7418_TREBLE_CENTER_10K0 0x80
#define TDA7418_TREBLE_CENTER_12K5 0xA0
#define TDA7418_TREBLE_CENTER_15K0 0xC0
#define TDA7418_TREBLE_CENTER_17K5 0xE0

// Middle bits
// 4: Middle
#define TDA7418_MIDDLE_ATT_OFT 0
#define TDA7418_MIDDLE_QFACT_OFT 5

#define TDA7418_MIDDLE_Q_0P50 0x00
#define TDA7418_MIDDLE_Q_0P75 0x20
#define TDA7418_MIDDLE_Q_1P10 0x40
#define TDA7418_MIDDLE_Q_1P25 0x60
#define TDA7418_MIDDLE_SOFTSTEP_OFF 0x80

// Bass bits
// 5: Bass
#define TDA7418_BASS_ATT_OFT 0
#define TDA7418_BASS_QFACT_OFT 5

#define TDA7418_BASS_Q_1P00 0x00
#define TDA7418_BASS_Q_1P25 0x20
#define TDA7418_BASS_Q_1P50 0x40
#define TDA7418_BASS_Q_2P00 0x60
#define TDA7418_BASS_SOFTSTEP_OFF 0x80

// Middle/bass FC select
// 6: Middle/bass FC select
#define TDA7418_MIDDLE_FREQ_OFT 0
#define TDA7418_BASS_FREQ_OFT 2

#define TDA7418_MIDDLE_CENTER_0500 0x00
#define TDA7418_MIDDLE_CENTER_1000 0x01
#define TDA7418_MIDDLE_CENTER_1500 0x02
Expand All @@ -75,7 +90,7 @@
#define TDA7418_BASS_DC_MODE 0x10
#define TDA7418_BASS_SMOOTH_FILTER 0x20

// Softmute bits
// Softmute
#define TDA7418_SOFTMUTE_ON 0x00
#define TDA7418_SOFTMUTE_OFF 0x01
#define TDA7418_SOFTMUTE_OP48MS 0x00
Expand All @@ -87,6 +102,54 @@ static const AudioGrid gridToneBal = {NULL, -15, 15, (int8_t)(1.00 * STEP_MULT
static const AudioGrid gridSubwoofer = {NULL, -15, 0, (int8_t)(1.00 * STEP_MULT)}; // -15..0dB with 1dB step
static const AudioGrid gridGain = {NULL, 0, 15, (int8_t)(1.00 * STEP_MULT)}; // 0..15dB with 1dB step

static const int16_t arrBassCFreq[] = {
60 * STEP_MULT,
80 * STEP_MULT,
100 * STEP_MULT,
200 * STEP_MULT
};
static const AudioGrid adjustBassCFreq = {arrBassCFreq, 0, 3, 0};

static const int16_t arrBassQFact[] = {
1 * STEP_MULT,
1.25 * STEP_MULT,
1.5 * STEP_MULT,
2 * STEP_MULT
};
static const AudioGrid adjustBassQFact = {arrBassQFact, 0, 3, 0};

static const int16_t arrMiddleCFreqK[] = {
0.5 * STEP_MULT,
1 * STEP_MULT,
1.5 * STEP_MULT,
2.5 * STEP_MULT
};
static const AudioGrid adjustMiddleCFreqK = {arrMiddleCFreqK, 0, 3, 0};

static const int16_t arrMiddleQFact[] = {
0.5 * STEP_MULT,
0.75 * STEP_MULT,
1 * STEP_MULT,
1.25 * STEP_MULT
};
static const AudioGrid adjustMiddleQFact = {arrMiddleQFact, 0, 3, 0};

static const int16_t arrTrebleCFreqK[] = {
10 * STEP_MULT,
12.5 * STEP_MULT,
15 * STEP_MULT,
17.5 * STEP_MULT
};
static const AudioGrid adjustTrebleCFreqK = {arrTrebleCFreqK, 0, 3, 0};

static const int16_t arrLoudPeakFreq[] = {
0 * STEP_MULT,
400 * STEP_MULT,
800 * STEP_MULT,
2400 * STEP_MULT
};
static const AudioGrid adjustLoudPeakFreq = {arrLoudPeakFreq, 0, 3, 0};

static AudioParam *aPar;

static const AudioApi tda7418Api = {
Expand All @@ -96,14 +159,8 @@ static const AudioApi tda7418Api = {
.setInput = tda7418SetInput,

.setMute = tda7418SetMute,
.setLoudness = tda7418SetLoudness,
};

// TODO: make this adjustable
static const uint8_t bassQ = TDA7418_BASS_Q_2P00;
static const uint8_t middleQ = TDA7418_MIDDLE_Q_1P25;
static const uint8_t trebleCF = TDA7418_TREBLE_CENTER_12K5;

static void tda7418InputGain(int8_t input, int8_t gain)
{
i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
Expand Down Expand Up @@ -149,6 +206,85 @@ void tda7418Init(AudioParam *param)
aPar->grid[AUDIO_TUNE_SUBWOOFER] = &gridSubwoofer;
}
aPar->grid[AUDIO_TUNE_GAIN] = &gridGain;

aPar->grid[AUDIO_TUNE_LOUD_PEAK_FREQ] = &adjustLoudPeakFreq;
aPar->grid[AUDIO_TUNE_BASS_FREQ] = &adjustBassCFreq;
aPar->grid[AUDIO_TUNE_BASS_QUAL] = &adjustBassQFact;
aPar->grid[AUDIO_TUNE_MIDDLE_KFREQ] = &adjustMiddleCFreqK;
aPar->grid[AUDIO_TUNE_MIDDLE_QUAL] = &adjustMiddleQFact;
aPar->grid[AUDIO_TUNE_TREBLE_KFREQ] = &adjustTrebleCFreqK;
}

static void tda7418SetTrebleFilter(void)
{
int8_t value = (aPar->flags & AUDIO_FLAG_BYPASS) ? 0 : aPar->tune[AUDIO_TUNE_TREBLE];

uint8_t reg03 = (value > 0) ? (31 - value) : (15 + value);

reg03 <<= TDA7418_MIDDLE_ATT_OFT;
reg03 |= (aPar->tune[AUDIO_TUNE_TREBLE_KFREQ] < TDA7418_TREBLE_FREQ_OFT);
reg03 |= 0x80;

i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_TREBLE);
i2cSend(I2C_AMP, reg03);
i2cTransmit(I2C_AMP);
}

static void tda7418SetMiddleFilter(void)
{
int8_t value = (aPar->flags & AUDIO_FLAG_BYPASS) ? 0 : aPar->tune[AUDIO_TUNE_MIDDLE];

uint8_t reg04 = (value > 0) ? (31 - value) : (15 + value);

reg04 <<= TDA7418_MIDDLE_ATT_OFT;
reg04 |= (aPar->tune[AUDIO_TUNE_MIDDLE_QUAL] < TDA7418_MIDDLE_QFACT_OFT);

i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_MIDDLE);
i2cSend(I2C_AMP, reg04);
i2cTransmit(I2C_AMP);
}

static void tda7418SetBassFilter(void)
{
int8_t value = (aPar->flags & AUDIO_FLAG_BYPASS) ? 0 : aPar->tune[AUDIO_TUNE_BASS];

uint8_t reg05 = (value > 0) ? (31 - value) : (15 + value);

reg05 <<= TDA7418_BASS_ATT_OFT;
reg05 |= (aPar->tune[AUDIO_TUNE_BASS_QUAL] << TDA7418_BASS_QFACT_OFT);

i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_BASS);
i2cSend(I2C_AMP, reg05);
i2cTransmit(I2C_AMP);
}

static void tda7418SetMiddleBassFcFilter(void)
{
uint8_t reg06 = 0;

reg06 |= (aPar->tune[AUDIO_TUNE_BASS_FREQ] << TDA7418_BASS_FREQ_OFT);
reg06 |= (aPar->tune[AUDIO_TUNE_MIDDLE_KFREQ] << TDA7418_MIDDLE_FREQ_OFT);

i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_MID_BASS_FC_SELECT);
i2cSend(I2C_AMP, reg06);
i2cTransmit(I2C_AMP);
}

static void tda7418SetLoudness(void)
{
uint8_t reg01 = 0;

reg01 |= ((-aPar->tune[AUDIO_TUNE_LOUDNESS]) << TDA7418_LOUDNESS_ATT_OFT);
reg01 |= (aPar->tune[AUDIO_TUNE_LOUD_PEAK_FREQ] << TDA7418_LOUD_FREQ_OFT);

i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_LOUDNESS);
i2cSend(I2C_AMP, reg01);
i2cTransmit(I2C_AMP);
}

void tda7418SetTune(AudioTune tune, int8_t value)
Expand All @@ -161,22 +297,16 @@ void tda7418SetTune(AudioTune tune, int8_t value)
i2cTransmit(I2C_AMP);
break;
case AUDIO_TUNE_BASS:
i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_BASS);
i2cSend(I2C_AMP, (uint8_t)((value > 0 ? 31 - value : 15 + value) | bassQ));
i2cTransmit(I2C_AMP);
case AUDIO_TUNE_BASS_QUAL:
tda7418SetBassFilter();
break;
case AUDIO_TUNE_MIDDLE:
i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_MIDDLE);
i2cSend(I2C_AMP, (uint8_t)((value > 0 ? 31 - value : 15 + value) | middleQ));
i2cTransmit(I2C_AMP);
case AUDIO_TUNE_MIDDLE_QUAL:
tda7418SetMiddleFilter();
break;
case AUDIO_TUNE_TREBLE:
i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_TREBLE);
i2cSend(I2C_AMP, (uint8_t)((value > 0 ? 31 - value : 15 + value) | trebleCF));
i2cTransmit(I2C_AMP);
case AUDIO_TUNE_TREBLE_KFREQ:
tda7418SetTrebleFilter();
break;
case AUDIO_TUNE_FRONTREAR:
tda7418SetSpeakers();
Expand All @@ -190,6 +320,14 @@ void tda7418SetTune(AudioTune tune, int8_t value)
i2cSend(I2C_AMP, (uint8_t)(value > 0 ? value : 16 - value));
i2cTransmit(I2C_AMP);
break;
case AUDIO_TUNE_LOUDNESS:
case AUDIO_TUNE_LOUD_PEAK_FREQ:
tda7418SetLoudness();
break;
case AUDIO_TUNE_BASS_FREQ:
case AUDIO_TUNE_MIDDLE_KFREQ:
tda7418SetMiddleBassFcFilter();
break;
case AUDIO_TUNE_GAIN:
tda7418InputGain(aPar->input, value);
break;
Expand All @@ -210,17 +348,3 @@ void tda7418SetMute(bool value)
i2cSend(I2C_AMP, (uint8_t)(value ? TDA7418_SOFTMUTE_ON : TDA7418_SOFTMUTE_OFF));
i2cTransmit(I2C_AMP);
}

void tda7418SetLoudness(bool value)
{
uint8_t loudness = TDA7448_LOUD_ATTN_MASK & 10;

if (value) {
loudness |= TDA7448_LOUD_FREQ_800HZ | TDA7448_LOUD_SHAPE_HILO;
}

i2cBegin(I2C_AMP, TDA7418_I2C_ADDR);
i2cSend(I2C_AMP, TDA7418_LOUDNESS);
i2cSend(I2C_AMP, loudness);
i2cTransmit(I2C_AMP);
}
1 change: 0 additions & 1 deletion src/audio/tda7418.h
View file
Expand Up @@ -19,7 +19,6 @@ void tda7418Init(AudioParam *param);
void tda7418SetTune(AudioTune tune, int8_t value);
void tda7418SetInput(int8_t value);
void tda7418SetMute(bool value);
void tda7418SetLoudness(bool value);

#ifdef __cplusplus
extern "C" {
Expand Down

0 comments on commit 8149ee6

Please sign in to comment.