|  | @@ -9,43 +9,31 @@
 | 
	
		
			
				|  |  |   *  https://opensource.org/licenses/MIT
 | 
	
		
			
				|  |  |   *
 | 
	
		
			
				|  |  |   */
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | +
 | 
	
		
			
				|  |  |  #include <freertos/FreeRTOS.h>
 | 
	
		
			
				|  |  |  #include <freertos/task.h>
 | 
	
		
			
				|  |  |  #include <driver/i2s.h>
 | 
	
		
			
				|  |  |  #include "driver/i2c.h"
 | 
	
		
			
				|  |  |  #include "esp_log.h"
 | 
	
		
			
				|  |  | -#include "cJSON.h"
 | 
	
		
			
				|  |  | -#include "platform_config.h"
 | 
	
		
			
				|  |  |  #include "adac.h"
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  | +#define WM8978	0x1A	// for TTGO TAudio
 | 
	
		
			
				|  |  | +
 | 
	
		
			
				|  |  |  static const char TAG[] = "WM8978";
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  | -static void deinit(void) { }
 | 
	
		
			
				|  |  | -static void speaker(bool active);
 | 
	
		
			
				|  |  | -static void headset(bool active);
 | 
	
		
			
				|  |  | +static void speaker(bool active) { }
 | 
	
		
			
				|  |  | +static void headset(bool active) { }
 | 
	
		
			
				|  |  |  static bool volume(unsigned left, unsigned right) { return false; }
 | 
	
		
			
				|  |  |  static void power(adac_power_e mode);
 | 
	
		
			
				|  |  |  static bool init(char *config, int i2c_port_num, i2s_config_t *i2s_config);
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  | -static bool i2c_json_execute(char *set);
 | 
	
		
			
				|  |  | -static esp_err_t i2c_write_reg(uint8_t reg, uint16_t val);
 | 
	
		
			
				|  |  | -static uint16_t i2c_read_reg(uint8_t reg);
 | 
	
		
			
				|  |  | +static esp_err_t i2c_write_shadow(uint8_t reg, uint16_t val);
 | 
	
		
			
				|  |  | +static uint16_t i2c_read_shadow(uint8_t reg);
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  | -const struct adac_s dac_wm8978 = { "WM8978", init, deinit, power, speaker, headset, volume };
 | 
	
		
			
				|  |  | -static int i2c_port, i2c_addr;
 | 
	
		
			
				|  |  | -static cJSON *i2c_json;
 | 
	
		
			
				|  |  | -// default dac_controlset
 | 
	
		
			
				|  |  | -static char* default_controlset = "{\"init\": [ {\"reg\":0,\"val\":0},{\"reg\":4,\"val\":16},{\"reg\":6,\"val\":0},{\"reg\":10,\"val\":8},{\"reg\":43,\"val\":16},{\"reg\":49,\"val\":102} ], \"poweron\": [ {\"reg\":1,\"val\":11},{\"reg\":2,\"val\":384},{\"reg\":3,\"val\":111} ], \"poweroff\": [ {\"reg\":1,\"val\":0},{\"reg\":2,\"val\":0},{\"reg\":3,\"val\":0} ]}";
 | 
	
		
			
				|  |  | -/* Note: Device supports headset and speaker volume/mute, but jack
 | 
	
		
			
				|  |  | -//   insertion is conrolled internaly and not connected gpio on t-audio to monitor.
 | 
	
		
			
				|  |  | -//   (currently jack_handler mutes headset at all times) 
 | 
	
		
			
				|  |  | -//  "headseton": [ {"reg":52,"val":57},{"reg":53,"val":319} ], "headsetoff": [  {"reg":52,"val":121},{"reg":53,"val":383} ], "speakeron": [ {"reg":54,"val":57},{"reg":55,"val":319} ], "speakeroff": [ {"reg":54,"val":121},{"reg":55,"val":383} ]}"; 
 | 
	
		
			
				|  |  | -*/
 | 
	
		
			
				|  |  | +const struct adac_s dac_wm8978 = { "WM8978", init, adac_deinit, power, speaker, headset, volume };
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  |  // initiation table for non-readbale 9-bit i2c registers
 | 
	
		
			
				|  |  | -static uint16_t WM8978_REGVAL_TBL[58] =
 | 
	
		
			
				|  |  | -	{
 | 
	
		
			
				|  |  | +static uint16_t WM8978_REGVAL_TBL[58] =	{
 | 
	
		
			
				|  |  |  		0X0000, 0X0000, 0X0000, 0X0000, 0X0050, 0X0000, 0X0140, 0X0000,
 | 
	
		
			
				|  |  |  		0X0000, 0X0000, 0X0000, 0X00FF, 0X00FF, 0X0000, 0X0100, 0X00FF,
 | 
	
		
			
				|  |  |  		0X00FF, 0X0000, 0X012C, 0X002C, 0X002C, 0X002C, 0X002C, 0X0000,
 | 
	
	
		
			
				|  | @@ -53,50 +41,26 @@ static uint16_t WM8978_REGVAL_TBL[58] =
 | 
	
		
			
				|  |  |  		0X0038, 0X000B, 0X0032, 0X0000, 0X0008, 0X000C, 0X0093, 0X00E9,
 | 
	
		
			
				|  |  |  		0X0000, 0X0000, 0X0000, 0X0000, 0X0003, 0X0010, 0X0010, 0X0100,
 | 
	
		
			
				|  |  |  		0X0100, 0X0002, 0X0001, 0X0001, 0X0039, 0X0039, 0X0039, 0X0039,
 | 
	
		
			
				|  |  | -		0X0001, 0X0001};
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | +		0X0001, 0X0001
 | 
	
		
			
				|  |  | +};
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  |  /****************************************************************************************
 | 
	
		
			
				|  |  |   * init
 | 
	
		
			
				|  |  |   */
 | 
	
		
			
				|  |  | -static bool init(char *config, int i2c_port_num, i2s_config_t *i2s_config) {	 
 | 
	
		
			
				|  |  | -	char *p;	
 | 
	
		
			
				|  |  | -	i2c_port = i2c_port_num;
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	// configure i2c
 | 
	
		
			
				|  |  | -	i2c_config_t i2c_config = {
 | 
	
		
			
				|  |  | -			.mode = I2C_MODE_MASTER,
 | 
	
		
			
				|  |  | -			.sda_io_num = -1,
 | 
	
		
			
				|  |  | -			.sda_pullup_en = GPIO_PULLUP_ENABLE,
 | 
	
		
			
				|  |  | -			.scl_io_num = -1,
 | 
	
		
			
				|  |  | -			.scl_pullup_en = GPIO_PULLUP_ENABLE,
 | 
	
		
			
				|  |  | -			.master.clk_speed = 250000,
 | 
	
		
			
				|  |  | -		};
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -	if ((p = strcasestr(config, "i2c")) != NULL) i2c_addr = atoi(strchr(p, '=') + 1);
 | 
	
		
			
				|  |  | -	if ((p = strcasestr(config, "sda")) != NULL) i2c_config.sda_io_num = atoi(strchr(p, '=') + 1);
 | 
	
		
			
				|  |  | -	if ((p = strcasestr(config, "scl")) != NULL) i2c_config.scl_io_num = atoi(strchr(p, '=') + 1);
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -	p = config_alloc_get_str("dac_controlset", CONFIG_DAC_CONTROLSET, default_controlset);
 | 
	
		
			
				|  |  | -	i2c_json = cJSON_Parse(p);
 | 
	
		
			
				|  |  | +static bool init(char *config, int i2c_port, i2s_config_t *i2s_config) {	 
 | 
	
		
			
				|  |  | +	// TODO: maybe add something here to confirm it is actually detected? 
 | 
	
		
			
				|  |  | +	adac_init(config, i2c_port);
 | 
	
		
			
				|  |  |  	
 | 
	
		
			
				|  |  | -	if (!i2c_addr || !i2c_json || i2c_config.sda_io_num == -1 || i2c_config.scl_io_num == -1) {
 | 
	
		
			
				|  |  | -		if (p) free(p);
 | 
	
		
			
				|  |  | -		ESP_LOGW(TAG, "No i2c controlset found");
 | 
	
		
			
				|  |  | -		return true;
 | 
	
		
			
				|  |  | -	}	
 | 
	
		
			
				|  |  | +	ESP_LOGI(TAG, "WM8978 detected");
 | 
	
		
			
				|  |  | +
 | 
	
		
			
				|  |  | +	// init sequence
 | 
	
		
			
				|  |  | +	i2c_write_shadow(0, 0);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(4, 16);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(6, 0);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(10, 8);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(43, 16);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(49, 102);
 | 
	
		
			
				|  |  |  	
 | 
	
		
			
				|  |  | -	ESP_LOGI(TAG, "WM8978 uses IC2 @%d with sda:%d, scl:%d", i2c_addr, i2c_config.sda_io_num, i2c_config.scl_io_num);
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	// we have an I2C configured	
 | 
	
		
			
				|  |  | -	i2c_param_config(i2c_port, &i2c_config);
 | 
	
		
			
				|  |  | -	i2c_driver_install(i2c_port, I2C_MODE_MASTER, false, false, false);
 | 
	
		
			
				|  |  | -		
 | 
	
		
			
				|  |  | -	if (!i2c_json_execute("init")) {	
 | 
	
		
			
				|  |  | -		ESP_LOGE(TAG, "could not intialize DAC");
 | 
	
		
			
				|  |  | -		return false;
 | 
	
		
			
				|  |  | -	}	
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  |  	// Configure system clk to GPIO0 for DAC MCLK input
 | 
	
		
			
				|  |  |      ESP_LOGI(TAG, "Configuring MCLK on pin:%d", 0);
 | 
	
		
			
				|  |  |  	PIN_FUNC_SELECT(PERIPHS_IO_MUX_GPIO0_U, FUNC_GPIO0_CLK_OUT1);
 | 
	
	
		
			
				|  | @@ -109,96 +73,26 @@ static bool init(char *config, int i2c_port_num, i2s_config_t *i2s_config) {
 | 
	
		
			
				|  |  |   * power
 | 
	
		
			
				|  |  |   */
 | 
	
		
			
				|  |  |  static void power(adac_power_e mode) {
 | 
	
		
			
				|  |  | -	if (mode == ADAC_STANDBY || mode == ADAC_OFF) i2c_json_execute("poweroff");
 | 
	
		
			
				|  |  | -	else i2c_json_execute("poweron");
 | 
	
		
			
				|  |  | +	uint16_t *data, off[] = {0, 0, 0}, on[] = {11, 384, 111};
 | 
	
		
			
				|  |  | +	data = (mode == ADAC_STANDBY || mode == ADAC_OFF) ? off : on;
 | 
	
		
			
				|  |  | +	i2c_write_shadow(1, data[0]);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(2, data[1]);
 | 
	
		
			
				|  |  | +	i2c_write_shadow(3, data[2]);
 | 
	
		
			
				|  |  |  }
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  |  /****************************************************************************************
 | 
	
		
			
				|  |  | - * speaker
 | 
	
		
			
				|  |  | - */
 | 
	
		
			
				|  |  | -static void speaker(bool active) {
 | 
	
		
			
				|  |  | -	if (active) i2c_json_execute("speakeron");
 | 
	
		
			
				|  |  | -	else i2c_json_execute("speakeroff");
 | 
	
		
			
				|  |  | -} 
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -/****************************************************************************************
 | 
	
		
			
				|  |  | - * headset
 | 
	
		
			
				|  |  | - */
 | 
	
		
			
				|  |  | -static void headset(bool active) {
 | 
	
		
			
				|  |  | -	if (active) i2c_json_execute("headseton");
 | 
	
		
			
				|  |  | -	else i2c_json_execute("headsetoff");
 | 
	
		
			
				|  |  | -} 
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -/****************************************************************************************
 | 
	
		
			
				|  |  | - * 
 | 
	
		
			
				|  |  | - */
 | 
	
		
			
				|  |  | -bool i2c_json_execute(char *set) {
 | 
	
		
			
				|  |  | -	cJSON *json_set = cJSON_GetObjectItemCaseSensitive(i2c_json, set);
 | 
	
		
			
				|  |  | -	cJSON *item;
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -	if (!json_set) return true;
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	cJSON_ArrayForEach(item, json_set)
 | 
	
		
			
				|  |  | -	{
 | 
	
		
			
				|  |  | -		cJSON *reg = cJSON_GetObjectItemCaseSensitive(item, "reg");
 | 
	
		
			
				|  |  | -		cJSON *val = cJSON_GetObjectItemCaseSensitive(item, "val");
 | 
	
		
			
				|  |  | -		cJSON *mode = cJSON_GetObjectItemCaseSensitive(item, "mode");
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -		if (!reg || !val) continue;
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -		if (!mode) {
 | 
	
		
			
				|  |  | -			i2c_write_reg(reg->valueint, val->valueint);
 | 
	
		
			
				|  |  | -		} else if (!strcasecmp(mode->valuestring, "or")) {
 | 
	
		
			
				|  |  | -			uint16_t data = i2c_read_reg(reg->valueint);
 | 
	
		
			
				|  |  | -			data |= (uint16_t) val->valueint;
 | 
	
		
			
				|  |  | -			i2c_write_reg(reg->valueint, data);
 | 
	
		
			
				|  |  | -		} else if (!strcasecmp(mode->valuestring, "and")) {
 | 
	
		
			
				|  |  | -			uint16_t data = i2c_read_reg(reg->valueint);
 | 
	
		
			
				|  |  | -			data &= (uint16_t) val->valueint;
 | 
	
		
			
				|  |  | -			i2c_write_reg(reg->valueint, data);
 | 
	
		
			
				|  |  | -        }
 | 
	
		
			
				|  |  | -	}
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	return true;
 | 
	
		
			
				|  |  | -}	
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -/****************************************************************************************
 | 
	
		
			
				|  |  | - * 
 | 
	
		
			
				|  |  | + *  Write with custom reg/value structure
 | 
	
		
			
				|  |  |   */
 | 
	
		
			
				|  |  | -static esp_err_t i2c_write_reg(uint8_t reg, uint16_t val) {
 | 
	
		
			
				|  |  | -	esp_err_t ret;
 | 
	
		
			
				|  |  | -	uint8_t msb;
 | 
	
		
			
				|  |  | -	uint8_t lsb;
 | 
	
		
			
				|  |  | -    msb = (reg << 1) | ((val >> 8) & 0X01);
 | 
	
		
			
				|  |  | -    lsb = val & 0XFF;
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -    i2c_cmd_handle_t cmd = i2c_cmd_link_create();
 | 
	
		
			
				|  |  | -    i2c_master_start(cmd);
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	i2c_master_write_byte(cmd, (i2c_addr << 1) | I2C_MASTER_WRITE, I2C_MASTER_NACK);
 | 
	
		
			
				|  |  | -	i2c_master_write_byte(cmd, msb, I2C_MASTER_NACK);
 | 
	
		
			
				|  |  | -	i2c_master_write_byte(cmd, lsb, I2C_MASTER_NACK);
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	i2c_master_stop(cmd);
 | 
	
		
			
				|  |  | -    ret = i2c_master_cmd_begin(i2c_port, cmd, 100 / portTICK_RATE_MS);
 | 
	
		
			
				|  |  | -    i2c_cmd_link_delete(cmd);
 | 
	
		
			
				|  |  | -	
 | 
	
		
			
				|  |  | -	if (ret != ESP_OK) {
 | 
	
		
			
				|  |  | -		ESP_LOGW(TAG, "I2C write failed");
 | 
	
		
			
				|  |  | -	} else {
 | 
	
		
			
				|  |  | -		// update local register
 | 
	
		
			
				|  |  | -		WM8978_REGVAL_TBL[reg] = val;
 | 
	
		
			
				|  |  | -        ESP_LOGD(TAG, "I2C Write OK %d=%d (bytes %d %d)", reg, val, msb, lsb);
 | 
	
		
			
				|  |  | -    }
 | 
	
		
			
				|  |  | -    
 | 
	
		
			
				|  |  | -	return ret;
 | 
	
		
			
				|  |  | + static esp_err_t i2c_write_shadow(uint8_t reg, uint16_t val) {
 | 
	
		
			
				|  |  | +	WM8978_REGVAL_TBL[reg] = val;
 | 
	
		
			
				|  |  | +	reg = (reg << 1) | ((val >> 8) & 0x01);
 | 
	
		
			
				|  |  | +    val &= 0xff;  
 | 
	
		
			
				|  |  | +	return adac_write_byte(WM8978, reg, val);
 | 
	
		
			
				|  |  |  }
 | 
	
		
			
				|  |  |  
 | 
	
		
			
				|  |  |  /****************************************************************************************
 | 
	
		
			
				|  |  |   *  Return local register value
 | 
	
		
			
				|  |  |   */
 | 
	
		
			
				|  |  | -static uint16_t i2c_read_reg(uint8_t reg) {
 | 
	
		
			
				|  |  | +static uint16_t i2c_read_shadow(uint8_t reg) {
 | 
	
		
			
				|  |  |  	return WM8978_REGVAL_TBL[reg];
 | 
	
		
			
				|  |  |  }
 | 
	
		
			
				|  |  | -
 | 
	
		
			
				|  |  | -
 |