74 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2//3// Common code for Cirrus side-codecs.4//5// Copyright (C) 2021, 2023 Cirrus Logic, Inc. and6// Cirrus Logic International Semiconductor Ltd.7 8#include <linux/dev_printk.h>9#include <linux/gpio/consumer.h>10#include <linux/module.h>11 12#include "cirrus_scodec.h"13 14int cirrus_scodec_get_speaker_id(struct device *dev, int amp_index,15 int num_amps, int fixed_gpio_id)16{17 struct gpio_desc *speaker_id_desc;18 int speaker_id = -ENOENT;19 20 if (fixed_gpio_id >= 0) {21 dev_dbg(dev, "Found Fixed Speaker ID GPIO (index = %d)\n", fixed_gpio_id);22 speaker_id_desc = gpiod_get_index(dev, NULL, fixed_gpio_id, GPIOD_IN);23 if (IS_ERR(speaker_id_desc)) {24 speaker_id = PTR_ERR(speaker_id_desc);25 return speaker_id;26 }27 speaker_id = gpiod_get_value_cansleep(speaker_id_desc);28 gpiod_put(speaker_id_desc);29 } else {30 int base_index;31 int gpios_per_amp;32 int count;33 int tmp;34 int i;35 36 count = gpiod_count(dev, "spk-id");37 if (count > 0) {38 speaker_id = 0;39 gpios_per_amp = count / num_amps;40 base_index = gpios_per_amp * amp_index;41 42 if (count % num_amps)43 return -EINVAL;44 45 dev_dbg(dev, "Found %d Speaker ID GPIOs per Amp\n", gpios_per_amp);46 47 for (i = 0; i < gpios_per_amp; i++) {48 speaker_id_desc = gpiod_get_index(dev, "spk-id", i + base_index,49 GPIOD_IN);50 if (IS_ERR(speaker_id_desc)) {51 speaker_id = PTR_ERR(speaker_id_desc);52 break;53 }54 tmp = gpiod_get_value_cansleep(speaker_id_desc);55 gpiod_put(speaker_id_desc);56 if (tmp < 0) {57 speaker_id = tmp;58 break;59 }60 speaker_id |= tmp << i;61 }62 }63 }64 65 dev_dbg(dev, "Speaker ID = %d\n", speaker_id);66 67 return speaker_id;68}69EXPORT_SYMBOL_NS_GPL(cirrus_scodec_get_speaker_id, SND_HDA_CIRRUS_SCODEC);70 71MODULE_DESCRIPTION("HDA Cirrus side-codec library");72MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>");73MODULE_LICENSE("GPL");74