From 7498016107b8e264020a46c0f735bed82580438f Mon Sep 17 00:00:00 2001 From: Julian Daube Date: Tue, 22 Oct 2019 00:04:30 +0200 Subject: [PATCH] firmware: add equalizing commands bass boost (B) and treble boost (T) --- firmware/Include/bd3491.h | 4 ++-- firmware/Src/bd3491.c | 12 ++++++++++-- firmware/Src/message_parser.c | 15 ++++++++++++++- 3 files changed, 26 insertions(+), 5 deletions(-) diff --git a/firmware/Include/bd3491.h b/firmware/Include/bd3491.h index 1786a7b..2def415 100644 --- a/firmware/Include/bd3491.h +++ b/firmware/Include/bd3491.h @@ -20,9 +20,9 @@ int bd_set_gain(I2C_HandleTypeDef * handle, uint8_t gain_in_db); uint8_t bd_set_attenuation(I2C_HandleTypeDef * handle, uint8_t right_channel, uint8_t attenuation_in_db); // when gain == 0, cut bass boost -void bd_set_bass_boost(I2C_HandleTypeDef * handle, uint8_t gain); +uint8_t bd_set_bass_boost(I2C_HandleTypeDef * handle, uint8_t gain); // when gain == 0, cut treble boost -void bd_set_treble_boost(I2C_HandleTypeDef * handle, uint8_t gain); +uint8_t bd_set_treble_boost(I2C_HandleTypeDef * handle, uint8_t gain); enum BD_SOURROUND_GAIN { BD_SOURROUND_OFF = 0, diff --git a/firmware/Src/bd3491.c b/firmware/Src/bd3491.c index 7ff6e04..0cac892 100644 --- a/firmware/Src/bd3491.c +++ b/firmware/Src/bd3491.c @@ -70,13 +70,21 @@ uint8_t bd_set_attenuation(I2C_HandleTypeDef * handle, uint8_t right_channel, ui } // when gain == 0, cut bass boost -void bd_set_bass_boost(I2C_HandleTypeDef * handle, uint8_t gain) { +uint8_t bd_set_bass_boost(I2C_HandleTypeDef * handle, uint8_t gain) { + if (gain > 0x07) gain = 0x07; + bd_write_reg(handle, 0x51, (gain == 0)?(0x80):(0x00) | (gain&0x07) << 1); + + return gain; } // when gain == 0, cut treble boost -void bd_set_treble_boost(I2C_HandleTypeDef * handle, uint8_t gain) { +uint8_t bd_set_treble_boost(I2C_HandleTypeDef * handle, uint8_t gain) { + if (gain > 0x07) gain = 0x07; + bd_write_reg(handle, 0x57, (gain == 0)?(0x80):(0x00) | (gain&0x07) << 1); + + return gain; } void bd_set_sourround(I2C_HandleTypeDef * handle, enum BD_SOURROUND_GAIN gain) { diff --git a/firmware/Src/message_parser.c b/firmware/Src/message_parser.c index 85a11eb..d67e7ac 100644 --- a/firmware/Src/message_parser.c +++ b/firmware/Src/message_parser.c @@ -169,8 +169,21 @@ int parse_buffer() { } break; case 'B': - case 'T': + { + uint16_t boost; + if (next_arg_unsigned(&boost)) break; + printf("B%d\n", bd_set_bass_boost(&hi2c1, boost)); + } + break; + case 'T': + { + uint16_t boost; + if (next_arg_unsigned(&boost)) break; + + printf("T%d\n", bd_set_treble_boost(&hi2c1, boost)); + } + break; default: printf("E\n"); }