/* * Rockchip machine ASoC driver for Rockchip Multi-codecs audio * * Copyright (C) 2018 Fuzhou Rockchip Electronics Co., Ltd * * Authors: Sugar Zhang , * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. * * This program is distributed in the hope it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define DRV_NAME "rk-multicodecs" #define WAIT_CARDS (SNDRV_CARDS - 1) #define DEFAULT_MCLK_FS 256 #define DAI_FMT_BASE (SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF) struct adc_keys_button { u32 voltage; u32 keycode; }; struct input_dev_poller { void (*poll)(struct input_dev *dev); unsigned int poll_interval_ms; struct input_dev *input; struct delayed_work work; }; struct multicodecs_data { struct snd_soc_card snd_card; struct snd_soc_dai_link dai_link[3]; struct snd_soc_jack *jack_headset; struct gpio_desc *hp_ctl_gpio; struct gpio_desc *spk_ctl_gpio; struct gpio_desc *hp_det_gpio; struct iio_channel *adc; struct extcon_dev *extcon; struct delayed_work handler; unsigned int mclk_fs; unsigned int *mclk_fs_map; bool codec_hp_det; u32 num_keys; u32 last_key; u32 keyup_voltage; u32 pre_poweron_delayms; u32 post_powerdown_delayms; const struct adc_keys_button *map; struct input_dev *input; struct input_dev_poller *poller; int slots; int slot_width; unsigned int tx_slot_mask; unsigned int rx_slot_mask; }; static unsigned int headset_extcon_cable[] = { EXTCON_NONE, EXTCON_NONE, EXTCON_NONE, }; static void mc_set_poll_interval(struct input_dev_poller *poller, unsigned int interval) { if (poller) poller->poll_interval_ms = interval; } static void mc_keys_poller_queue_work(struct input_dev_poller *poller) { unsigned long delay; delay = msecs_to_jiffies(poller->poll_interval_ms); if (delay >= HZ) delay = round_jiffies_relative(delay); queue_delayed_work(system_freezable_wq, &poller->work, delay); } static void mc_keys_poller_work(struct work_struct *work) { struct input_dev_poller *poller = container_of(work, struct input_dev_poller, work.work); poller->poll(poller->input); mc_keys_poller_queue_work(poller); } static void mc_keys_poller_start(struct input_dev_poller *poller) { if (poller->poll_interval_ms > 0) { poller->poll(poller->input); mc_keys_poller_queue_work(poller); } } static void mc_keys_poller_stop(struct input_dev_poller *poller) { cancel_delayed_work_sync(&poller->work); } static int mc_keys_setup_polling(struct multicodecs_data *mc_data, void (*poll_fn)(struct input_dev *dev)) { struct input_dev_poller *poller; poller = devm_kzalloc(mc_data->snd_card.dev, sizeof(*poller), GFP_KERNEL); if (!poller) return -ENOMEM; INIT_DELAYED_WORK(&poller->work, mc_keys_poller_work); poller->input = mc_data->input; poller->poll = poll_fn; mc_data->poller = poller; return 0; } static void mc_keys_poll(struct input_dev *input) { struct multicodecs_data *mc_data = input_get_drvdata(input); int i, value, ret; u32 diff, closest = 0xffffffff; int keycode = 0; ret = iio_read_channel_processed(mc_data->adc, &value); if (unlikely(ret < 0)) { /* Forcibly release key if any was pressed */ value = mc_data->keyup_voltage; } else { for (i = 0; i < mc_data->num_keys; i++) { diff = abs(mc_data->map[i].voltage - value); if (diff < closest) { closest = diff; keycode = mc_data->map[i].keycode; } } } if (abs(mc_data->keyup_voltage - value) < closest) keycode = 0; if (mc_data->last_key && mc_data->last_key != keycode) input_report_key(input, mc_data->last_key, 0); if (keycode) input_report_key(input, keycode, 1); input_sync(input); mc_data->last_key = keycode; } static int mc_keys_load_keymap(struct device *dev, struct multicodecs_data *mc_data) { struct adc_keys_button *map; struct fwnode_handle *child; int i = 0; mc_data->num_keys = device_get_child_node_count(dev); if (mc_data->num_keys == 0) { dev_err(dev, "keymap is missing\n"); return -EINVAL; } map = devm_kmalloc_array(dev, mc_data->num_keys, sizeof(*map), GFP_KERNEL); if (!map) return -ENOMEM; device_for_each_child_node(dev, child) { if (fwnode_property_read_u32(child, "press-threshold-microvolt", &map[i].voltage)) { dev_err(dev, "Key with invalid or missing voltage\n"); fwnode_handle_put(child); return -EINVAL; } map[i].voltage /= 1000; if (fwnode_property_read_u32(child, "linux,code", &map[i].keycode)) { dev_err(dev, "Key with invalid or missing linux,code\n"); fwnode_handle_put(child); return -EINVAL; } i++; } mc_data->map = map; return 0; } static void adc_jack_handler(struct work_struct *work) { struct multicodecs_data *mc_data = container_of(to_delayed_work(work), struct multicodecs_data, handler); struct snd_soc_jack *jack_headset = mc_data->jack_headset; int adc, ret = 0; if (!gpiod_get_value(mc_data->hp_det_gpio)) { snd_soc_jack_report(jack_headset, 0, SND_JACK_HEADSET); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_HEADPHONE, false); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_MICROPHONE, false); if (mc_data->poller) mc_keys_poller_stop(mc_data->poller); return; } if (!mc_data->adc) { /* no ADC, so is headphone */ snd_soc_jack_report(jack_headset, SND_JACK_HEADPHONE, SND_JACK_HEADSET); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_HEADPHONE, true); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_MICROPHONE, false); return; } ret = iio_read_channel_processed(mc_data->adc, &adc); if (ret < 0) { /* failed to read ADC, so assume headphone */ snd_soc_jack_report(jack_headset, SND_JACK_HEADPHONE, SND_JACK_HEADSET); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_HEADPHONE, true); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_MICROPHONE, false); } else { snd_soc_jack_report(jack_headset, snd_soc_jack_get_type(jack_headset, adc), SND_JACK_HEADSET); extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_HEADPHONE, true); if (snd_soc_jack_get_type(jack_headset, adc) == SND_JACK_HEADSET) { extcon_set_state_sync(mc_data->extcon, EXTCON_JACK_MICROPHONE, true); if (mc_data->poller) mc_keys_poller_start(mc_data->poller); } } }; static irqreturn_t headset_det_irq_thread(int irq, void *data) { struct multicodecs_data *mc_data = (struct multicodecs_data *)data; queue_delayed_work(system_power_efficient_wq, &mc_data->handler, msecs_to_jiffies(200)); return IRQ_HANDLED; }; static int mc_hp_event(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { struct snd_soc_card *card = w->dapm->card; struct multicodecs_data *mc_data = snd_soc_card_get_drvdata(card); switch (event) { case SND_SOC_DAPM_POST_PMU: if (mc_data->pre_poweron_delayms) msleep(mc_data->pre_poweron_delayms); gpiod_set_value_cansleep(mc_data->hp_ctl_gpio, 1); break; case SND_SOC_DAPM_PRE_PMD: gpiod_set_value_cansleep(mc_data->hp_ctl_gpio, 0); if (mc_data->post_powerdown_delayms) msleep(mc_data->post_powerdown_delayms); break; default: return 0; } return 0; } static int mc_spk_event(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { struct snd_soc_card *card = w->dapm->card; struct multicodecs_data *mc_data = snd_soc_card_get_drvdata(card); switch (event) { case SND_SOC_DAPM_POST_PMU: if (mc_data->pre_poweron_delayms) msleep(mc_data->pre_poweron_delayms); gpiod_set_value_cansleep(mc_data->spk_ctl_gpio, 1); break; case SND_SOC_DAPM_PRE_PMD: gpiod_set_value_cansleep(mc_data->spk_ctl_gpio, 0); if (mc_data->post_powerdown_delayms) msleep(mc_data->post_powerdown_delayms); break; default: return 0; } return 0; } static const struct snd_soc_dapm_widget mc_dapm_widgets[] = { SND_SOC_DAPM_HP("Headphone", mc_hp_event), SND_SOC_DAPM_SPK("Speaker", mc_spk_event), SND_SOC_DAPM_LINE("Line Out Jack", NULL), SND_SOC_DAPM_LINE("Line In Jack", NULL), SND_SOC_DAPM_MIC("Main Mic", NULL), SND_SOC_DAPM_MIC("Headset Mic", NULL), SND_SOC_DAPM_SUPPLY("Speaker Power", SND_SOC_NOPM, 0, 0, NULL, 0), SND_SOC_DAPM_SUPPLY("Headphone Power", SND_SOC_NOPM, 0, 0, NULL, 0), }; static int mc_switch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_card *card = snd_kcontrol_chip(kcontrol); struct multicodecs_data *mc_data = snd_soc_card_get_drvdata(card); struct soc_mixer_control *mc = (struct soc_mixer_control *)kcontrol->private_value; struct gpio_desc *gpio = mc->reg == 1 ? mc_data->hp_ctl_gpio : mc_data->spk_ctl_gpio; ucontrol->value.integer.value[0] = gpiod_get_value_cansleep(gpio); return 0; } static int mc_switch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_card *card = snd_kcontrol_chip(kcontrol); struct multicodecs_data *mc_data = snd_soc_card_get_drvdata(card); struct soc_mixer_control *mc = (struct soc_mixer_control *)kcontrol->private_value; struct gpio_desc *gpio = mc->reg == 1 ? mc_data->hp_ctl_gpio : mc_data->spk_ctl_gpio; gpiod_set_value_cansleep(gpio, ucontrol->value.integer.value[0] ? 1 : 0); return 0; } static const struct snd_kcontrol_new mc_controls[] = { SOC_SINGLE_EXT("spk switch", 0, 0, 1, 0, mc_switch_get, mc_switch_put), SOC_SINGLE_EXT("hp switch", 1, 0, 1, 0, mc_switch_get, mc_switch_put), SOC_DAPM_PIN_SWITCH("Headphone"), SOC_DAPM_PIN_SWITCH("Speaker"), SOC_DAPM_PIN_SWITCH("Main Mic"), SOC_DAPM_PIN_SWITCH("Headset Mic"), }; static int rk_multicodecs_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params) { struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); struct snd_soc_dai *codec_dai; struct multicodecs_data *mc_data = snd_soc_card_get_drvdata(rtd->card); unsigned int mclk; unsigned int codec_mclk; int ret, i; mclk = params_rate(params) * mc_data->mclk_fs; for_each_rtd_codec_dais(rtd, i, codec_dai) { if (mc_data->mclk_fs_map[i] > 0) codec_mclk = params_rate(params) * mc_data->mclk_fs_map[i]; else codec_mclk = mclk; ret = snd_soc_dai_set_sysclk(codec_dai, substream->stream, codec_mclk, SND_SOC_CLOCK_IN); if (ret && ret != -ENOTSUPP) { pr_err("Set codec_dai sysclk(%uHZ) failed: %d\n", codec_mclk, ret); goto out; } } ret = snd_soc_dai_set_sysclk(cpu_dai, substream->stream, mclk, SND_SOC_CLOCK_OUT); if (ret && ret != -ENOTSUPP) { pr_err("Set cpu_dai sysclk(%uHZ) failed: %d\n", mclk, ret); goto out; } return 0; out: return ret; } static int rk_dailink_init(struct snd_soc_pcm_runtime *rtd) { struct multicodecs_data *mc_data = snd_soc_card_get_drvdata(rtd->card); struct snd_soc_card *card = rtd->card; struct snd_soc_jack *jack_headset; struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); struct snd_soc_dai *codec_dai; int ret, irq, i; struct snd_soc_jack_pin *pins; struct snd_soc_jack_zone *zones; struct snd_soc_jack_pin jack_pins[] = { { .pin = "Headphone", .mask = SND_JACK_HEADPHONE, }, { .pin = "Headset Mic", .mask = SND_JACK_MICROPHONE, }, }; struct snd_soc_jack_zone headset_zones[] = { { .min_mv = 0, .max_mv = 222, .jack_type = SND_JACK_HEADPHONE, }, { .min_mv = 223, .max_mv = 1500, .jack_type = SND_JACK_HEADSET, }, { .min_mv = 1501, .max_mv = UINT_MAX, .jack_type = SND_JACK_HEADPHONE, } }; if (mc_data->slots) { ret = snd_soc_dai_set_tdm_slot(cpu_dai, mc_data->tx_slot_mask, mc_data->rx_slot_mask, mc_data->slots, mc_data->slot_width); if (ret && ret != -ENOTSUPP) { dev_err(card->dev, "cpu_dai: set_tdm_slot error\n"); return ret; } for_each_rtd_codec_dais(rtd, i, codec_dai) { ret = snd_soc_dai_set_tdm_slot(codec_dai, mc_data->tx_slot_mask, mc_data->rx_slot_mask, mc_data->slots, mc_data->slot_width); if (ret && ret != -ENOTSUPP) { dev_err(card->dev, "codec_dai: set_tdm_slot error\n"); return ret; } } } if ((!mc_data->codec_hp_det) && (gpiod_to_irq(mc_data->hp_det_gpio) < 0)) { dev_info(card->dev, "Don't need to map headset detect gpio to irq\n"); return 0; } jack_headset = devm_kzalloc(card->dev, sizeof(*jack_headset), GFP_KERNEL); if (!jack_headset) return -ENOMEM; pins = devm_kmemdup(card->dev, jack_pins, sizeof(*jack_pins) * ARRAY_SIZE(jack_pins), GFP_KERNEL); if (!pins) return -ENOMEM; zones = devm_kmemdup(card->dev, headset_zones, sizeof(*headset_zones) * ARRAY_SIZE(headset_zones), GFP_KERNEL); if (!zones) return -ENOMEM; ret = snd_soc_card_jack_new_pins(card, "Headset", SND_JACK_HEADSET, jack_headset, pins, ARRAY_SIZE(jack_pins)); if (ret) return ret; ret = snd_soc_jack_add_zones(jack_headset, ARRAY_SIZE(headset_zones), zones); if (ret) return ret; mc_data->jack_headset = jack_headset; if (mc_data->codec_hp_det) { struct snd_soc_dai *codec_dai; int i; /* set jack for the first successful one */ for_each_rtd_codec_dais(rtd, i, codec_dai) { ret = snd_soc_component_set_jack(codec_dai->component, jack_headset, NULL); if (ret >= 0) break; } } else { irq = gpiod_to_irq(mc_data->hp_det_gpio); if (irq >= 0) { ret = devm_request_threaded_irq(card->dev, irq, NULL, headset_det_irq_thread, IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, "headset_detect", mc_data); if (ret) { dev_err(card->dev, "Failed to request headset detect irq"); return ret; } } } return 0; } static int rk_multicodecs_parse_daifmt(struct device_node *node, struct device_node *codec, struct multicodecs_data *mc_data, const char *prefix) { struct snd_soc_dai_link *dai_link = &mc_data->dai_link[0]; struct device_node *bitclkmaster = NULL; struct device_node *framemaster = NULL; unsigned int daifmt; daifmt = snd_soc_daifmt_parse_format(node, prefix); snd_soc_daifmt_parse_clock_provider_as_phandle(node, prefix, &bitclkmaster, &framemaster); if (!bitclkmaster && !framemaster) { /* * No dai-link level and master setting was not found from * sound node level, revert back to legacy DT parsing and * take the settings from codec node. */ pr_debug("%s: Revert to legacy daifmt parsing\n", __func__); daifmt |= snd_soc_daifmt_parse_clock_provider_as_flag(codec, NULL); } else { daifmt |= snd_soc_daifmt_clock_provider_from_bitmap( ((codec == bitclkmaster) << 4) | (codec == framemaster)); } /* * If there is NULL format means that the format isn't specified, we * need to set i2s format by default. */ if (!(daifmt & SND_SOC_DAIFMT_FORMAT_MASK)) daifmt |= SND_SOC_DAIFMT_I2S; dai_link->dai_fmt = daifmt; of_node_put(bitclkmaster); of_node_put(framemaster); return 0; } static int wait_locked_card(struct device_node *np, struct device *dev) { char *propname = "rockchip,wait-card-locked"; u32 cards[WAIT_CARDS]; int num; int ret; #ifndef MODULE int i; #endif ret = of_property_count_u32_elems(np, propname); if (ret < 0) { if (ret == -EINVAL) { /* * -EINVAL means the property does not exist, this is * fine. */ return 0; } dev_err(dev, "Property '%s' elems could not be read: %d\n", propname, ret); return ret; } num = ret; if (num > WAIT_CARDS) num = WAIT_CARDS; ret = of_property_read_u32_array(np, propname, cards, num); if (ret < 0) { if (ret == -EINVAL) { /* * -EINVAL means the property does not exist, this is * fine. */ return 0; } dev_err(dev, "Property '%s' could not be read: %d\n", propname, ret); return ret; } ret = 0; #ifndef MODULE for (i = 0; i < num; i++) { if (!snd_card_locked(cards[i])) { dev_warn(dev, "card: %d has not been locked, re-probe again\n", cards[i]); ret = -EPROBE_DEFER; break; } } #endif return ret; } static struct snd_soc_ops rk_ops = { .hw_params = rk_multicodecs_hw_params, }; SND_SOC_DAILINK_DEFS(hifi, DAILINK_COMP_ARRAY(COMP_EMPTY()), DAILINK_COMP_ARRAY(COMP_EMPTY()), DAILINK_COMP_ARRAY(COMP_EMPTY())); SND_SOC_DAILINK_DEFS(hifi_fe, DAILINK_COMP_ARRAY(COMP_EMPTY()), DAILINK_COMP_ARRAY(COMP_DUMMY()), DAILINK_COMP_ARRAY(COMP_EMPTY())); SND_SOC_DAILINK_DEFS(hifi_be, DAILINK_COMP_ARRAY(COMP_EMPTY()), DAILINK_COMP_ARRAY(COMP_EMPTY()), DAILINK_COMP_ARRAY(COMP_DUMMY())); static const struct snd_soc_dai_link rk_multicodecs_card_dai[] = { /* Default ASoC DAI Link*/ { .name = "HiFi", .stream_name = "HiFi", .ops = &rk_ops, SND_SOC_DAILINK_REG(hifi), }, /* DPCM Link between Front-End and Back-End (Optional) */ { .name = "HiFi-ASRC-FE", .stream_name = "HiFi-ASRC-FE", .dpcm_playback = 1, .dpcm_capture = 1, .dynamic = 1, SND_SOC_DAILINK_REG(hifi_fe), }, { .name = "HiFi-ASRC-BE", .stream_name = "HiFi-ASRC-BE", .ops = &rk_ops, .dpcm_playback = 1, .dpcm_capture = 1, .no_pcm = 1, SND_SOC_DAILINK_REG(hifi_be), }, }; static int rk_multicodecs_probe_keys(struct platform_device *pdev, struct multicodecs_data *mc_data) { struct input_dev *input; int ret = 0, i = 0, value = 0; if (IS_ERR_OR_NULL(mc_data) || IS_ERR_OR_NULL(mc_data->adc)) return -EINVAL; if (IS_ERR_OR_NULL(pdev)) return -EINVAL; if (mc_data->adc->channel->type != IIO_VOLTAGE) return -EINVAL; if (device_property_read_u32(&pdev->dev, "keyup-threshold-microvolt", &mc_data->keyup_voltage)) { dev_warn(&pdev->dev, "Invalid or missing keyup voltage\n"); return -EINVAL; } mc_data->keyup_voltage /= 1000; ret = mc_keys_load_keymap(&pdev->dev, mc_data); if (ret) return ret; input = devm_input_allocate_device(&pdev->dev); if (IS_ERR(input)) { dev_err(&pdev->dev, "Failed to allocate input device\n"); return PTR_ERR(input); } input_set_drvdata(input, mc_data); input->name = "headset-keys"; input->phys = "headset-keys/input0"; input->id.bustype = BUS_HOST; input->id.vendor = 0x0001; input->id.product = 0x0001; input->id.version = 0x0100; __set_bit(EV_KEY, input->evbit); for (i = 0; i < mc_data->num_keys; i++) __set_bit(mc_data->map[i].keycode, input->keybit); if (device_property_read_bool(&pdev->dev, "autorepeat")) __set_bit(EV_REP, input->evbit); mc_data->input = input; ret = mc_keys_setup_polling(mc_data, mc_keys_poll); if (ret) { dev_err(&pdev->dev, "Failed to set up polling: %d\n", ret); return ret; } if (!device_property_read_u32(&pdev->dev, "poll-interval", &value)) mc_set_poll_interval(mc_data->poller, value); ret = input_register_device(mc_data->input); if (ret) { dev_err(&pdev->dev, "Failed to register input device: %d\n", ret); return ret; } return ret; } static int rk_multicodecs_resume_post(struct snd_soc_card *card) { struct multicodecs_data *mc_data = dev_get_drvdata(card->dev); if (gpiod_to_irq(mc_data->hp_det_gpio) >= 0) queue_delayed_work(system_power_efficient_wq, &mc_data->handler, msecs_to_jiffies(200)); return 0; } static int rk_multicodecs_probe(struct platform_device *pdev) { struct snd_soc_card *card; struct device_node *np = pdev->dev.of_node, *node, *asrc_np; struct snd_soc_dai_link_component *codecs; struct multicodecs_data *mc_data; struct of_phandle_args args; unsigned int *map; u32 val; int count, irq; int ret = 0, i = 0, idx = 0; const char *prefix = "rockchip,"; int cable = 0; ret = wait_locked_card(np, &pdev->dev); if (ret < 0) { dev_err(&pdev->dev, "check_lock_card failed: %d\n", ret); return ret; } mc_data = devm_kzalloc(&pdev->dev, sizeof(*mc_data), GFP_KERNEL); if (!mc_data) return -ENOMEM; memcpy(mc_data->dai_link, rk_multicodecs_card_dai, sizeof(mc_data->dai_link)); card = &mc_data->snd_card; card->dev = &pdev->dev; /* Parse the card name from DT */ ret = snd_soc_of_parse_card_name(card, "rockchip,card-name"); if (ret < 0) return ret; mc_data->dai_link[0].name = "dailink-multicodecs"; mc_data->dai_link[0].stream_name = mc_data->dai_link[0].name; mc_data->dai_link[0].init = rk_dailink_init; mc_data->dai_link[0].ops = &rk_ops; mc_data->dai_link[0].num_cpus = 1; mc_data->dai_link[0].num_platforms = 1; mc_data->dai_link[0].ignore_pmdown_time = 1; card->dai_link = mc_data->dai_link; card->num_links = 1; card->dapm_widgets = mc_dapm_widgets; card->num_dapm_widgets = ARRAY_SIZE(mc_dapm_widgets); card->controls = mc_controls; card->num_controls = ARRAY_SIZE(mc_controls); card->num_aux_devs = 0; count = of_count_phandle_with_args(np, "rockchip,codec", NULL); if (count < 0) return -EINVAL; /* refine codecs, remove unavailable node */ for (i = 0; i < count; i++) { node = of_parse_phandle(np, "rockchip,codec", i); if (!node) return -ENODEV; if (of_device_is_available(node)) idx++; } if (!idx) return -ENODEV; codecs = devm_kcalloc(&pdev->dev, idx, sizeof(*codecs), GFP_KERNEL); if (!codecs) return -ENOMEM; mc_data->dai_link[0].codecs = codecs; mc_data->dai_link[0].num_codecs = idx; idx = 0; for (i = 0; i < count; i++) { node = of_parse_phandle(np, "rockchip,codec", i); if (!node) return -ENODEV; if (!of_device_is_available(node)) continue; ret = of_parse_phandle_with_fixed_args(np, "rockchip,codec", 0, i, &args); if (ret) return ret; codecs[idx].of_node = node; ret = snd_soc_get_dai_name(&args, &codecs[idx].dai_name); if (ret) return ret; idx++; } /* Only reference the codecs[0].of_node which maybe as master. */ rk_multicodecs_parse_daifmt(np, codecs[0].of_node, mc_data, prefix); mc_data->dai_link[0].cpus->of_node = of_parse_phandle(np, "rockchip,cpu", 0); if (!mc_data->dai_link[0].cpus->of_node) return -ENODEV; mc_data->dai_link[0].platforms->of_node = mc_data->dai_link[0].cpus->of_node; ret = snd_soc_of_parse_tdm_slot(np, &mc_data->tx_slot_mask, &mc_data->rx_slot_mask, &mc_data->slots, &mc_data->slot_width); if (ret < 0) { dev_err(&pdev->dev, "snd_soc_of_parse_tdm_slot failed: %d\n", ret); return ret; } asrc_np = of_parse_phandle(np, "rockchip,asrc", 0); if (asrc_np) { mc_data->dai_link[1].cpus->of_node = asrc_np; mc_data->dai_link[1].platforms->of_node = asrc_np; mc_data->dai_link[1].num_cpus = 1; mc_data->dai_link[1].num_platforms = 1; /* Support multicodec in future */ mc_data->dai_link[2].codecs->dai_name = "dummy_codec"; mc_data->dai_link[2].codecs->of_node = of_parse_phandle(np, "rockchip,codec", 0); mc_data->dai_link[2].cpus->of_node = mc_data->dai_link[0].cpus->of_node; card->num_links = 3; } map = devm_kcalloc(&pdev->dev, count, sizeof(*map), GFP_KERNEL); if (!map) return -ENOMEM; ret = of_property_read_u32_array(np, "rockchip,mclk-fs-mapping", map, count); if (ret) memset(map, 0x0, sizeof(*map) * count); mc_data->mclk_fs_map = map; mc_data->mclk_fs = DEFAULT_MCLK_FS; if (!of_property_read_u32(np, "rockchip,mclk-fs", &val)) mc_data->mclk_fs = val; if (!of_property_read_u32(np, "rockchip,pre-power-on-delay-ms", &val)) mc_data->pre_poweron_delayms = val; if (!of_property_read_u32(np, "rockchip,post-power-down-delay-ms", &val)) mc_data->post_powerdown_delayms = val; mc_data->codec_hp_det = of_property_read_bool(np, "rockchip,codec-hp-det"); mc_data->adc = devm_iio_channel_get(&pdev->dev, "adc-detect"); if (IS_ERR(mc_data->adc)) { if (PTR_ERR(mc_data->adc) == -EPROBE_DEFER) { dev_warn(&pdev->dev, "deferred by saradc not ready\n"); return -EPROBE_DEFER; } mc_data->adc = NULL; dev_warn(&pdev->dev, "Has no ADC channel\n"); } else { ret = rk_multicodecs_probe_keys(pdev, mc_data); if (ret) dev_warn(&pdev->dev, "Has no input keys\n"); headset_extcon_cable[cable++] = EXTCON_JACK_MICROPHONE; } INIT_DEFERRABLE_WORK(&mc_data->handler, adc_jack_handler); mc_data->spk_ctl_gpio = devm_gpiod_get_optional(&pdev->dev, "spk-con", GPIOD_OUT_LOW); if (IS_ERR(mc_data->spk_ctl_gpio)) return PTR_ERR(mc_data->spk_ctl_gpio); mc_data->hp_ctl_gpio = devm_gpiod_get_optional(&pdev->dev, "hp-con", GPIOD_OUT_LOW); if (IS_ERR(mc_data->hp_ctl_gpio)) return PTR_ERR(mc_data->hp_ctl_gpio); mc_data->hp_det_gpio = devm_gpiod_get_optional(&pdev->dev, "hp-det", GPIOD_IN); if (IS_ERR(mc_data->hp_det_gpio)) return PTR_ERR(mc_data->hp_det_gpio); if (gpiod_to_irq(mc_data->hp_det_gpio) >= 0) { headset_extcon_cable[cable++] = EXTCON_JACK_HEADPHONE; card->resume_post = &rk_multicodecs_resume_post; } mc_data->extcon = devm_extcon_dev_allocate(&pdev->dev, headset_extcon_cable); if (IS_ERR(mc_data->extcon)) { dev_err(&pdev->dev, "Failed to allocate extcon\n"); return PTR_ERR(mc_data->extcon); } ret = devm_extcon_dev_register(&pdev->dev, mc_data->extcon); if (ret) { dev_err(&pdev->dev, "Failed to register extcon: %d\n", ret); return ret; } snd_soc_of_parse_audio_routing(card, "rockchip,audio-routing"); snd_soc_card_set_drvdata(card, mc_data); platform_set_drvdata(pdev, mc_data); ret = devm_snd_soc_register_card(&pdev->dev, card); if (ret) { dev_err(&pdev->dev, "Failed to register card: %d\n", ret); return ret; } irq = gpiod_to_irq(mc_data->hp_det_gpio); if (irq >= 0) queue_delayed_work(system_power_efficient_wq, &mc_data->handler, msecs_to_jiffies(50)); return ret; } static int rk_multicodec_remove(struct platform_device *pdev) { struct multicodecs_data *mc_data = platform_get_drvdata(pdev); cancel_delayed_work_sync(&mc_data->handler); return 0; } static void rk_multicodec_shutdown(struct platform_device *pdev) { struct multicodecs_data *mc_data = platform_get_drvdata(pdev); cancel_delayed_work_sync(&mc_data->handler); } static const struct of_device_id rockchip_multicodecs_of_match[] = { { .compatible = "rockchip,multicodecs-card", }, {}, }; MODULE_DEVICE_TABLE(of, rockchip_multicodecs_of_match); static struct platform_driver rockchip_multicodecs_driver = { .probe = rk_multicodecs_probe, .remove = rk_multicodec_remove, .shutdown = rk_multicodec_shutdown, .driver = { .name = DRV_NAME, .pm = &snd_soc_pm_ops, .of_match_table = rockchip_multicodecs_of_match, }, }; module_platform_driver(rockchip_multicodecs_driver); MODULE_AUTHOR("Sugar Zhang "); MODULE_DESCRIPTION("Rockchip General Multicodecs ASoC driver"); MODULE_LICENSE("GPL v2"); MODULE_ALIAS("platform:" DRV_NAME);