mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
synced 2026-08-31 10:31:33 -04:00
ASoC: cs35l56: Switch to using the IRQ from the SoundWire core
Richard Fitzgerald <rf@opensource.cirrus.com> says: At the time the cs35l56 driver was written the only way to get interrupts from the SoundWire core was to implement a custom handler inside the interrupt_callback() function. The SoundWire core now provides a virtual IRQ for notifying ImpDef interrupts, and switching to this simplifies the code and also makes it more similar to the normal interrupt handling of I2C/SPI (though some SoundWire specials are still needed). Patches #1 and #2 do some preparatory code shuffling so that there is less clutter in patch #4. Patch #3 changes the SoundWire core code to create the virtual ImpDef IRQ before calling the codec drive probe() so that the IRQ can be requested in probe(). Link: https://patch.msgid.link/20260810104045.60701-1-rf@opensource.cirrus.com
This commit is contained in:
@@ -105,6 +105,9 @@ static int sdw_bus_probe(struct device *dev)
|
||||
}
|
||||
slave->index = ret;
|
||||
|
||||
/* Create IRQ mapping now so the driver can get it in probe() */
|
||||
sdw_irq_create_mapping(slave);
|
||||
|
||||
ret = drv->probe(slave, id);
|
||||
if (ret) {
|
||||
ida_free(&slave->bus->slave_ida, slave->index);
|
||||
@@ -117,9 +120,6 @@ static int sdw_bus_probe(struct device *dev)
|
||||
if (drv->ops && drv->ops->read_prop)
|
||||
drv->ops->read_prop(slave);
|
||||
|
||||
if (slave->prop.use_domain_irq)
|
||||
sdw_irq_create_mapping(slave);
|
||||
|
||||
/* init the dynamic sysfs attributes we need */
|
||||
ret = sdw_slave_sysfs_dpn_init(slave);
|
||||
if (ret < 0)
|
||||
|
||||
@@ -417,7 +417,6 @@ void cs35l56_wait_control_port_ready(void);
|
||||
void cs35l56_wait_min_reset_pulse(void);
|
||||
void cs35l56_system_reset(struct cs35l56_base *cs35l56_base, bool is_soundwire);
|
||||
int cs35l56_irq_request(struct cs35l56_base *cs35l56_base, int irq);
|
||||
irqreturn_t cs35l56_irq(int irq, void *data);
|
||||
int cs35l56_is_fw_reload_needed(struct cs35l56_base *cs35l56_base);
|
||||
int cs35l56_runtime_suspend_common(struct cs35l56_base *cs35l56_base);
|
||||
int cs35l56_runtime_resume_common(struct cs35l56_base *cs35l56_base, bool is_soundwire);
|
||||
|
||||
@@ -896,6 +896,7 @@ config SND_SOC_CS35L56_SDW
|
||||
tristate "Cirrus Logic CS35L56 CODEC (SDW)"
|
||||
depends on SOUNDWIRE
|
||||
select REGMAP_SOUNDWIRE
|
||||
select IRQ_DOMAIN
|
||||
select SND_SOC_CS35L56
|
||||
select SND_SOC_CS35L56_SHARED
|
||||
help
|
||||
|
||||
@@ -51,15 +51,7 @@ static int cs35l56_i2c_probe(struct i2c_client *client)
|
||||
return dev_err_probe(cs35l56->base.dev, ret, "Failed to allocate register map\n");
|
||||
}
|
||||
|
||||
ret = cs35l56_common_probe(cs35l56);
|
||||
if (ret != 0)
|
||||
return ret;
|
||||
|
||||
ret = cs35l56_irq_request(&cs35l56->base, client->irq);
|
||||
if (ret < 0)
|
||||
cs35l56_remove(cs35l56);
|
||||
|
||||
return ret;
|
||||
return cs35l56_common_probe(cs35l56, client->irq);
|
||||
}
|
||||
|
||||
static void cs35l56_i2c_remove(struct i2c_client *client)
|
||||
|
||||
@@ -231,7 +231,7 @@ static void cs35l56_sdw_init(struct sdw_slave *peripheral)
|
||||
* a soft reset.
|
||||
*/
|
||||
if (cs35l56->base.init_done)
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56->sdw_peripheral);
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56);
|
||||
|
||||
out:
|
||||
pm_runtime_put_autosuspend(cs35l56->base.dev);
|
||||
@@ -240,47 +240,17 @@ static void cs35l56_sdw_init(struct sdw_slave *peripheral)
|
||||
static int cs35l56_sdw_interrupt(struct sdw_slave *peripheral,
|
||||
struct sdw_slave_intr_status *status)
|
||||
{
|
||||
struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev);
|
||||
|
||||
/* SoundWire core holds our pm_runtime when calling this function. */
|
||||
|
||||
dev_dbg(cs35l56->base.dev, "int control_port=%#x\n", status->control_port);
|
||||
|
||||
if ((status->control_port & SDW_SCP_INT1_IMPL_DEF) == 0)
|
||||
return 0;
|
||||
|
||||
/*
|
||||
* Prevent bus manager suspending and possibly issuing a
|
||||
* bus-reset before the queued work has run.
|
||||
* The IRQ itself was handled through the regmap_irq handler, this is
|
||||
* just clearing up the additional Cirrus SoundWire registers that are
|
||||
* not covered by the SoundWire framework or the IRQ handler itself.
|
||||
*/
|
||||
pm_runtime_get_noresume(cs35l56->base.dev);
|
||||
|
||||
/*
|
||||
* Mask and clear until it has been handled.
|
||||
* None of the interrupts are time-critical so use the
|
||||
* power-efficient queue.
|
||||
*/
|
||||
cs35l56_mask_soundwire_interrupts(peripheral);
|
||||
queue_work(system_power_efficient_wq, &cs35l56->sdw_irq_work);
|
||||
sdw_read_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1);
|
||||
sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1, 0xFF);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void cs35l56_sdw_irq_work(struct work_struct *work)
|
||||
{
|
||||
struct cs35l56_private *cs35l56 = container_of(work,
|
||||
struct cs35l56_private,
|
||||
sdw_irq_work);
|
||||
|
||||
cs35l56_irq(-1, &cs35l56->base);
|
||||
|
||||
/* unmask interrupts */
|
||||
if (!cs35l56->sdw_irq_no_unmask)
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56->sdw_peripheral);
|
||||
|
||||
pm_runtime_put_autosuspend(cs35l56->base.dev);
|
||||
}
|
||||
|
||||
static int cs35l56_sdw_read_prop(struct sdw_slave *peripheral)
|
||||
{
|
||||
struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev);
|
||||
@@ -302,6 +272,7 @@ static int cs35l56_sdw_read_prop(struct sdw_slave *peripheral)
|
||||
prop->source_ports = BIT(CS35L56_SDW1_CAPTURE_PORT);
|
||||
prop->sink_ports = BIT(CS35L56_SDW1_PLAYBACK_PORT);
|
||||
prop->paging_support = true;
|
||||
prop->use_domain_irq = true;
|
||||
prop->quirks = SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY;
|
||||
prop->scp_int1_mask = SDW_SCP_INT1_BUS_CLASH | SDW_SCP_INT1_PARITY | SDW_SCP_INT1_IMPL_DEF;
|
||||
|
||||
@@ -406,7 +377,7 @@ static int __maybe_unused cs35l56_sdw_runtime_resume(struct device *dev)
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56->sdw_peripheral);
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -418,21 +389,12 @@ static int __maybe_unused cs35l56_sdw_system_suspend(struct device *dev)
|
||||
if (!cs35l56->base.init_done)
|
||||
return 0;
|
||||
|
||||
cs35l56_disable_sdw_interrupts(cs35l56);
|
||||
/* runtime_resume unmasks the interrupt */
|
||||
cs35l56_mask_soundwire_interrupts(cs35l56);
|
||||
|
||||
return cs35l56_system_suspend(dev);
|
||||
}
|
||||
|
||||
static int __maybe_unused cs35l56_sdw_system_resume(struct device *dev)
|
||||
{
|
||||
struct cs35l56_private *cs35l56 = dev_get_drvdata(dev);
|
||||
|
||||
cs35l56->sdw_irq_no_unmask = false;
|
||||
/* runtime_resume re-enables the interrupt */
|
||||
|
||||
return cs35l56_system_resume(dev);
|
||||
}
|
||||
|
||||
static int cs35l56_sdw_probe(struct sdw_slave *peripheral, const struct sdw_device_id *id)
|
||||
{
|
||||
struct device *dev = &peripheral->dev;
|
||||
@@ -447,7 +409,6 @@ static int cs35l56_sdw_probe(struct sdw_slave *peripheral, const struct sdw_devi
|
||||
cs35l56->base.dev = dev;
|
||||
cs35l56->sdw_peripheral = peripheral;
|
||||
cs35l56->sdw_link_num = peripheral->bus->link_id;
|
||||
INIT_WORK(&cs35l56->sdw_irq_work, cs35l56_sdw_irq_work);
|
||||
|
||||
dev_set_drvdata(dev, cs35l56);
|
||||
|
||||
@@ -484,25 +445,21 @@ static int cs35l56_sdw_probe(struct sdw_slave *peripheral, const struct sdw_devi
|
||||
/* Start in cache-only until device is enumerated */
|
||||
regcache_cache_only(cs35l56->base.regmap, true);
|
||||
|
||||
ret = cs35l56_common_probe(cs35l56);
|
||||
if (ret != 0)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
return cs35l56_common_probe(cs35l56, peripheral->irq);
|
||||
}
|
||||
|
||||
static void cs35l56_sdw_remove(struct sdw_slave *peripheral)
|
||||
{
|
||||
struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev);
|
||||
|
||||
cs35l56_disable_sdw_interrupts(cs35l56);
|
||||
cs35l56_mask_soundwire_interrupts(cs35l56);
|
||||
|
||||
cs35l56_remove(cs35l56);
|
||||
}
|
||||
|
||||
static const struct dev_pm_ops cs35l56_sdw_pm = {
|
||||
SET_RUNTIME_PM_OPS(cs35l56_sdw_runtime_suspend, cs35l56_sdw_runtime_resume, NULL)
|
||||
SYSTEM_SLEEP_PM_OPS(cs35l56_sdw_system_suspend, cs35l56_sdw_system_resume)
|
||||
SYSTEM_SLEEP_PM_OPS(cs35l56_sdw_system_suspend, cs35l56_system_resume)
|
||||
LATE_SYSTEM_SLEEP_PM_OPS(cs35l56_system_suspend_late, cs35l56_system_resume_early)
|
||||
/* NOIRQ stage not needed, SoundWire doesn't use a hard IRQ */
|
||||
};
|
||||
|
||||
@@ -616,26 +616,7 @@ void cs35l56_system_reset(struct cs35l56_base *cs35l56_base, bool is_soundwire)
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_system_reset, "SND_SOC_CS35L56_SHARED");
|
||||
|
||||
int cs35l56_irq_request(struct cs35l56_base *cs35l56_base, int irq)
|
||||
{
|
||||
int ret;
|
||||
|
||||
if (irq < 1)
|
||||
return 0;
|
||||
|
||||
ret = devm_request_threaded_irq(cs35l56_base->dev, irq, NULL, cs35l56_irq,
|
||||
IRQF_ONESHOT | IRQF_SHARED | IRQF_TRIGGER_LOW,
|
||||
"cs35l56", cs35l56_base);
|
||||
if (!ret)
|
||||
cs35l56_base->irq = irq;
|
||||
else
|
||||
dev_err(cs35l56_base->dev, "Failed to get IRQ: %d\n", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_irq_request, "SND_SOC_CS35L56_SHARED");
|
||||
|
||||
irqreturn_t cs35l56_irq(int irq, void *data)
|
||||
static irqreturn_t cs35l56_irq(int irq, void *data)
|
||||
{
|
||||
struct cs35l56_base *cs35l56_base = data;
|
||||
unsigned int status1 = 0, status8 = 0, status20 = 0;
|
||||
@@ -692,7 +673,25 @@ irqreturn_t cs35l56_irq(int irq, void *data)
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_irq, "SND_SOC_CS35L56_SHARED");
|
||||
|
||||
int cs35l56_irq_request(struct cs35l56_base *cs35l56_base, int irq)
|
||||
{
|
||||
int ret;
|
||||
|
||||
if (irq < 1)
|
||||
return 0;
|
||||
|
||||
ret = devm_request_threaded_irq(cs35l56_base->dev, irq, NULL, cs35l56_irq,
|
||||
IRQF_ONESHOT | IRQF_SHARED | IRQF_TRIGGER_LOW,
|
||||
"cs35l56", cs35l56_base);
|
||||
if (!ret)
|
||||
cs35l56_base->irq = irq;
|
||||
else
|
||||
dev_err(cs35l56_base->dev, "Failed to get IRQ: %d\n", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_irq_request, "SND_SOC_CS35L56_SHARED");
|
||||
|
||||
int cs35l56_is_fw_reload_needed(struct cs35l56_base *cs35l56_base)
|
||||
{
|
||||
|
||||
@@ -40,15 +40,7 @@ static int cs35l56_spi_probe(struct spi_device *spi)
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = cs35l56_common_probe(cs35l56);
|
||||
if (ret != 0)
|
||||
return ret;
|
||||
|
||||
ret = cs35l56_irq_request(&cs35l56->base, spi->irq);
|
||||
if (ret < 0)
|
||||
cs35l56_remove(cs35l56);
|
||||
|
||||
return ret;
|
||||
return cs35l56_common_probe(cs35l56, spi->irq);
|
||||
}
|
||||
|
||||
static void cs35l56_spi_remove(struct spi_device *spi)
|
||||
|
||||
@@ -37,48 +37,49 @@
|
||||
#include "wm_adsp.h"
|
||||
#include "cs35l56.h"
|
||||
|
||||
void cs35l56_mask_soundwire_interrupts(struct sdw_slave *peripheral)
|
||||
void cs35l56_mask_soundwire_interrupts(struct cs35l56_private *cs35l56)
|
||||
{
|
||||
/*
|
||||
* Mask unconditionally.
|
||||
*
|
||||
* The read of GEN_INT_STAT_1 is required as per the SoundWire spec
|
||||
* for interrupt status bits to clear.
|
||||
* GEN_INT_MASK_1 masks the _inputs_ to GEN_INT_STAT1.
|
||||
*/
|
||||
sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_MASK_1, 0);
|
||||
sdw_read_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1);
|
||||
sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1, 0xFF);
|
||||
sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_MASK_1, 0);
|
||||
sdw_read_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_STAT_1);
|
||||
sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_STAT_1, 0xFF);
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_mask_soundwire_interrupts, "SND_SOC_CS35L56_CORE");
|
||||
|
||||
void cs35l56_unmask_soundwire_interrupts(struct sdw_slave *peripheral)
|
||||
void cs35l56_unmask_soundwire_interrupts(struct cs35l56_private *cs35l56)
|
||||
{
|
||||
sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_MASK_1, CS35L56_SDW_INT_MASK_CODEC_IRQ);
|
||||
if (!cs35l56->base.irq)
|
||||
return;
|
||||
|
||||
sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_MASK_1,
|
||||
CS35L56_SDW_INT_MASK_CODEC_IRQ);
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_unmask_soundwire_interrupts, "SND_SOC_CS35L56_CORE");
|
||||
|
||||
void cs35l56_disable_sdw_interrupts(struct cs35l56_private *cs35l56)
|
||||
static void cs35l56_disable_sdw_interrupts(struct cs35l56_private *cs35l56)
|
||||
{
|
||||
if (!cs35l56->sdw_peripheral)
|
||||
return;
|
||||
|
||||
cs35l56->sdw_irq_no_unmask = true;
|
||||
flush_work(&cs35l56->sdw_irq_work);
|
||||
|
||||
/* Mask interrupts and flush in case sdw_irq_work was queued again */
|
||||
cs35l56_mask_soundwire_interrupts(cs35l56->sdw_peripheral);
|
||||
flush_work(&cs35l56->sdw_irq_work);
|
||||
cs35l56_mask_soundwire_interrupts(cs35l56);
|
||||
if (cs35l56->base.irq)
|
||||
disable_irq(cs35l56->base.irq);
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_disable_sdw_interrupts, "SND_SOC_CS35L56_CORE");
|
||||
|
||||
void cs35l56_enable_sdw_interrupts(struct cs35l56_private *cs35l56)
|
||||
static void cs35l56_enable_sdw_interrupts(struct cs35l56_private *cs35l56)
|
||||
{
|
||||
if (!cs35l56->sdw_peripheral)
|
||||
if (!cs35l56->sdw_peripheral || !cs35l56->base.irq)
|
||||
return;
|
||||
|
||||
cs35l56->sdw_irq_no_unmask = false;
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56->sdw_peripheral);
|
||||
enable_irq(cs35l56->base.irq);
|
||||
cs35l56_unmask_soundwire_interrupts(cs35l56);
|
||||
}
|
||||
EXPORT_SYMBOL_NS_GPL(cs35l56_enable_sdw_interrupts, "SND_SOC_CS35L56_CORE");
|
||||
|
||||
static int cs35l56_dsp_event(struct snd_soc_dapm_widget *w,
|
||||
struct snd_kcontrol *kcontrol, int event);
|
||||
@@ -828,11 +829,7 @@ static void cs35l56_patch(struct cs35l56_private *cs35l56, bool firmware_missing
|
||||
{
|
||||
int ret;
|
||||
|
||||
/*
|
||||
* Disable SoundWire interrupts to prevent race with IRQ work.
|
||||
* Setting sdw_irq_no_unmask prevents the handler re-enabling
|
||||
* the SoundWire interrupt.
|
||||
*/
|
||||
/* Disable SoundWire interrupts to prevent race with IRQ handler thread */
|
||||
cs35l56_disable_sdw_interrupts(cs35l56);
|
||||
|
||||
ret = cs35l56_firmware_shutdown(&cs35l56->base);
|
||||
@@ -1942,7 +1939,7 @@ static int cs35l56_try_get_broken_sdca_spkid_gpio(struct cs35l56_private *cs35l5
|
||||
return ret;
|
||||
}
|
||||
|
||||
int cs35l56_common_probe(struct cs35l56_private *cs35l56)
|
||||
int cs35l56_common_probe(struct cs35l56_private *cs35l56, int irq)
|
||||
{
|
||||
int ret;
|
||||
|
||||
@@ -2019,16 +2016,24 @@ int cs35l56_common_probe(struct cs35l56_private *cs35l56)
|
||||
goto err_remove_wm_adsp;
|
||||
}
|
||||
|
||||
ret = cs35l56_irq_request(&cs35l56->base, irq);
|
||||
if (ret)
|
||||
goto err_remove_wm_adsp;
|
||||
|
||||
ret = snd_soc_register_component(cs35l56->base.dev,
|
||||
&soc_component_dev_cs35l56,
|
||||
cs35l56_dai, ARRAY_SIZE(cs35l56_dai));
|
||||
if (ret < 0) {
|
||||
dev_err_probe(cs35l56->base.dev, ret, "Register codec failed\n");
|
||||
goto err_remove_wm_adsp;
|
||||
goto err_free_irq;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_irq:
|
||||
if (cs35l56->base.irq)
|
||||
devm_free_irq(cs35l56->base.dev, cs35l56->base.irq, &cs35l56->base);
|
||||
|
||||
err_remove_wm_adsp:
|
||||
wm_adsp2_remove(&cs35l56->dsp);
|
||||
|
||||
|
||||
@@ -39,8 +39,6 @@ struct cs35l56_private {
|
||||
struct sdw_slave *sdw_peripheral;
|
||||
struct regmap *sdw_bus_regmap;
|
||||
const char *fallback_fw_suffix;
|
||||
struct work_struct sdw_irq_work;
|
||||
bool sdw_irq_no_unmask;
|
||||
bool soft_resetting;
|
||||
bool sdw_attached;
|
||||
struct completion init_completion;
|
||||
@@ -65,10 +63,8 @@ static inline struct cs35l56_private *cs35l56_private_from_base(struct cs35l56_b
|
||||
|
||||
extern const struct dev_pm_ops cs35l56_pm_ops_i2c_spi;
|
||||
|
||||
void cs35l56_mask_soundwire_interrupts(struct sdw_slave *peripheral);
|
||||
void cs35l56_unmask_soundwire_interrupts(struct sdw_slave *peripheral);
|
||||
void cs35l56_disable_sdw_interrupts(struct cs35l56_private *cs35l56);
|
||||
void cs35l56_enable_sdw_interrupts(struct cs35l56_private *cs35l56);
|
||||
void cs35l56_mask_soundwire_interrupts(struct cs35l56_private *cs35l56);
|
||||
void cs35l56_unmask_soundwire_interrupts(struct cs35l56_private *cs35l56);
|
||||
|
||||
int cs35l56_system_suspend(struct device *dev);
|
||||
int cs35l56_system_suspend_late(struct device *dev);
|
||||
@@ -76,9 +72,8 @@ int cs35l56_system_suspend_no_irq(struct device *dev);
|
||||
int cs35l56_system_resume_no_irq(struct device *dev);
|
||||
int cs35l56_system_resume_early(struct device *dev);
|
||||
int cs35l56_system_resume(struct device *dev);
|
||||
irqreturn_t cs35l56_irq(int irq, void *data);
|
||||
int cs35l56_irq_request(struct cs35l56_base *cs35l56_base, int irq);
|
||||
int cs35l56_common_probe(struct cs35l56_private *cs35l56);
|
||||
int cs35l56_common_probe(struct cs35l56_private *cs35l56, int irq);
|
||||
int cs35l56_init(struct cs35l56_private *cs35l56);
|
||||
void cs35l56_remove(struct cs35l56_private *cs35l56);
|
||||
|
||||
|
||||
Reference in New Issue
Block a user