// SPDX-License-Identifier: GPL-2.0-only // // aw87390.c -- AW87390 ALSA SoC Audio driver // // Copyright (c) 2023 awinic Technology CO., LTD // // Author: Weidong Wang // #include #include #include #include #include "aw87390.h" #include "aw88395/aw88395_data_type.h" #include "aw88395/aw88395_device.h" static const struct regmap_config aw87390_remap_config = { .val_bits = 8, .reg_bits = 8, .max_register = AW87390_REG_MAX, .reg_format_endian = REGMAP_ENDIAN_LITTLE, .val_format_endian = REGMAP_ENDIAN_BIG, }; static int aw87390_dev_reg_update(struct aw_device *aw_dev, unsigned char *data, unsigned int len) { int i, ret; if (!data) { dev_err(aw_dev->dev, "data is NULL\n"); return -EINVAL; } for (i = 0; i < len-1; i += 2) { if (data[i] == AW87390_DELAY_REG_ADDR) { usleep_range(data[i + 1] * AW87390_REG_DELAY_TIME, data[i + 1] * AW87390_REG_DELAY_TIME + 10); continue; } ret = regmap_write(aw_dev->regmap, data[i], data[i + 1]); if (ret) return ret; } return 0; } static int aw87390_dev_get_prof_name(struct aw_device *aw_dev, int index, char **prof_name) { struct aw_prof_info *prof_info = &aw_dev->prof_info; struct aw_prof_desc *prof_desc; if ((index >= aw_dev->prof_info.count) || (index < 0)) { dev_err(aw_dev->dev, "index[%d] overflow count[%d]\n", index, aw_dev->prof_info.count); return -EINVAL; } prof_desc = &aw_dev->prof_info.prof_desc[index]; *prof_name = prof_info->prof_name_list[prof_desc->id]; return 0; } static int aw87390_dev_get_prof_data(struct aw_device *aw_dev, int index, struct aw_prof_desc **prof_desc) { if ((index >= aw_dev->prof_info.count) || (index < 0)) { dev_err(aw_dev->dev, "%s: index[%d] overflow count[%d]\n", __func__, index, aw_dev->prof_info.count); return -EINVAL; } *prof_desc = &aw_dev->prof_info.prof_desc[index]; return 0; } static int aw87390_dev_fw_update(struct aw_device *aw_dev) { struct aw_prof_desc *prof_index_desc; struct aw_sec_data_desc *sec_desc; char *prof_name; int ret; ret = aw87390_dev_get_prof_name(aw_dev, aw_dev->prof_index, &prof_name); if (ret) { dev_err(aw_dev->dev, "get prof name failed\n"); return -EINVAL; } dev_dbg(aw_dev->dev, "start update %s", prof_name); ret = aw87390_dev_get_prof_data(aw_dev, aw_dev->prof_index, &prof_index_desc); if (ret) { dev_err(aw_dev->dev, "aw87390_dev_get_prof_data failed\n"); return ret; } /* update reg */ sec_desc = prof_index_desc->sec_desc; ret = aw87390_dev_reg_update(aw_dev, sec_desc[AW88395_DATA_TYPE_REG].data, sec_desc[AW88395_DATA_TYPE_REG].len); if (ret) { dev_err(aw_dev->dev, "update reg failed\n"); return ret; } aw_dev->prof_cur = aw_dev->prof_index; return 0; } static int aw87390_power_off(struct aw_device *aw_dev) { int ret; if (aw_dev->status == AW87390_DEV_PW_OFF) { dev_dbg(aw_dev->dev, "already power off\n"); return 0; } ret = regmap_write(aw_dev->regmap, AW87390_SYSCTRL_REG, AW87390_POWER_DOWN_VALUE); if (ret) return ret; aw_dev->status = AW87390_DEV_PW_OFF; return 0; } static int aw87390_power_on(struct aw_device *aw_dev) { int ret; if (aw_dev->status == AW87390_DEV_PW_ON) { dev_dbg(aw_dev->dev, "already power on\n"); return 0; } if (!aw_dev->fw_status) { dev_err(aw_dev->dev, "fw not load\n"); return -EINVAL; } ret = regmap_write(aw_dev->regmap, AW87390_SYSCTRL_REG, AW87390_POWER_DOWN_VALUE); if (ret) return ret; ret = aw87390_dev_fw_update(aw_dev); if (ret) { dev_err(aw_dev->dev, "%s load profile failed\n", __func__); return ret; } aw_dev->status = AW87390_DEV_PW_ON; return 0; } static int aw87390_dev_set_profile_index(struct aw_device *aw_dev, int index) { if ((index >= aw_dev->prof_info.count) || (index < 0)) return -EINVAL; if (aw_dev->prof_index == index) return -EPERM; aw_dev->prof_index = index; return 0; } static int aw87390_profile_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) { struct snd_soc_component *codec = snd_kcontrol_chip(kcontrol); struct aw87390 *aw87390 = snd_soc_component_get_drvdata(codec); char *prof_name; int count, ret; uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; uinfo->count = 1; count = aw87390->aw_pa->prof_info.count; if (count <= 0) { uinfo->value.enumerated.items = 0; return 0; } uinfo->value.enumerated.items = count; if (uinfo->value.enumerated.item >= count) uinfo->value.enumerated.item = count - 1; count = uinfo->value.enumerated.item; ret = aw87390_dev_get_prof_name(aw87390->aw_pa, count, &prof_name); if (ret) { strscpy(uinfo->value.enumerated.name, "null"); return 0; } strscpy(uinfo->value.enumerated.name, prof_name); return 0; } static int aw87390_profile_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_component *codec = snd_kcontrol_chip(kcontrol); struct aw87390 *aw87390 = snd_soc_component_get_drvdata(codec); ucontrol->value.integer.value[0] = aw87390->aw_pa->prof_index; return 0; } static int aw87390_profile_set(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_component *codec = snd_kcontrol_chip(kcontrol); struct aw87390 *aw87390 = snd_soc_component_get_drvdata(codec); int ret; mutex_lock(&aw87390->lock); ret = aw87390_dev_set_profile_index(aw87390->aw_pa, ucontrol->value.integer.value[0]); if (ret) { dev_dbg(codec->dev, "profile index does not change\n"); mutex_unlock(&aw87390->lock); return 0; } if (aw87390->aw_pa->status == AW87390_DEV_PW_ON) { aw87390_power_off(aw87390->aw_pa); aw87390_power_on(aw87390->aw_pa); } mutex_unlock(&aw87390->lock); return 1; } static const struct snd_kcontrol_new aw87390_controls[] = { AW87390_PROFILE_EXT("AW87390 Profile Set", aw87390_profile_info, aw87390_profile_get, aw87390_profile_set), }; static int aw87390_request_firmware_file(struct aw87390 *aw87390) { const struct firmware *cont = NULL; int ret; aw87390->aw_pa->fw_status = AW87390_DEV_FW_FAILED; ret = request_firmware(&cont, AW87390_ACF_FILE, aw87390->aw_pa->dev); if (ret) return dev_err_probe(aw87390->aw_pa->dev, ret, "load [%s] failed!\n", AW87390_ACF_FILE); dev_dbg(aw87390->aw_pa->dev, "loaded %s - size: %zu\n", AW87390_ACF_FILE, cont ? cont->size : 0); aw87390->aw_cfg = devm_kzalloc(aw87390->aw_pa->dev, struct_size(aw87390->aw_cfg, data, cont->size), GFP_KERNEL); if (!aw87390->aw_cfg) { release_firmware(cont); return -ENOMEM; } aw87390->aw_cfg->len = cont->size; memcpy(aw87390->aw_cfg->data, cont->data, cont->size); release_firmware(cont); ret = aw88395_dev_load_acf_check(aw87390->aw_pa, aw87390->aw_cfg); if (ret) { dev_err(aw87390->aw_pa->dev, "load [%s] failed!\n", AW87390_ACF_FILE); return ret; } mutex_lock(&aw87390->lock); ret = aw88395_dev_cfg_load(aw87390->aw_pa, aw87390->aw_cfg); if (ret) dev_err(aw87390->aw_pa->dev, "aw_dev acf parse failed\n"); mutex_unlock(&aw87390->lock); return ret; } static int aw87390_drv_event(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); struct aw87390 *aw87390 = snd_soc_component_get_drvdata(component); struct aw_device *aw_dev = aw87390->aw_pa; int ret; switch (event) { case SND_SOC_DAPM_PRE_PMU: ret = aw87390_power_on(aw_dev); break; case SND_SOC_DAPM_POST_PMD: ret = aw87390_power_off(aw_dev); break; default: dev_err(aw_dev->dev, "%s: invalid event %d\n", __func__, event); ret = -EINVAL; } return ret; } static int aw87391_rgds_drv_event(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); struct aw87390 *aw87390 = snd_soc_component_get_drvdata(component); struct aw_device *aw_dev = aw87390->aw_pa; switch (event) { case SND_SOC_DAPM_PRE_PMU: if (!IS_ERR(aw87390->vdd_reg)) { if (regulator_enable(aw87390->vdd_reg)) dev_warn(aw_dev->dev, "Failed to enable vdd\n"); } break; case SND_SOC_DAPM_POST_PMU: regmap_write(aw_dev->regmap, AW87391_SYSCTRL_REG, AW87391_REG_VER_SEL_LOW | AW87391_REG_EN_ADAP | AW87391_REG_EN_2X | AW87391_EN_SPK | AW87391_EN_PA | AW87391_REG_EN_CP | AW87391_EN_SW); break; case SND_SOC_DAPM_PRE_PMD: regmap_write(aw_dev->regmap, AW87390_SYSCTRL_REG, AW87390_POWER_DOWN_VALUE); break; case SND_SOC_DAPM_POST_PMD: if (!IS_ERR(aw87390->vdd_reg)) { if (regulator_disable(aw87390->vdd_reg)) dev_warn(aw_dev->dev, "Failed to disable vdd\n"); } break; default: dev_err(aw_dev->dev, "%s: invalid event %d\n", __func__, event); return -EINVAL; } return 0; } static const struct snd_soc_dapm_widget aw87390_dapm_widgets[] = { SND_SOC_DAPM_INPUT("IN"), SND_SOC_DAPM_PGA_E("SPK PA", SND_SOC_NOPM, 0, 0, NULL, 0, aw87390_drv_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_OUTPUT("OUT"), }; static const struct snd_soc_dapm_widget aw87391_rgds_dapm_widgets[] = { SND_SOC_DAPM_INPUT("IN"), SND_SOC_DAPM_PGA_E("SPK PA", SND_SOC_NOPM, 0, 0, NULL, 0, aw87391_rgds_drv_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_OUTPUT("OUT"), }; static const struct snd_soc_dapm_route aw87390_dapm_routes[] = { { "SPK PA", NULL, "IN" }, { "OUT", NULL, "SPK PA" }, }; static int aw87390_codec_probe(struct snd_soc_component *component) { struct aw87390 *aw87390 = snd_soc_component_get_drvdata(component); int ret; ret = aw87390_request_firmware_file(aw87390); if (ret) return dev_err_probe(aw87390->aw_pa->dev, ret, "aw87390_request_firmware_file failed\n"); return 0; } /* * Firmware typically is used to load the sequence of init commands, * however for the Anbernic RG-DS we don't have a firmware file just * a list of registers and values. Most of these values are undocumented * in the AW87391 datasheet. */ static void aw87391_rgds_codec_init(struct aw87390 *aw87390) { struct aw_device *aw_dev = aw87390->aw_pa; /* Undocumented command per datasheet. */ regmap_write(aw_dev->regmap, 0x64, 0x3a); /* Bits 7:4 are undocumented but provided by manufacturer. */ regmap_write(aw_dev->regmap, AW87391_CP_REG, (5 << 4) | AW87391_REG_CP_OVP_8_50V); regmap_write(aw_dev->regmap, AW87391_AGCPO_REG, AW87391_AK1_S_016 | AW87391_AGC2PO_MW(500)); regmap_write(aw_dev->regmap, AW87391_AGC2PA_REG, AW87391_RK_S_20_48 | AW87391_AK2_S_41 | AW87391_AK2F_S_41); /* Undocumented commands per datasheet. */ regmap_write(aw_dev->regmap, 0x5d, 0x00); regmap_write(aw_dev->regmap, 0x5e, 0xb4); regmap_write(aw_dev->regmap, 0x5f, 0x30); regmap_write(aw_dev->regmap, 0x60, 0x39); regmap_write(aw_dev->regmap, 0x61, 0x10); regmap_write(aw_dev->regmap, 0x62, 0x03); regmap_write(aw_dev->regmap, 0x63, 0x7d); regmap_write(aw_dev->regmap, 0x65, 0xa0); regmap_write(aw_dev->regmap, 0x66, 0x21); regmap_write(aw_dev->regmap, 0x67, 0x41); regmap_write(aw_dev->regmap, 0x68, 0x3b); regmap_write(aw_dev->regmap, 0x6e, 0x00); regmap_write(aw_dev->regmap, 0x6f, 0x00); regmap_write(aw_dev->regmap, 0x70, 0x00); regmap_write(aw_dev->regmap, 0x71, 0x00); regmap_write(aw_dev->regmap, 0x72, 0x34); regmap_write(aw_dev->regmap, 0x73, 0x06); regmap_write(aw_dev->regmap, 0x74, 0x10); regmap_write(aw_dev->regmap, 0x75, 0x00); regmap_write(aw_dev->regmap, 0x7a, 0x00); regmap_write(aw_dev->regmap, 0x7b, 0x00); regmap_write(aw_dev->regmap, 0x7c, 0x00); regmap_write(aw_dev->regmap, 0x7d, 0x00); regmap_write(aw_dev->regmap, AW87391_PAG_REG, AW87391_GAIN_12DB); regmap_write(aw_dev->regmap, AW87391_SYSCTRL_REG, AW87391_EN_PA | AW87391_REG_EN_CP | AW87391_EN_SW); regmap_write(aw_dev->regmap, AW87391_SYSCTRL_REG, AW87391_REG_VER_SEL_LOW | AW87391_REG_EN_ADAP | AW87391_REG_EN_2X | AW87391_EN_SPK | AW87391_EN_PA | AW87391_REG_EN_CP | AW87391_EN_SW); regmap_write(aw_dev->regmap, AW87391_PAG_REG, AW87391_GAIN_15DB); } static int aw87391_rgds_codec_probe(struct snd_soc_component *component) { struct aw87390 *aw87390 = snd_soc_component_get_drvdata(component); aw87390->vdd_reg = devm_regulator_get_optional(aw87390->aw_pa->dev, "vdd"); if (IS_ERR(aw87390->vdd_reg) && PTR_ERR(aw87390->vdd_reg) != -ENODEV) return dev_err_probe(aw87390->aw_pa->dev, PTR_ERR(aw87390->vdd_reg), "Could not get vdd regulator\n"); aw87391_rgds_codec_init(aw87390); return 0; } static const struct snd_soc_component_driver soc_codec_dev_aw87390 = { .probe = aw87390_codec_probe, .dapm_widgets = aw87390_dapm_widgets, .num_dapm_widgets = ARRAY_SIZE(aw87390_dapm_widgets), .dapm_routes = aw87390_dapm_routes, .num_dapm_routes = ARRAY_SIZE(aw87390_dapm_routes), .controls = aw87390_controls, .num_controls = ARRAY_SIZE(aw87390_controls), }; static const struct snd_soc_component_driver soc_codec_dev_anbernic_rgds = { .probe = aw87391_rgds_codec_probe, .dapm_widgets = aw87391_rgds_dapm_widgets, .num_dapm_widgets = ARRAY_SIZE(aw87391_rgds_dapm_widgets), .dapm_routes = aw87390_dapm_routes, .num_dapm_routes = ARRAY_SIZE(aw87390_dapm_routes), }; static void aw87390_parse_channel_dt(struct aw87390 *aw87390) { struct aw_device *aw_dev = aw87390->aw_pa; struct device_node *np = aw_dev->dev->of_node; u32 channel_value = AW87390_DEV_DEFAULT_CH; of_property_read_u32(np, "awinic,audio-channel", &channel_value); aw_dev->channel = channel_value; } static int aw87390_init(struct aw87390 *aw87390, struct i2c_client *i2c, struct regmap *regmap) { struct aw_device *aw_dev; unsigned int chip_id; int ret; aw_dev = devm_kzalloc(&i2c->dev, sizeof(*aw_dev), GFP_KERNEL); if (!aw_dev) return -ENOMEM; /* read chip id */ ret = regmap_read(regmap, AW87390_ID_REG, &chip_id); if (ret) { dev_err(&i2c->dev, "%s read chipid error. ret = %d\n", __func__, ret); return ret; } switch (chip_id) { case AW87390_CHIP_ID: aw_dev->chip_id = AW87390_CHIP_ID; break; case AW87391_CHIP_ID: aw_dev->chip_id = AW87391_CHIP_ID; break; default: dev_err(&i2c->dev, "unsupported device\n"); return -ENXIO; } dev_dbg(&i2c->dev, "chip id = 0x%x\n", chip_id); aw87390->aw_pa = aw_dev; aw_dev->i2c = i2c; aw_dev->regmap = regmap; aw_dev->dev = &i2c->dev; aw_dev->acf = NULL; aw_dev->prof_info.prof_desc = NULL; aw_dev->prof_info.count = 0; aw_dev->prof_info.prof_type = AW88395_DEV_NONE_TYPE_ID; aw_dev->channel = AW87390_DEV_DEFAULT_CH; aw_dev->fw_status = AW87390_DEV_FW_FAILED; aw_dev->prof_index = AW87390_INIT_PROFILE; aw_dev->status = AW87390_DEV_PW_OFF; aw87390_parse_channel_dt(aw87390); return 0; } static int aw87390_i2c_probe(struct i2c_client *i2c) { struct aw87390 *aw87390; const struct snd_soc_component_driver *priv; int ret; ret = i2c_check_functionality(i2c->adapter, I2C_FUNC_I2C); if (!ret) return dev_err_probe(&i2c->dev, -ENXIO, "check_functionality failed\n"); aw87390 = devm_kzalloc(&i2c->dev, sizeof(*aw87390), GFP_KERNEL); if (!aw87390) return -ENOMEM; mutex_init(&aw87390->lock); i2c_set_clientdata(i2c, aw87390); aw87390->regmap = devm_regmap_init_i2c(i2c, &aw87390_remap_config); if (IS_ERR(aw87390->regmap)) return dev_err_probe(&i2c->dev, PTR_ERR(aw87390->regmap), "failed to init regmap\n"); /* aw pa init */ ret = aw87390_init(aw87390, i2c, aw87390->regmap); if (ret) return ret; ret = regmap_write(aw87390->regmap, AW87390_ID_REG, AW87390_SOFT_RESET_VALUE); if (ret) return ret; switch (aw87390->aw_pa->chip_id) { case AW87390_CHIP_ID: ret = devm_snd_soc_register_component(&i2c->dev, &soc_codec_dev_aw87390, NULL, 0); break; case AW87391_CHIP_ID: priv = of_device_get_match_data(&i2c->dev); if (!priv) return dev_err_probe(&i2c->dev, -EINVAL, "aw87391 not currently supported\n"); ret = devm_snd_soc_register_component(&i2c->dev, priv, NULL, 0); break; default: return -ENXIO; } if (ret) dev_err(&i2c->dev, "failed to register aw87390: %d\n", ret); return ret; } static const struct of_device_id aw87390_of_match[] = { { .compatible = "awinic,aw87390" }, { .compatible = "anbernic,rgds-amp", .data = &soc_codec_dev_anbernic_rgds }, {}, }; MODULE_DEVICE_TABLE(of, aw87390_of_match); static const struct i2c_device_id aw87390_i2c_id[] = { { AW87390_I2C_NAME }, { AW87391_I2C_NAME }, { } }; MODULE_DEVICE_TABLE(i2c, aw87390_i2c_id); static struct i2c_driver aw87390_i2c_driver = { .driver = { .name = AW87390_I2C_NAME, .of_match_table = of_match_ptr(aw87390_of_match), }, .probe = aw87390_i2c_probe, .id_table = aw87390_i2c_id, }; module_i2c_driver(aw87390_i2c_driver); MODULE_DESCRIPTION("ASoC AW87390 PA Driver"); MODULE_LICENSE("GPL v2");