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