1// SPDX-License-Identifier: GPL-2.0-only 2// 3// Common code for Cirrus side-codecs. 4// 5// Copyright (C) 2021, 2023 Cirrus Logic, Inc. and 6// 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