223 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * CS42L43 SoundWire driver4 *5 * Copyright (C) 2022-2023 Cirrus Logic, Inc. and6 * Cirrus Logic International Semiconductor Ltd.7 */8 9#include <linux/array_size.h>10#include <linux/device.h>11#include <linux/err.h>12#include <linux/mfd/cs42l43.h>13#include <linux/mfd/cs42l43-regs.h>14#include <linux/mod_devicetable.h>15#include <linux/module.h>16#include <linux/pm.h>17#include <linux/regmap.h>18#include <linux/soundwire/sdw.h>19#include <linux/soundwire/sdw_registers.h>20#include <linux/soundwire/sdw_type.h>21 22#include "cs42l43.h"23 24#define CS42L43_SDW_PORT(port, chans) { \25 .num = port, \26 .max_ch = chans, \27 .type = SDW_DPN_FULL, \28 .max_word = 24, \29}30 31static const struct regmap_config cs42l43_sdw_regmap = {32 .reg_bits = 32,33 .reg_stride = 4,34 .val_bits = 32,35 .reg_format_endian = REGMAP_ENDIAN_LITTLE,36 .val_format_endian = REGMAP_ENDIAN_LITTLE,37 38 .max_register = CS42L43_MCU_RAM_MAX,39 .readable_reg = cs42l43_readable_register,40 .volatile_reg = cs42l43_volatile_register,41 .precious_reg = cs42l43_precious_register,42 43 .cache_type = REGCACHE_MAPLE,44 .reg_defaults = cs42l43_reg_default,45 .num_reg_defaults = ARRAY_SIZE(cs42l43_reg_default),46};47 48static const struct sdw_dpn_prop cs42l43_src_port_props[] = {49 CS42L43_SDW_PORT(1, 4),50 CS42L43_SDW_PORT(2, 2),51 CS42L43_SDW_PORT(3, 2),52 CS42L43_SDW_PORT(4, 2),53};54 55static const struct sdw_dpn_prop cs42l43_sink_port_props[] = {56 CS42L43_SDW_PORT(5, 2),57 CS42L43_SDW_PORT(6, 2),58 CS42L43_SDW_PORT(7, 2),59};60 61static int cs42l43_read_prop(struct sdw_slave *sdw)62{63 struct sdw_slave_prop *prop = &sdw->prop;64 struct device *dev = &sdw->dev;65 int i;66 67 prop->use_domain_irq = true;68 prop->paging_support = true;69 prop->wake_capable = true;70 prop->quirks = SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY;71 prop->scp_int1_mask = SDW_SCP_INT1_BUS_CLASH | SDW_SCP_INT1_PARITY |72 SDW_SCP_INT1_IMPL_DEF;73 74 for (i = 0; i < ARRAY_SIZE(cs42l43_src_port_props); i++)75 prop->source_ports |= BIT(cs42l43_src_port_props[i].num);76 77 prop->src_dpn_prop = devm_kmemdup(dev, cs42l43_src_port_props,78 sizeof(cs42l43_src_port_props), GFP_KERNEL);79 if (!prop->src_dpn_prop)80 return -ENOMEM;81 82 for (i = 0; i < ARRAY_SIZE(cs42l43_sink_port_props); i++)83 prop->sink_ports |= BIT(cs42l43_sink_port_props[i].num);84 85 prop->sink_dpn_prop = devm_kmemdup(dev, cs42l43_sink_port_props,86 sizeof(cs42l43_sink_port_props), GFP_KERNEL);87 if (!prop->sink_dpn_prop)88 return -ENOMEM;89 90 return 0;91}92 93static int cs42l43_sdw_update_status(struct sdw_slave *sdw, enum sdw_slave_status status)94{95 struct cs42l43 *cs42l43 = dev_get_drvdata(&sdw->dev);96 97 switch (status) {98 case SDW_SLAVE_ATTACHED:99 dev_dbg(cs42l43->dev, "Device attach\n");100 101 sdw_write_no_pm(sdw, CS42L43_GEN_INT_MASK_1,102 CS42L43_INT_STAT_GEN1_MASK);103 104 cs42l43->attached = true;105 106 complete(&cs42l43->device_attach);107 break;108 case SDW_SLAVE_UNATTACHED:109 dev_dbg(cs42l43->dev, "Device detach\n");110 111 cs42l43->attached = false;112 113 reinit_completion(&cs42l43->device_attach);114 complete(&cs42l43->device_detach);115 break;116 default:117 break;118 }119 120 return 0;121}122 123static int cs42l43_sdw_interrupt(struct sdw_slave *sdw,124 struct sdw_slave_intr_status *status)125{126 /*127 * The IRQ itself was handled through the regmap_irq handler, this is128 * just clearing up the additional Cirrus SoundWire registers that are129 * not covered by the SoundWire framework or the IRQ handler itself.130 * There is only a single bit in GEN_INT_STAT_1 and it doesn't clear if131 * IRQs are still pending so doing a read/write here after handling the132 * IRQ is fine.133 */134 sdw_read_no_pm(sdw, CS42L43_GEN_INT_STAT_1);135 sdw_write_no_pm(sdw, CS42L43_GEN_INT_STAT_1, CS42L43_INT_STAT_GEN1_MASK);136 137 return 0;138}139 140static int cs42l43_sdw_bus_config(struct sdw_slave *sdw,141 struct sdw_bus_params *params)142{143 struct cs42l43 *cs42l43 = dev_get_drvdata(&sdw->dev);144 int ret = 0;145 146 mutex_lock(&cs42l43->pll_lock);147 148 if (cs42l43->sdw_freq != params->curr_dr_freq / 2) {149 if (cs42l43->sdw_pll_active) {150 dev_err(cs42l43->dev,151 "PLL active can't change SoundWire bus clock\n");152 ret = -EBUSY;153 } else {154 cs42l43->sdw_freq = params->curr_dr_freq / 2;155 }156 }157 158 mutex_unlock(&cs42l43->pll_lock);159 160 return ret;161}162 163static const struct sdw_slave_ops cs42l43_sdw_ops = {164 .read_prop = cs42l43_read_prop,165 .update_status = cs42l43_sdw_update_status,166 .interrupt_callback = cs42l43_sdw_interrupt,167 .bus_config = cs42l43_sdw_bus_config,168};169 170static int cs42l43_sdw_probe(struct sdw_slave *sdw, const struct sdw_device_id *id)171{172 struct cs42l43 *cs42l43;173 struct device *dev = &sdw->dev;174 175 cs42l43 = devm_kzalloc(dev, sizeof(*cs42l43), GFP_KERNEL);176 if (!cs42l43)177 return -ENOMEM;178 179 cs42l43->dev = dev;180 cs42l43->sdw = sdw;181 182 cs42l43->regmap = devm_regmap_init_sdw(sdw, &cs42l43_sdw_regmap);183 if (IS_ERR(cs42l43->regmap))184 return dev_err_probe(cs42l43->dev, PTR_ERR(cs42l43->regmap),185 "Failed to allocate regmap\n");186 187 return cs42l43_dev_probe(cs42l43);188}189 190static int cs42l43_sdw_remove(struct sdw_slave *sdw)191{192 struct cs42l43 *cs42l43 = dev_get_drvdata(&sdw->dev);193 194 cs42l43_dev_remove(cs42l43);195 196 return 0;197}198 199static const struct sdw_device_id cs42l43_sdw_id[] = {200 SDW_SLAVE_ENTRY(0x01FA, 0x4243, 0),201 {}202};203MODULE_DEVICE_TABLE(sdw, cs42l43_sdw_id);204 205static struct sdw_driver cs42l43_sdw_driver = {206 .driver = {207 .name = "cs42l43",208 .pm = pm_ptr(&cs42l43_pm_ops),209 },210 211 .probe = cs42l43_sdw_probe,212 .remove = cs42l43_sdw_remove,213 .id_table = cs42l43_sdw_id,214 .ops = &cs42l43_sdw_ops,215};216module_sdw_driver(cs42l43_sdw_driver);217 218MODULE_IMPORT_NS(MFD_CS42L43);219 220MODULE_DESCRIPTION("CS42L43 SoundWire Driver");221MODULE_AUTHOR("Lucas Tanure <tanureal@opensource.cirrus.com>");222MODULE_LICENSE("GPL");223