1 // SPDX-License-Identifier: GPL-2.0-only 2 // 3 // CS35L56 ALSA SoC audio driver SoundWire binding 4 // 5 // Copyright (C) 2023 Cirrus Logic, Inc. and 6 // Cirrus Logic International Semiconductor Ltd. 7 8 #include <linux/delay.h> 9 #include <linux/device.h> 10 #include <linux/err.h> 11 #include <linux/module.h> 12 #include <linux/pm_runtime.h> 13 #include <linux/regmap.h> 14 #include <linux/soundwire/sdw.h> 15 #include <linux/soundwire/sdw_registers.h> 16 #include <linux/soundwire/sdw_type.h> 17 #include <linux/swab.h> 18 #include <linux/types.h> 19 #include <linux/workqueue.h> 20 21 #include "cs35l56.h" 22 23 /* Register addresses are offset when sent over SoundWire */ 24 #define CS35L56_SDW_ADDR_OFFSET 0x8000 25 26 static int cs35l56_sdw_read_one(struct sdw_slave *peripheral, unsigned int reg, void *buf) 27 { 28 int ret; 29 30 ret = sdw_nread_no_pm(peripheral, reg, 4, (u8 *)buf); 31 if (ret != 0) { 32 dev_err(&peripheral->dev, "Read failed @%#x:%d\n", reg, ret); 33 return ret; 34 } 35 36 swab32s((u32 *)buf); 37 38 return 0; 39 } 40 41 static int cs35l56_sdw_read(void *context, const void *reg_buf, 42 const size_t reg_size, void *val_buf, 43 size_t val_size) 44 { 45 struct sdw_slave *peripheral = context; 46 u8 *buf8 = val_buf; 47 unsigned int reg, bytes; 48 int ret; 49 50 reg = le32_to_cpu(*(const __le32 *)reg_buf); 51 reg += CS35L56_SDW_ADDR_OFFSET; 52 53 if (val_size == 4) 54 return cs35l56_sdw_read_one(peripheral, reg, val_buf); 55 56 while (val_size) { 57 bytes = SDW_REG_NO_PAGE - (reg & SDW_REGADDR); /* to end of page */ 58 if (bytes > val_size) 59 bytes = val_size; 60 61 ret = sdw_nread_no_pm(peripheral, reg, bytes, buf8); 62 if (ret != 0) { 63 dev_err(&peripheral->dev, "Read failed @%#x..%#x:%d\n", 64 reg, reg + bytes - 1, ret); 65 return ret; 66 } 67 68 swab32_array((u32 *)buf8, bytes / 4); 69 val_size -= bytes; 70 reg += bytes; 71 buf8 += bytes; 72 } 73 74 return 0; 75 } 76 77 static inline void cs35l56_swab_copy(void *dest, const void *src, size_t nbytes) 78 { 79 u32 *dest32 = dest; 80 const u32 *src32 = src; 81 82 for (; nbytes > 0; nbytes -= 4) 83 *dest32++ = swab32(*src32++); 84 } 85 86 static int cs35l56_sdw_write_one(struct sdw_slave *peripheral, unsigned int reg, const void *buf) 87 { 88 u32 val_le = swab32(*(u32 *)buf); 89 int ret; 90 91 ret = sdw_nwrite_no_pm(peripheral, reg, 4, (u8 *)&val_le); 92 if (ret != 0) { 93 dev_err(&peripheral->dev, "Write failed @%#x:%d\n", reg, ret); 94 return ret; 95 } 96 97 return 0; 98 } 99 100 static int cs35l56_sdw_gather_write(void *context, 101 const void *reg_buf, size_t reg_size, 102 const void *val_buf, size_t val_size) 103 { 104 struct sdw_slave *peripheral = context; 105 const u8 *src_be = val_buf; 106 u32 val_le_buf[64]; /* Define u32 so it is 32-bit aligned */ 107 unsigned int reg, bytes; 108 int ret; 109 110 reg = le32_to_cpu(*(const __le32 *)reg_buf); 111 reg += CS35L56_SDW_ADDR_OFFSET; 112 113 if (val_size == 4) 114 return cs35l56_sdw_write_one(peripheral, reg, src_be); 115 116 while (val_size) { 117 bytes = SDW_REG_NO_PAGE - (reg & SDW_REGADDR); /* to end of page */ 118 if (bytes > val_size) 119 bytes = val_size; 120 if (bytes > sizeof(val_le_buf)) 121 bytes = sizeof(val_le_buf); 122 123 cs35l56_swab_copy(val_le_buf, src_be, bytes); 124 125 ret = sdw_nwrite_no_pm(peripheral, reg, bytes, (u8 *)val_le_buf); 126 if (ret != 0) { 127 dev_err(&peripheral->dev, "Write failed @%#x..%#x:%d\n", 128 reg, reg + bytes - 1, ret); 129 return ret; 130 } 131 132 val_size -= bytes; 133 reg += bytes; 134 src_be += bytes; 135 } 136 137 return 0; 138 } 139 140 static int cs35l56_sdw_write(void *context, const void *val_buf, size_t val_size) 141 { 142 const u8 *src_buf = val_buf; 143 144 /* First word of val_buf contains the destination address */ 145 return cs35l56_sdw_gather_write(context, &src_buf[0], 4, &src_buf[4], val_size - 4); 146 } 147 148 /* 149 * Registers are big-endian on I2C and SPI but little-endian on SoundWire. 150 * Exported firmware controls are big-endian on I2C/SPI but little-endian on 151 * SoundWire. Firmware files are always big-endian and are opaque blobs. 152 * Present a big-endian regmap and hide the endianness swap, so that the ALSA 153 * byte controls always have the same byte order, and firmware file blobs 154 * can be written verbatim. 155 */ 156 static const struct regmap_bus cs35l56_regmap_bus_sdw = { 157 .read = cs35l56_sdw_read, 158 .write = cs35l56_sdw_write, 159 .gather_write = cs35l56_sdw_gather_write, 160 .reg_format_endian_default = REGMAP_ENDIAN_LITTLE, 161 .val_format_endian_default = REGMAP_ENDIAN_BIG, 162 }; 163 164 static void cs35l56_sdw_init(struct sdw_slave *peripheral) 165 { 166 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 167 int ret; 168 169 pm_runtime_get_noresume(cs35l56->dev); 170 171 regcache_cache_only(cs35l56->regmap, false); 172 173 ret = cs35l56_init(cs35l56); 174 if (ret < 0) { 175 regcache_cache_only(cs35l56->regmap, true); 176 goto out; 177 } 178 179 /* 180 * cs35l56_init can return with !init_done if it triggered 181 * a soft reset. 182 */ 183 if (cs35l56->init_done) { 184 /* Enable SoundWire interrupts */ 185 sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_MASK_1, 186 CS35L56_SDW_INT_MASK_CODEC_IRQ); 187 } 188 189 out: 190 pm_runtime_mark_last_busy(cs35l56->dev); 191 pm_runtime_put_autosuspend(cs35l56->dev); 192 } 193 194 static int cs35l56_sdw_interrupt(struct sdw_slave *peripheral, 195 struct sdw_slave_intr_status *status) 196 { 197 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 198 199 /* SoundWire core holds our pm_runtime when calling this function. */ 200 201 dev_dbg(cs35l56->dev, "int control_port=%#x\n", status->control_port); 202 203 if ((status->control_port & SDW_SCP_INT1_IMPL_DEF) == 0) 204 return 0; 205 206 /* 207 * Prevent bus manager suspending and possibly issuing a 208 * bus-reset before the queued work has run. 209 */ 210 pm_runtime_get_noresume(cs35l56->dev); 211 212 /* 213 * Mask and clear until it has been handled. The read of GEN_INT_STAT_1 214 * is required as per the SoundWire spec for interrupt status bits 215 * to clear. GEN_INT_MASK_1 masks the _inputs_ to GEN_INT_STAT1. 216 * None of the interrupts are time-critical so use the 217 * power-efficient queue. 218 */ 219 sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_MASK_1, 0); 220 sdw_read_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1); 221 sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1, 0xFF); 222 queue_work(system_power_efficient_wq, &cs35l56->sdw_irq_work); 223 224 return 0; 225 } 226 227 static void cs35l56_sdw_irq_work(struct work_struct *work) 228 { 229 struct cs35l56_private *cs35l56 = container_of(work, 230 struct cs35l56_private, 231 sdw_irq_work); 232 233 cs35l56_irq(-1, cs35l56); 234 235 /* unmask interrupts */ 236 if (!cs35l56->sdw_irq_no_unmask) 237 sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_MASK_1, 238 CS35L56_SDW_INT_MASK_CODEC_IRQ); 239 240 pm_runtime_put_autosuspend(cs35l56->dev); 241 } 242 243 static int cs35l56_sdw_read_prop(struct sdw_slave *peripheral) 244 { 245 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 246 struct sdw_slave_prop *prop = &peripheral->prop; 247 struct sdw_dpn_prop *ports; 248 249 ports = devm_kcalloc(cs35l56->dev, 2, sizeof(*ports), GFP_KERNEL); 250 if (!ports) 251 return -ENOMEM; 252 253 prop->source_ports = BIT(CS35L56_SDW1_CAPTURE_PORT); 254 prop->sink_ports = BIT(CS35L56_SDW1_PLAYBACK_PORT); 255 prop->paging_support = true; 256 prop->clk_stop_mode1 = false; 257 prop->quirks = SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY; 258 prop->scp_int1_mask = SDW_SCP_INT1_BUS_CLASH | SDW_SCP_INT1_PARITY | SDW_SCP_INT1_IMPL_DEF; 259 260 /* DP1 - playback */ 261 ports[0].num = CS35L56_SDW1_PLAYBACK_PORT; 262 ports[0].type = SDW_DPN_FULL; 263 ports[0].ch_prep_timeout = 10; 264 prop->sink_dpn_prop = &ports[0]; 265 266 /* DP3 - capture */ 267 ports[1].num = CS35L56_SDW1_CAPTURE_PORT; 268 ports[1].type = SDW_DPN_FULL; 269 ports[1].ch_prep_timeout = 10; 270 prop->src_dpn_prop = &ports[1]; 271 272 return 0; 273 } 274 275 static int cs35l56_sdw_update_status(struct sdw_slave *peripheral, 276 enum sdw_slave_status status) 277 { 278 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 279 280 switch (status) { 281 case SDW_SLAVE_ATTACHED: 282 dev_dbg(cs35l56->dev, "%s: ATTACHED\n", __func__); 283 if (cs35l56->sdw_attached) 284 break; 285 286 if (!cs35l56->init_done || cs35l56->soft_resetting) 287 cs35l56_sdw_init(peripheral); 288 289 cs35l56->sdw_attached = true; 290 break; 291 case SDW_SLAVE_UNATTACHED: 292 dev_dbg(cs35l56->dev, "%s: UNATTACHED\n", __func__); 293 cs35l56->sdw_attached = false; 294 break; 295 default: 296 break; 297 } 298 299 return 0; 300 } 301 302 static int cs35l56_a1_kick_divider(struct cs35l56_private *cs35l56, 303 struct sdw_slave *peripheral) 304 { 305 unsigned int curr_scale_reg, next_scale_reg; 306 int curr_scale, next_scale, ret; 307 308 if (!cs35l56->init_done) 309 return 0; 310 311 if (peripheral->bus->params.curr_bank) { 312 curr_scale_reg = SDW_SCP_BUSCLOCK_SCALE_B1; 313 next_scale_reg = SDW_SCP_BUSCLOCK_SCALE_B0; 314 } else { 315 curr_scale_reg = SDW_SCP_BUSCLOCK_SCALE_B0; 316 next_scale_reg = SDW_SCP_BUSCLOCK_SCALE_B1; 317 } 318 319 /* 320 * Current clock scale value must be different to new value. 321 * Modify current to guarantee this. If next still has the dummy 322 * value we wrote when it was current, the core code has not set 323 * a new scale so restore its original good value 324 */ 325 curr_scale = sdw_read_no_pm(peripheral, curr_scale_reg); 326 if (curr_scale < 0) { 327 dev_err(cs35l56->dev, "Failed to read current clock scale: %d\n", curr_scale); 328 return curr_scale; 329 } 330 331 next_scale = sdw_read_no_pm(peripheral, next_scale_reg); 332 if (next_scale < 0) { 333 dev_err(cs35l56->dev, "Failed to read next clock scale: %d\n", next_scale); 334 return next_scale; 335 } 336 337 if (next_scale == CS35L56_SDW_INVALID_BUS_SCALE) { 338 next_scale = cs35l56->old_sdw_clock_scale; 339 ret = sdw_write_no_pm(peripheral, next_scale_reg, next_scale); 340 if (ret < 0) { 341 dev_err(cs35l56->dev, "Failed to modify current clock scale: %d\n", ret); 342 return ret; 343 } 344 } 345 346 cs35l56->old_sdw_clock_scale = curr_scale; 347 ret = sdw_write_no_pm(peripheral, curr_scale_reg, CS35L56_SDW_INVALID_BUS_SCALE); 348 if (ret < 0) { 349 dev_err(cs35l56->dev, "Failed to modify current clock scale: %d\n", ret); 350 return ret; 351 } 352 353 dev_dbg(cs35l56->dev, "Next bus scale: %#x\n", next_scale); 354 355 return 0; 356 } 357 358 static int cs35l56_sdw_bus_config(struct sdw_slave *peripheral, 359 struct sdw_bus_params *params) 360 { 361 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 362 int sclk; 363 364 sclk = params->curr_dr_freq / 2; 365 dev_dbg(cs35l56->dev, "%s: sclk=%u c=%u r=%u\n", __func__, sclk, params->col, params->row); 366 367 if (cs35l56->rev < 0xb0) 368 return cs35l56_a1_kick_divider(cs35l56, peripheral); 369 370 return 0; 371 } 372 373 static int __maybe_unused cs35l56_sdw_clk_stop(struct sdw_slave *peripheral, 374 enum sdw_clk_stop_mode mode, 375 enum sdw_clk_stop_type type) 376 { 377 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 378 379 dev_dbg(cs35l56->dev, "%s: mode:%d type:%d\n", __func__, mode, type); 380 381 return 0; 382 } 383 384 static const struct sdw_slave_ops cs35l56_sdw_ops = { 385 .read_prop = cs35l56_sdw_read_prop, 386 .interrupt_callback = cs35l56_sdw_interrupt, 387 .update_status = cs35l56_sdw_update_status, 388 .bus_config = cs35l56_sdw_bus_config, 389 #ifdef DEBUG 390 .clk_stop = cs35l56_sdw_clk_stop, 391 #endif 392 }; 393 394 static int __maybe_unused cs35l56_sdw_handle_unattach(struct cs35l56_private *cs35l56) 395 { 396 struct sdw_slave *peripheral = cs35l56->sdw_peripheral; 397 398 if (peripheral->unattach_request) { 399 /* Cannot access registers until bus is re-initialized. */ 400 dev_dbg(cs35l56->dev, "Wait for initialization_complete\n"); 401 if (!wait_for_completion_timeout(&peripheral->initialization_complete, 402 msecs_to_jiffies(5000))) { 403 dev_err(cs35l56->dev, "initialization_complete timed out\n"); 404 return -ETIMEDOUT; 405 } 406 407 peripheral->unattach_request = 0; 408 409 /* 410 * Don't call regcache_mark_dirty(), we can't be sure that the 411 * Manager really did issue a Bus Reset. 412 */ 413 } 414 415 return 0; 416 } 417 418 static int __maybe_unused cs35l56_sdw_runtime_suspend(struct device *dev) 419 { 420 struct cs35l56_private *cs35l56 = dev_get_drvdata(dev); 421 422 if (!cs35l56->init_done) 423 return 0; 424 425 return cs35l56_runtime_suspend(dev); 426 } 427 428 static int __maybe_unused cs35l56_sdw_runtime_resume(struct device *dev) 429 { 430 struct cs35l56_private *cs35l56 = dev_get_drvdata(dev); 431 int ret; 432 433 dev_dbg(dev, "Runtime resume\n"); 434 435 if (!cs35l56->init_done) 436 return 0; 437 438 ret = cs35l56_sdw_handle_unattach(cs35l56); 439 if (ret < 0) 440 return ret; 441 442 ret = cs35l56_runtime_resume_common(cs35l56); 443 if (ret) 444 return ret; 445 446 /* Re-enable SoundWire interrupts */ 447 sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_MASK_1, 448 CS35L56_SDW_INT_MASK_CODEC_IRQ); 449 450 return 0; 451 } 452 453 static int __maybe_unused cs35l56_sdw_system_suspend(struct device *dev) 454 { 455 struct cs35l56_private *cs35l56 = dev_get_drvdata(dev); 456 457 if (!cs35l56->init_done) 458 return 0; 459 460 /* 461 * Disable SoundWire interrupts. 462 * Flush - don't cancel because that could leave an unbalanced pm_runtime_get. 463 */ 464 cs35l56->sdw_irq_no_unmask = true; 465 flush_work(&cs35l56->sdw_irq_work); 466 467 /* Mask interrupts and flush in case sdw_irq_work was queued again */ 468 sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_MASK_1, 0); 469 sdw_read_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_STAT_1); 470 sdw_write_no_pm(cs35l56->sdw_peripheral, CS35L56_SDW_GEN_INT_STAT_1, 0xFF); 471 flush_work(&cs35l56->sdw_irq_work); 472 473 return cs35l56_system_suspend(dev); 474 } 475 476 static int __maybe_unused cs35l56_sdw_system_resume(struct device *dev) 477 { 478 struct cs35l56_private *cs35l56 = dev_get_drvdata(dev); 479 480 cs35l56->sdw_irq_no_unmask = false; 481 /* runtime_resume re-enables the interrupt */ 482 483 return cs35l56_system_resume(dev); 484 } 485 486 static int cs35l56_sdw_probe(struct sdw_slave *peripheral, const struct sdw_device_id *id) 487 { 488 struct device *dev = &peripheral->dev; 489 struct cs35l56_private *cs35l56; 490 int ret; 491 492 cs35l56 = devm_kzalloc(dev, sizeof(*cs35l56), GFP_KERNEL); 493 if (!cs35l56) 494 return -ENOMEM; 495 496 cs35l56->dev = dev; 497 cs35l56->sdw_peripheral = peripheral; 498 INIT_WORK(&cs35l56->sdw_irq_work, cs35l56_sdw_irq_work); 499 500 dev_set_drvdata(dev, cs35l56); 501 502 cs35l56->regmap = devm_regmap_init(dev, &cs35l56_regmap_bus_sdw, 503 peripheral, &cs35l56_regmap_sdw); 504 if (IS_ERR(cs35l56->regmap)) { 505 ret = PTR_ERR(cs35l56->regmap); 506 return dev_err_probe(dev, ret, "Failed to allocate register map\n"); 507 } 508 509 /* Start in cache-only until device is enumerated */ 510 regcache_cache_only(cs35l56->regmap, true); 511 512 ret = cs35l56_common_probe(cs35l56); 513 if (ret != 0) 514 return ret; 515 516 return 0; 517 } 518 519 static int cs35l56_sdw_remove(struct sdw_slave *peripheral) 520 { 521 struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev); 522 523 /* Disable SoundWire interrupts */ 524 cs35l56->sdw_irq_no_unmask = true; 525 cancel_work_sync(&cs35l56->sdw_irq_work); 526 sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_MASK_1, 0); 527 sdw_read_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1); 528 sdw_write_no_pm(peripheral, CS35L56_SDW_GEN_INT_STAT_1, 0xFF); 529 530 cs35l56_remove(cs35l56); 531 532 return 0; 533 } 534 535 static const struct dev_pm_ops cs35l56_sdw_pm = { 536 SET_RUNTIME_PM_OPS(cs35l56_sdw_runtime_suspend, cs35l56_sdw_runtime_resume, NULL) 537 SYSTEM_SLEEP_PM_OPS(cs35l56_sdw_system_suspend, cs35l56_sdw_system_resume) 538 LATE_SYSTEM_SLEEP_PM_OPS(cs35l56_system_suspend_late, cs35l56_system_resume_early) 539 /* NOIRQ stage not needed, SoundWire doesn't use a hard IRQ */ 540 }; 541 542 static const struct sdw_device_id cs35l56_sdw_id[] = { 543 SDW_SLAVE_ENTRY(0x01FA, 0x3556, 0), 544 {}, 545 }; 546 MODULE_DEVICE_TABLE(sdw, cs35l56_sdw_id); 547 548 static struct sdw_driver cs35l56_sdw_driver = { 549 .driver = { 550 .name = "cs35l56", 551 .pm = &cs35l56_sdw_pm, 552 }, 553 .probe = cs35l56_sdw_probe, 554 .remove = cs35l56_sdw_remove, 555 .ops = &cs35l56_sdw_ops, 556 .id_table = cs35l56_sdw_id, 557 }; 558 559 module_sdw_driver(cs35l56_sdw_driver); 560 561 MODULE_DESCRIPTION("ASoC CS35L56 SoundWire driver"); 562 MODULE_IMPORT_NS(SND_SOC_CS35L56_CORE); 563 MODULE_IMPORT_NS(SND_SOC_CS35L56_SHARED); 564 MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>"); 565 MODULE_AUTHOR("Simon Trimmer <simont@opensource.cirrus.com>"); 566 MODULE_LICENSE("GPL"); 567