74 lines
1.9 KiB
C
74 lines
1.9 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-only
|
||
|
|
//
|
||
|
|
// Common code for Cirrus side-codecs.
|
||
|
|
//
|
||
|
|
// Copyright (C) 2021, 2023 Cirrus Logic, Inc. and
|
||
|
|
// Cirrus Logic International Semiconductor Ltd.
|
||
|
|
|
||
|
|
#include <linux/dev_printk.h>
|
||
|
|
#include <linux/gpio/consumer.h>
|
||
|
|
#include <linux/module.h>
|
||
|
|
|
||
|
|
#include "cirrus_scodec.h"
|
||
|
|
|
||
|
|
int cirrus_scodec_get_speaker_id(struct device *dev, int amp_index,
|
||
|
|
int num_amps, int fixed_gpio_id)
|
||
|
|
{
|
||
|
|
struct gpio_desc *speaker_id_desc;
|
||
|
|
int speaker_id = -ENOENT;
|
||
|
|
|
||
|
|
if (fixed_gpio_id >= 0) {
|
||
|
|
dev_dbg(dev, "Found Fixed Speaker ID GPIO (index = %d)\n", fixed_gpio_id);
|
||
|
|
speaker_id_desc = gpiod_get_index(dev, NULL, fixed_gpio_id, GPIOD_IN);
|
||
|
|
if (IS_ERR(speaker_id_desc)) {
|
||
|
|
speaker_id = PTR_ERR(speaker_id_desc);
|
||
|
|
return speaker_id;
|
||
|
|
}
|
||
|
|
speaker_id = gpiod_get_value_cansleep(speaker_id_desc);
|
||
|
|
gpiod_put(speaker_id_desc);
|
||
|
|
} else {
|
||
|
|
int base_index;
|
||
|
|
int gpios_per_amp;
|
||
|
|
int count;
|
||
|
|
int tmp;
|
||
|
|
int i;
|
||
|
|
|
||
|
|
count = gpiod_count(dev, "spk-id");
|
||
|
|
if (count > 0) {
|
||
|
|
speaker_id = 0;
|
||
|
|
gpios_per_amp = count / num_amps;
|
||
|
|
base_index = gpios_per_amp * amp_index;
|
||
|
|
|
||
|
|
if (count % num_amps)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
dev_dbg(dev, "Found %d Speaker ID GPIOs per Amp\n", gpios_per_amp);
|
||
|
|
|
||
|
|
for (i = 0; i < gpios_per_amp; i++) {
|
||
|
|
speaker_id_desc = gpiod_get_index(dev, "spk-id", i + base_index,
|
||
|
|
GPIOD_IN);
|
||
|
|
if (IS_ERR(speaker_id_desc)) {
|
||
|
|
speaker_id = PTR_ERR(speaker_id_desc);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
tmp = gpiod_get_value_cansleep(speaker_id_desc);
|
||
|
|
gpiod_put(speaker_id_desc);
|
||
|
|
if (tmp < 0) {
|
||
|
|
speaker_id = tmp;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
speaker_id |= tmp << i;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
dev_dbg(dev, "Speaker ID = %d\n", speaker_id);
|
||
|
|
|
||
|
|
return speaker_id;
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL_NS_GPL(cirrus_scodec_get_speaker_id, SND_HDA_CIRRUS_SCODEC);
|
||
|
|
|
||
|
|
MODULE_DESCRIPTION("HDA Cirrus side-codec library");
|
||
|
|
MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>");
|
||
|
|
MODULE_LICENSE("GPL");
|