sound/soc/codecs/cs35l56-sdw.c

Source file repositories/reference/linux-study-clean/sound/soc/codecs/cs35l56-sdw.c

File Facts

System
Linux kernel
Corpus path
sound/soc/codecs/cs35l56-sdw.c
Extension
.c
Size
14596 bytes
Lines
536
Domain
Driver Families
Bucket
sound/soc
Inferred role
Driver Families: implementation source
Status
source implementation candidate

Why This File Exists

Repeatable hardware-adapter layer. Deep compatibility for every driver is out of scope; this atlas records patterns, probe lifecycles, bus glue, IRQ/DMA usage, and links back to core abstractions.

Dependency Surface

Detected Declarations

Annotated Snippet

if (ret < 0) {
			dev_err(&peripheral->dev, "!CMD_IN_PROGRESS fail: %d\n", ret);
			return ret;
		}

		/* Reading LSByte triggers read of register to holding buffer */
		sdw_read_no_pm(peripheral, reg + i);

		/* Wait for data available */
		ret = cs35l56_sdw_poll_mem_status(peripheral,
						  CS35L56_SDW_RDATA_RDY,
						  CS35L56_SDW_RDATA_RDY);
		if (ret < 0) {
			dev_err(&peripheral->dev, "RDATA_RDY fail: %d\n", ret);
			return ret;
		}

		/* Read data from buffer */
		ret = sdw_nread_no_pm(peripheral, CS35L56_SDW_MEM_READ_DATA,
				      sizeof(u32), &buf[i]);
		if (ret) {
			dev_err(&peripheral->dev, "Late read @%#x failed: %d\n", reg + i, ret);
			return ret;
		}

		swab32s((u32 *)&buf[i]);
	}

	return 0;
}

static int cs35l56_sdw_read(void *context, const void *reg_buf,
			    const size_t reg_size, void *val_buf,
			    size_t val_size)
{
	struct sdw_slave *peripheral = context;
	struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev);
	unsigned int reg_addr = get_unaligned_le32(reg_buf);
	int ret;

	if (cs35l56_is_otp_register(reg_addr - CS35L56_SDW_ADDR_OFFSET))
		return cs35l56_sdw_slow_read(peripheral, reg_addr, (u8 *)val_buf, val_size);

	ret = regmap_raw_read(cs35l56->sdw_bus_regmap, reg_addr, val_buf, val_size);
	if (ret)
		return ret;

	swab32_array((u32 *)val_buf, val_size / sizeof(u32));

	return 0;
}

static inline void cs35l56_swab_copy(void *dest, const void *src, size_t nbytes)
{
	u32 *dest32 = dest;
	const u32 *src32 = src;

	for (; nbytes > 0; nbytes -= 4)
		*dest32++ = swab32(*src32++);
}

static int cs35l56_sdw_gather_write(void *context,
				    const void *reg_buf, size_t reg_size,
				    const void *val_buf, size_t val_size)
{
	struct sdw_slave *peripheral = context;
	struct cs35l56_private *cs35l56 = dev_get_drvdata(&peripheral->dev);
	unsigned int reg_addr = get_unaligned_le32(reg_buf);
	u32 swab_buf[64];	/* Define u32 so it is 32-bit aligned */
	int ret;

	while (val_size > sizeof(swab_buf)) {
		cs35l56_swab_copy(swab_buf, val_buf, sizeof(swab_buf));
		ret = regmap_raw_write(cs35l56->sdw_bus_regmap, reg_addr,
				       swab_buf, sizeof(swab_buf));
		if (ret)
			return ret;

		val_size -= sizeof(swab_buf);
		reg_addr += sizeof(swab_buf);
		val_buf += sizeof(swab_buf);
	}

	if (val_size == 0)
		return 0;

	cs35l56_swab_copy(swab_buf, val_buf, val_size);

	return regmap_raw_write(cs35l56->sdw_bus_regmap, reg_addr, swab_buf, val_size);
}

Annotation

Implementation Notes