xref: /openbmc/linux/drivers/i3c/master/dw-i3c-master.c (revision e2d43101f61d6e79510d1cd9e7052b4745b8d809)
11dd728f5SVitor Soares // SPDX-License-Identifier: GPL-2.0
21dd728f5SVitor Soares /*
31dd728f5SVitor Soares  * Copyright (c) 2018 Synopsys, Inc. and/or its affiliates.
41dd728f5SVitor Soares  *
51dd728f5SVitor Soares  * Author: Vitor Soares <vitor.soares@synopsys.com>
61dd728f5SVitor Soares  */
71dd728f5SVitor Soares 
81dd728f5SVitor Soares #include <linux/bitops.h>
91dd728f5SVitor Soares #include <linux/clk.h>
101dd728f5SVitor Soares #include <linux/completion.h>
111dd728f5SVitor Soares #include <linux/err.h>
121dd728f5SVitor Soares #include <linux/errno.h>
131dd728f5SVitor Soares #include <linux/i3c/master.h>
141dd728f5SVitor Soares #include <linux/interrupt.h>
151dd728f5SVitor Soares #include <linux/ioport.h>
161dd728f5SVitor Soares #include <linux/iopoll.h>
171dd728f5SVitor Soares #include <linux/list.h>
181dd728f5SVitor Soares #include <linux/module.h>
191dd728f5SVitor Soares #include <linux/of.h>
201dd728f5SVitor Soares #include <linux/platform_device.h>
211dd728f5SVitor Soares #include <linux/reset.h>
221dd728f5SVitor Soares #include <linux/slab.h>
231dd728f5SVitor Soares 
24d782188cSJeremy Kerr #include "dw-i3c-master.h"
25d782188cSJeremy Kerr 
261dd728f5SVitor Soares #define DEVICE_CTRL			0x0
271dd728f5SVitor Soares #define DEV_CTRL_ENABLE			BIT(31)
281dd728f5SVitor Soares #define DEV_CTRL_RESUME			BIT(30)
291dd728f5SVitor Soares #define DEV_CTRL_HOT_JOIN_NACK		BIT(8)
301dd728f5SVitor Soares #define DEV_CTRL_I2C_SLAVE_PRESENT	BIT(7)
311dd728f5SVitor Soares 
321dd728f5SVitor Soares #define DEVICE_ADDR			0x4
331dd728f5SVitor Soares #define DEV_ADDR_DYNAMIC_ADDR_VALID	BIT(31)
341dd728f5SVitor Soares #define DEV_ADDR_DYNAMIC(x)		(((x) << 16) & GENMASK(22, 16))
351dd728f5SVitor Soares 
361dd728f5SVitor Soares #define HW_CAPABILITY			0x8
371dd728f5SVitor Soares #define COMMAND_QUEUE_PORT		0xc
381dd728f5SVitor Soares #define COMMAND_PORT_TOC		BIT(30)
391dd728f5SVitor Soares #define COMMAND_PORT_READ_TRANSFER	BIT(28)
401dd728f5SVitor Soares #define COMMAND_PORT_SDAP		BIT(27)
411dd728f5SVitor Soares #define COMMAND_PORT_ROC		BIT(26)
421dd728f5SVitor Soares #define COMMAND_PORT_SPEED(x)		(((x) << 21) & GENMASK(23, 21))
431dd728f5SVitor Soares #define COMMAND_PORT_DEV_INDEX(x)	(((x) << 16) & GENMASK(20, 16))
441dd728f5SVitor Soares #define COMMAND_PORT_CP			BIT(15)
451dd728f5SVitor Soares #define COMMAND_PORT_CMD(x)		(((x) << 7) & GENMASK(14, 7))
461dd728f5SVitor Soares #define COMMAND_PORT_TID(x)		(((x) << 3) & GENMASK(6, 3))
471dd728f5SVitor Soares 
481dd728f5SVitor Soares #define COMMAND_PORT_ARG_DATA_LEN(x)	(((x) << 16) & GENMASK(31, 16))
491dd728f5SVitor Soares #define COMMAND_PORT_ARG_DATA_LEN_MAX	65536
501dd728f5SVitor Soares #define COMMAND_PORT_TRANSFER_ARG	0x01
511dd728f5SVitor Soares 
521dd728f5SVitor Soares #define COMMAND_PORT_SDA_DATA_BYTE_3(x)	(((x) << 24) & GENMASK(31, 24))
531dd728f5SVitor Soares #define COMMAND_PORT_SDA_DATA_BYTE_2(x)	(((x) << 16) & GENMASK(23, 16))
541dd728f5SVitor Soares #define COMMAND_PORT_SDA_DATA_BYTE_1(x)	(((x) << 8) & GENMASK(15, 8))
551dd728f5SVitor Soares #define COMMAND_PORT_SDA_BYTE_STRB_3	BIT(5)
561dd728f5SVitor Soares #define COMMAND_PORT_SDA_BYTE_STRB_2	BIT(4)
571dd728f5SVitor Soares #define COMMAND_PORT_SDA_BYTE_STRB_1	BIT(3)
581dd728f5SVitor Soares #define COMMAND_PORT_SHORT_DATA_ARG	0x02
591dd728f5SVitor Soares 
601dd728f5SVitor Soares #define COMMAND_PORT_DEV_COUNT(x)	(((x) << 21) & GENMASK(25, 21))
611dd728f5SVitor Soares #define COMMAND_PORT_ADDR_ASSGN_CMD	0x03
621dd728f5SVitor Soares 
631dd728f5SVitor Soares #define RESPONSE_QUEUE_PORT		0x10
641dd728f5SVitor Soares #define RESPONSE_PORT_ERR_STATUS(x)	(((x) & GENMASK(31, 28)) >> 28)
651dd728f5SVitor Soares #define RESPONSE_NO_ERROR		0
661dd728f5SVitor Soares #define RESPONSE_ERROR_CRC		1
671dd728f5SVitor Soares #define RESPONSE_ERROR_PARITY		2
681dd728f5SVitor Soares #define RESPONSE_ERROR_FRAME		3
691dd728f5SVitor Soares #define RESPONSE_ERROR_IBA_NACK		4
701dd728f5SVitor Soares #define RESPONSE_ERROR_ADDRESS_NACK	5
711dd728f5SVitor Soares #define RESPONSE_ERROR_OVER_UNDER_FLOW	6
721dd728f5SVitor Soares #define RESPONSE_ERROR_TRANSF_ABORT	8
731dd728f5SVitor Soares #define RESPONSE_ERROR_I2C_W_NACK_ERR	9
741dd728f5SVitor Soares #define RESPONSE_PORT_TID(x)		(((x) & GENMASK(27, 24)) >> 24)
751dd728f5SVitor Soares #define RESPONSE_PORT_DATA_LEN(x)	((x) & GENMASK(15, 0))
761dd728f5SVitor Soares 
771dd728f5SVitor Soares #define RX_TX_DATA_PORT			0x14
781dd728f5SVitor Soares #define IBI_QUEUE_STATUS		0x18
791dd728f5SVitor Soares #define QUEUE_THLD_CTRL			0x1c
801dd728f5SVitor Soares #define QUEUE_THLD_CTRL_RESP_BUF_MASK	GENMASK(15, 8)
811dd728f5SVitor Soares #define QUEUE_THLD_CTRL_RESP_BUF(x)	(((x) - 1) << 8)
821dd728f5SVitor Soares 
831dd728f5SVitor Soares #define DATA_BUFFER_THLD_CTRL		0x20
841dd728f5SVitor Soares #define DATA_BUFFER_THLD_CTRL_RX_BUF	GENMASK(11, 8)
851dd728f5SVitor Soares 
861dd728f5SVitor Soares #define IBI_QUEUE_CTRL			0x24
871dd728f5SVitor Soares #define IBI_MR_REQ_REJECT		0x2C
881dd728f5SVitor Soares #define IBI_SIR_REQ_REJECT		0x30
891dd728f5SVitor Soares #define IBI_REQ_REJECT_ALL		GENMASK(31, 0)
901dd728f5SVitor Soares 
911dd728f5SVitor Soares #define RESET_CTRL			0x34
921dd728f5SVitor Soares #define RESET_CTRL_IBI_QUEUE		BIT(5)
931dd728f5SVitor Soares #define RESET_CTRL_RX_FIFO		BIT(4)
941dd728f5SVitor Soares #define RESET_CTRL_TX_FIFO		BIT(3)
951dd728f5SVitor Soares #define RESET_CTRL_RESP_QUEUE		BIT(2)
961dd728f5SVitor Soares #define RESET_CTRL_CMD_QUEUE		BIT(1)
971dd728f5SVitor Soares #define RESET_CTRL_SOFT			BIT(0)
981dd728f5SVitor Soares 
991dd728f5SVitor Soares #define SLV_EVENT_CTRL			0x38
1001dd728f5SVitor Soares #define INTR_STATUS			0x3c
1011dd728f5SVitor Soares #define INTR_STATUS_EN			0x40
1021dd728f5SVitor Soares #define INTR_SIGNAL_EN			0x44
1031dd728f5SVitor Soares #define INTR_FORCE			0x48
1041dd728f5SVitor Soares #define INTR_BUSOWNER_UPDATE_STAT	BIT(13)
1051dd728f5SVitor Soares #define INTR_IBI_UPDATED_STAT		BIT(12)
1061dd728f5SVitor Soares #define INTR_READ_REQ_RECV_STAT		BIT(11)
1071dd728f5SVitor Soares #define INTR_DEFSLV_STAT		BIT(10)
1081dd728f5SVitor Soares #define INTR_TRANSFER_ERR_STAT		BIT(9)
1091dd728f5SVitor Soares #define INTR_DYN_ADDR_ASSGN_STAT	BIT(8)
1101dd728f5SVitor Soares #define INTR_CCC_UPDATED_STAT		BIT(6)
1111dd728f5SVitor Soares #define INTR_TRANSFER_ABORT_STAT	BIT(5)
1121dd728f5SVitor Soares #define INTR_RESP_READY_STAT		BIT(4)
1131dd728f5SVitor Soares #define INTR_CMD_QUEUE_READY_STAT	BIT(3)
1141dd728f5SVitor Soares #define INTR_IBI_THLD_STAT		BIT(2)
1151dd728f5SVitor Soares #define INTR_RX_THLD_STAT		BIT(1)
1161dd728f5SVitor Soares #define INTR_TX_THLD_STAT		BIT(0)
1171dd728f5SVitor Soares #define INTR_ALL			(INTR_BUSOWNER_UPDATE_STAT |	\
1181dd728f5SVitor Soares 					INTR_IBI_UPDATED_STAT |		\
1191dd728f5SVitor Soares 					INTR_READ_REQ_RECV_STAT |	\
1201dd728f5SVitor Soares 					INTR_DEFSLV_STAT |		\
1211dd728f5SVitor Soares 					INTR_TRANSFER_ERR_STAT |	\
1221dd728f5SVitor Soares 					INTR_DYN_ADDR_ASSGN_STAT |	\
1231dd728f5SVitor Soares 					INTR_CCC_UPDATED_STAT |		\
1241dd728f5SVitor Soares 					INTR_TRANSFER_ABORT_STAT |	\
1251dd728f5SVitor Soares 					INTR_RESP_READY_STAT |		\
1261dd728f5SVitor Soares 					INTR_CMD_QUEUE_READY_STAT |	\
1271dd728f5SVitor Soares 					INTR_IBI_THLD_STAT |		\
1281dd728f5SVitor Soares 					INTR_TX_THLD_STAT |		\
1291dd728f5SVitor Soares 					INTR_RX_THLD_STAT)
1301dd728f5SVitor Soares 
1311dd728f5SVitor Soares #define INTR_MASTER_MASK		(INTR_TRANSFER_ERR_STAT |	\
1321dd728f5SVitor Soares 					 INTR_RESP_READY_STAT)
1331dd728f5SVitor Soares 
1341dd728f5SVitor Soares #define QUEUE_STATUS_LEVEL		0x4c
1351dd728f5SVitor Soares #define QUEUE_STATUS_IBI_STATUS_CNT(x)	(((x) & GENMASK(28, 24)) >> 24)
1361dd728f5SVitor Soares #define QUEUE_STATUS_IBI_BUF_BLR(x)	(((x) & GENMASK(23, 16)) >> 16)
1371dd728f5SVitor Soares #define QUEUE_STATUS_LEVEL_RESP(x)	(((x) & GENMASK(15, 8)) >> 8)
1381dd728f5SVitor Soares #define QUEUE_STATUS_LEVEL_CMD(x)	((x) & GENMASK(7, 0))
1391dd728f5SVitor Soares 
1401dd728f5SVitor Soares #define DATA_BUFFER_STATUS_LEVEL	0x50
1411dd728f5SVitor Soares #define DATA_BUFFER_STATUS_LEVEL_TX(x)	((x) & GENMASK(7, 0))
1421dd728f5SVitor Soares 
1431dd728f5SVitor Soares #define PRESENT_STATE			0x54
1441dd728f5SVitor Soares #define CCC_DEVICE_STATUS		0x58
1451dd728f5SVitor Soares #define DEVICE_ADDR_TABLE_POINTER	0x5c
1461dd728f5SVitor Soares #define DEVICE_ADDR_TABLE_DEPTH(x)	(((x) & GENMASK(31, 16)) >> 16)
1471dd728f5SVitor Soares #define DEVICE_ADDR_TABLE_ADDR(x)	((x) & GENMASK(7, 0))
1481dd728f5SVitor Soares 
1491dd728f5SVitor Soares #define DEV_CHAR_TABLE_POINTER		0x60
1501dd728f5SVitor Soares #define VENDOR_SPECIFIC_REG_POINTER	0x6c
1511dd728f5SVitor Soares #define SLV_PID_VALUE			0x74
1521dd728f5SVitor Soares #define SLV_CHAR_CTRL			0x78
1531dd728f5SVitor Soares #define SLV_MAX_LEN			0x7c
1541dd728f5SVitor Soares #define MAX_READ_TURNAROUND		0x80
1551dd728f5SVitor Soares #define MAX_DATA_SPEED			0x84
1561dd728f5SVitor Soares #define SLV_DEBUG_STATUS		0x88
1571dd728f5SVitor Soares #define SLV_INTR_REQ			0x8c
1581dd728f5SVitor Soares #define DEVICE_CTRL_EXTENDED		0xb0
1591dd728f5SVitor Soares #define SCL_I3C_OD_TIMING		0xb4
1601dd728f5SVitor Soares #define SCL_I3C_PP_TIMING		0xb8
1611dd728f5SVitor Soares #define SCL_I3C_TIMING_HCNT(x)		(((x) << 16) & GENMASK(23, 16))
1621dd728f5SVitor Soares #define SCL_I3C_TIMING_LCNT(x)		((x) & GENMASK(7, 0))
1631dd728f5SVitor Soares #define SCL_I3C_TIMING_CNT_MIN		5
1641dd728f5SVitor Soares 
1651dd728f5SVitor Soares #define SCL_I2C_FM_TIMING		0xbc
1661dd728f5SVitor Soares #define SCL_I2C_FM_TIMING_HCNT(x)	(((x) << 16) & GENMASK(31, 16))
1671dd728f5SVitor Soares #define SCL_I2C_FM_TIMING_LCNT(x)	((x) & GENMASK(15, 0))
1681dd728f5SVitor Soares 
1691dd728f5SVitor Soares #define SCL_I2C_FMP_TIMING		0xc0
1701dd728f5SVitor Soares #define SCL_I2C_FMP_TIMING_HCNT(x)	(((x) << 16) & GENMASK(23, 16))
1711dd728f5SVitor Soares #define SCL_I2C_FMP_TIMING_LCNT(x)	((x) & GENMASK(15, 0))
1721dd728f5SVitor Soares 
1731dd728f5SVitor Soares #define SCL_EXT_LCNT_TIMING		0xc8
1741dd728f5SVitor Soares #define SCL_EXT_LCNT_4(x)		(((x) << 24) & GENMASK(31, 24))
1751dd728f5SVitor Soares #define SCL_EXT_LCNT_3(x)		(((x) << 16) & GENMASK(23, 16))
1761dd728f5SVitor Soares #define SCL_EXT_LCNT_2(x)		(((x) << 8) & GENMASK(15, 8))
1771dd728f5SVitor Soares #define SCL_EXT_LCNT_1(x)		((x) & GENMASK(7, 0))
1781dd728f5SVitor Soares 
1791dd728f5SVitor Soares #define SCL_EXT_TERMN_LCNT_TIMING	0xcc
1801dd728f5SVitor Soares #define BUS_FREE_TIMING			0xd4
1811dd728f5SVitor Soares #define BUS_I3C_MST_FREE(x)		((x) & GENMASK(15, 0))
1821dd728f5SVitor Soares 
1831dd728f5SVitor Soares #define BUS_IDLE_TIMING			0xd8
1841dd728f5SVitor Soares #define I3C_VER_ID			0xe0
1851dd728f5SVitor Soares #define I3C_VER_TYPE			0xe4
1861dd728f5SVitor Soares #define EXTENDED_CAPABILITY		0xe8
1871dd728f5SVitor Soares #define SLAVE_CONFIG			0xec
1881dd728f5SVitor Soares 
1891dd728f5SVitor Soares #define DEV_ADDR_TABLE_LEGACY_I2C_DEV	BIT(31)
1901dd728f5SVitor Soares #define DEV_ADDR_TABLE_DYNAMIC_ADDR(x)	(((x) << 16) & GENMASK(23, 16))
1911dd728f5SVitor Soares #define DEV_ADDR_TABLE_STATIC_ADDR(x)	((x) & GENMASK(6, 0))
1921dd728f5SVitor Soares #define DEV_ADDR_TABLE_LOC(start, idx)	((start) + ((idx) << 2))
1931dd728f5SVitor Soares 
1941dd728f5SVitor Soares #define I3C_BUS_SDR1_SCL_RATE		8000000
1951dd728f5SVitor Soares #define I3C_BUS_SDR2_SCL_RATE		6000000
1961dd728f5SVitor Soares #define I3C_BUS_SDR3_SCL_RATE		4000000
1971dd728f5SVitor Soares #define I3C_BUS_SDR4_SCL_RATE		2000000
1981dd728f5SVitor Soares #define I3C_BUS_I2C_FM_TLOW_MIN_NS	1300
1991dd728f5SVitor Soares #define I3C_BUS_I2C_FMP_TLOW_MIN_NS	500
2001dd728f5SVitor Soares #define I3C_BUS_THIGH_MAX_NS		41
2011dd728f5SVitor Soares 
2021dd728f5SVitor Soares #define XFER_TIMEOUT (msecs_to_jiffies(1000))
2031dd728f5SVitor Soares 
2041dd728f5SVitor Soares struct dw_i3c_cmd {
2051dd728f5SVitor Soares 	u32 cmd_lo;
2061dd728f5SVitor Soares 	u32 cmd_hi;
2071dd728f5SVitor Soares 	u16 tx_len;
2081dd728f5SVitor Soares 	const void *tx_buf;
2091dd728f5SVitor Soares 	u16 rx_len;
2101dd728f5SVitor Soares 	void *rx_buf;
2111dd728f5SVitor Soares 	u8 error;
2121dd728f5SVitor Soares };
2131dd728f5SVitor Soares 
2141dd728f5SVitor Soares struct dw_i3c_xfer {
2151dd728f5SVitor Soares 	struct list_head node;
2161dd728f5SVitor Soares 	struct completion comp;
2171dd728f5SVitor Soares 	int ret;
2181dd728f5SVitor Soares 	unsigned int ncmds;
219cd851485SGustavo A. R. Silva 	struct dw_i3c_cmd cmds[];
2201dd728f5SVitor Soares };
2211dd728f5SVitor Soares 
2221dd728f5SVitor Soares struct dw_i3c_i2c_dev_data {
2231dd728f5SVitor Soares 	u8 index;
2241dd728f5SVitor Soares };
2251dd728f5SVitor Soares 
2261dd728f5SVitor Soares static u8 even_parity(u8 p)
2271dd728f5SVitor Soares {
2281dd728f5SVitor Soares 	p ^= p >> 4;
2291dd728f5SVitor Soares 	p &= 0xf;
2301dd728f5SVitor Soares 
2311dd728f5SVitor Soares 	return (0x9669 >> p) & 1;
2321dd728f5SVitor Soares }
2331dd728f5SVitor Soares 
2341dd728f5SVitor Soares static bool dw_i3c_master_supports_ccc_cmd(struct i3c_master_controller *m,
2351dd728f5SVitor Soares 					   const struct i3c_ccc_cmd *cmd)
2361dd728f5SVitor Soares {
2371dd728f5SVitor Soares 	if (cmd->ndests > 1)
2381dd728f5SVitor Soares 		return false;
2391dd728f5SVitor Soares 
2401dd728f5SVitor Soares 	switch (cmd->id) {
2411dd728f5SVitor Soares 	case I3C_CCC_ENEC(true):
2421dd728f5SVitor Soares 	case I3C_CCC_ENEC(false):
2431dd728f5SVitor Soares 	case I3C_CCC_DISEC(true):
2441dd728f5SVitor Soares 	case I3C_CCC_DISEC(false):
2451dd728f5SVitor Soares 	case I3C_CCC_ENTAS(0, true):
2461dd728f5SVitor Soares 	case I3C_CCC_ENTAS(0, false):
2471dd728f5SVitor Soares 	case I3C_CCC_RSTDAA(true):
2481dd728f5SVitor Soares 	case I3C_CCC_RSTDAA(false):
2491dd728f5SVitor Soares 	case I3C_CCC_ENTDAA:
2501dd728f5SVitor Soares 	case I3C_CCC_SETMWL(true):
2511dd728f5SVitor Soares 	case I3C_CCC_SETMWL(false):
2521dd728f5SVitor Soares 	case I3C_CCC_SETMRL(true):
2531dd728f5SVitor Soares 	case I3C_CCC_SETMRL(false):
2541dd728f5SVitor Soares 	case I3C_CCC_ENTHDR(0):
2551dd728f5SVitor Soares 	case I3C_CCC_SETDASA:
2561dd728f5SVitor Soares 	case I3C_CCC_SETNEWDA:
2571dd728f5SVitor Soares 	case I3C_CCC_GETMWL:
2581dd728f5SVitor Soares 	case I3C_CCC_GETMRL:
2591dd728f5SVitor Soares 	case I3C_CCC_GETPID:
2601dd728f5SVitor Soares 	case I3C_CCC_GETBCR:
2611dd728f5SVitor Soares 	case I3C_CCC_GETDCR:
2621dd728f5SVitor Soares 	case I3C_CCC_GETSTATUS:
2631dd728f5SVitor Soares 	case I3C_CCC_GETMXDS:
2641dd728f5SVitor Soares 	case I3C_CCC_GETHDRCAP:
2651dd728f5SVitor Soares 		return true;
2661dd728f5SVitor Soares 	default:
2671dd728f5SVitor Soares 		return false;
2681dd728f5SVitor Soares 	}
2691dd728f5SVitor Soares }
2701dd728f5SVitor Soares 
2711dd728f5SVitor Soares static inline struct dw_i3c_master *
2721dd728f5SVitor Soares to_dw_i3c_master(struct i3c_master_controller *master)
2731dd728f5SVitor Soares {
2741dd728f5SVitor Soares 	return container_of(master, struct dw_i3c_master, base);
2751dd728f5SVitor Soares }
2761dd728f5SVitor Soares 
2771dd728f5SVitor Soares static void dw_i3c_master_disable(struct dw_i3c_master *master)
2781dd728f5SVitor Soares {
279907621e9SVitor Soares 	writel(readl(master->regs + DEVICE_CTRL) & ~DEV_CTRL_ENABLE,
2801dd728f5SVitor Soares 	       master->regs + DEVICE_CTRL);
2811dd728f5SVitor Soares }
2821dd728f5SVitor Soares 
2831dd728f5SVitor Soares static void dw_i3c_master_enable(struct dw_i3c_master *master)
2841dd728f5SVitor Soares {
2851dd728f5SVitor Soares 	writel(readl(master->regs + DEVICE_CTRL) | DEV_CTRL_ENABLE,
2861dd728f5SVitor Soares 	       master->regs + DEVICE_CTRL);
2871dd728f5SVitor Soares }
2881dd728f5SVitor Soares 
2891dd728f5SVitor Soares static int dw_i3c_master_get_addr_pos(struct dw_i3c_master *master, u8 addr)
2901dd728f5SVitor Soares {
2911dd728f5SVitor Soares 	int pos;
2921dd728f5SVitor Soares 
2931dd728f5SVitor Soares 	for (pos = 0; pos < master->maxdevs; pos++) {
294*e2d43101SJeremy Kerr 		if (addr == master->devs[pos].addr)
2951dd728f5SVitor Soares 			return pos;
2961dd728f5SVitor Soares 	}
2971dd728f5SVitor Soares 
2981dd728f5SVitor Soares 	return -EINVAL;
2991dd728f5SVitor Soares }
3001dd728f5SVitor Soares 
3011dd728f5SVitor Soares static int dw_i3c_master_get_free_pos(struct dw_i3c_master *master)
3021dd728f5SVitor Soares {
3031dd728f5SVitor Soares 	if (!(master->free_pos & GENMASK(master->maxdevs - 1, 0)))
3041dd728f5SVitor Soares 		return -ENOSPC;
3051dd728f5SVitor Soares 
3061dd728f5SVitor Soares 	return ffs(master->free_pos) - 1;
3071dd728f5SVitor Soares }
3081dd728f5SVitor Soares 
3091dd728f5SVitor Soares static void dw_i3c_master_wr_tx_fifo(struct dw_i3c_master *master,
3101dd728f5SVitor Soares 				     const u8 *bytes, int nbytes)
3111dd728f5SVitor Soares {
3121dd728f5SVitor Soares 	writesl(master->regs + RX_TX_DATA_PORT, bytes, nbytes / 4);
3131dd728f5SVitor Soares 	if (nbytes & 3) {
3141dd728f5SVitor Soares 		u32 tmp = 0;
3151dd728f5SVitor Soares 
3161dd728f5SVitor Soares 		memcpy(&tmp, bytes + (nbytes & ~3), nbytes & 3);
3171dd728f5SVitor Soares 		writesl(master->regs + RX_TX_DATA_PORT, &tmp, 1);
3181dd728f5SVitor Soares 	}
3191dd728f5SVitor Soares }
3201dd728f5SVitor Soares 
32179f42b31SJeremy Kerr static void dw_i3c_master_read_fifo(struct dw_i3c_master *master,
32279f42b31SJeremy Kerr 				    int reg,  u8 *bytes, int nbytes)
3231dd728f5SVitor Soares {
32479f42b31SJeremy Kerr 	readsl(master->regs + reg, bytes, nbytes / 4);
3251dd728f5SVitor Soares 	if (nbytes & 3) {
3261dd728f5SVitor Soares 		u32 tmp;
3271dd728f5SVitor Soares 
32879f42b31SJeremy Kerr 		readsl(master->regs + reg, &tmp, 1);
3291dd728f5SVitor Soares 		memcpy(bytes + (nbytes & ~3), &tmp, nbytes & 3);
3301dd728f5SVitor Soares 	}
3311dd728f5SVitor Soares }
3321dd728f5SVitor Soares 
33379f42b31SJeremy Kerr static void dw_i3c_master_read_rx_fifo(struct dw_i3c_master *master,
33479f42b31SJeremy Kerr 				       u8 *bytes, int nbytes)
33579f42b31SJeremy Kerr {
33679f42b31SJeremy Kerr 	return dw_i3c_master_read_fifo(master, RX_TX_DATA_PORT, bytes, nbytes);
33779f42b31SJeremy Kerr }
33879f42b31SJeremy Kerr 
3391dd728f5SVitor Soares static struct dw_i3c_xfer *
3401dd728f5SVitor Soares dw_i3c_master_alloc_xfer(struct dw_i3c_master *master, unsigned int ncmds)
3411dd728f5SVitor Soares {
3421dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer;
3431dd728f5SVitor Soares 
3441dd728f5SVitor Soares 	xfer = kzalloc(struct_size(xfer, cmds, ncmds), GFP_KERNEL);
3451dd728f5SVitor Soares 	if (!xfer)
3461dd728f5SVitor Soares 		return NULL;
3471dd728f5SVitor Soares 
3481dd728f5SVitor Soares 	INIT_LIST_HEAD(&xfer->node);
3491dd728f5SVitor Soares 	xfer->ncmds = ncmds;
3501dd728f5SVitor Soares 	xfer->ret = -ETIMEDOUT;
3511dd728f5SVitor Soares 
3521dd728f5SVitor Soares 	return xfer;
3531dd728f5SVitor Soares }
3541dd728f5SVitor Soares 
3551dd728f5SVitor Soares static void dw_i3c_master_free_xfer(struct dw_i3c_xfer *xfer)
3561dd728f5SVitor Soares {
3571dd728f5SVitor Soares 	kfree(xfer);
3581dd728f5SVitor Soares }
3591dd728f5SVitor Soares 
3601dd728f5SVitor Soares static void dw_i3c_master_start_xfer_locked(struct dw_i3c_master *master)
3611dd728f5SVitor Soares {
3621dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer = master->xferqueue.cur;
3631dd728f5SVitor Soares 	unsigned int i;
3641dd728f5SVitor Soares 	u32 thld_ctrl;
3651dd728f5SVitor Soares 
3661dd728f5SVitor Soares 	if (!xfer)
3671dd728f5SVitor Soares 		return;
3681dd728f5SVitor Soares 
3691dd728f5SVitor Soares 	for (i = 0; i < xfer->ncmds; i++) {
3701dd728f5SVitor Soares 		struct dw_i3c_cmd *cmd = &xfer->cmds[i];
3711dd728f5SVitor Soares 
3721dd728f5SVitor Soares 		dw_i3c_master_wr_tx_fifo(master, cmd->tx_buf, cmd->tx_len);
3731dd728f5SVitor Soares 	}
3741dd728f5SVitor Soares 
3751dd728f5SVitor Soares 	thld_ctrl = readl(master->regs + QUEUE_THLD_CTRL);
3761dd728f5SVitor Soares 	thld_ctrl &= ~QUEUE_THLD_CTRL_RESP_BUF_MASK;
3771dd728f5SVitor Soares 	thld_ctrl |= QUEUE_THLD_CTRL_RESP_BUF(xfer->ncmds);
3781dd728f5SVitor Soares 	writel(thld_ctrl, master->regs + QUEUE_THLD_CTRL);
3791dd728f5SVitor Soares 
3801dd728f5SVitor Soares 	for (i = 0; i < xfer->ncmds; i++) {
3811dd728f5SVitor Soares 		struct dw_i3c_cmd *cmd = &xfer->cmds[i];
3821dd728f5SVitor Soares 
3831dd728f5SVitor Soares 		writel(cmd->cmd_hi, master->regs + COMMAND_QUEUE_PORT);
3841dd728f5SVitor Soares 		writel(cmd->cmd_lo, master->regs + COMMAND_QUEUE_PORT);
3851dd728f5SVitor Soares 	}
3861dd728f5SVitor Soares }
3871dd728f5SVitor Soares 
3881dd728f5SVitor Soares static void dw_i3c_master_enqueue_xfer(struct dw_i3c_master *master,
3891dd728f5SVitor Soares 				       struct dw_i3c_xfer *xfer)
3901dd728f5SVitor Soares {
3911dd728f5SVitor Soares 	unsigned long flags;
3921dd728f5SVitor Soares 
3931dd728f5SVitor Soares 	init_completion(&xfer->comp);
3941dd728f5SVitor Soares 	spin_lock_irqsave(&master->xferqueue.lock, flags);
3951dd728f5SVitor Soares 	if (master->xferqueue.cur) {
3961dd728f5SVitor Soares 		list_add_tail(&xfer->node, &master->xferqueue.list);
3971dd728f5SVitor Soares 	} else {
3981dd728f5SVitor Soares 		master->xferqueue.cur = xfer;
3991dd728f5SVitor Soares 		dw_i3c_master_start_xfer_locked(master);
4001dd728f5SVitor Soares 	}
4011dd728f5SVitor Soares 	spin_unlock_irqrestore(&master->xferqueue.lock, flags);
4021dd728f5SVitor Soares }
4031dd728f5SVitor Soares 
404f36c1f9aSJisheng Zhang static void dw_i3c_master_dequeue_xfer_locked(struct dw_i3c_master *master,
4051dd728f5SVitor Soares 					      struct dw_i3c_xfer *xfer)
4061dd728f5SVitor Soares {
4071dd728f5SVitor Soares 	if (master->xferqueue.cur == xfer) {
4081dd728f5SVitor Soares 		u32 status;
4091dd728f5SVitor Soares 
4101dd728f5SVitor Soares 		master->xferqueue.cur = NULL;
4111dd728f5SVitor Soares 
4121dd728f5SVitor Soares 		writel(RESET_CTRL_RX_FIFO | RESET_CTRL_TX_FIFO |
4131dd728f5SVitor Soares 		       RESET_CTRL_RESP_QUEUE | RESET_CTRL_CMD_QUEUE,
4141dd728f5SVitor Soares 		       master->regs + RESET_CTRL);
4151dd728f5SVitor Soares 
4161dd728f5SVitor Soares 		readl_poll_timeout_atomic(master->regs + RESET_CTRL, status,
4171dd728f5SVitor Soares 					  !status, 10, 1000000);
4181dd728f5SVitor Soares 	} else {
4191dd728f5SVitor Soares 		list_del_init(&xfer->node);
4201dd728f5SVitor Soares 	}
421f36c1f9aSJisheng Zhang }
422f36c1f9aSJisheng Zhang 
423f36c1f9aSJisheng Zhang static void dw_i3c_master_dequeue_xfer(struct dw_i3c_master *master,
424f36c1f9aSJisheng Zhang 				       struct dw_i3c_xfer *xfer)
425f36c1f9aSJisheng Zhang {
426f36c1f9aSJisheng Zhang 	unsigned long flags;
427f36c1f9aSJisheng Zhang 
428f36c1f9aSJisheng Zhang 	spin_lock_irqsave(&master->xferqueue.lock, flags);
429f36c1f9aSJisheng Zhang 	dw_i3c_master_dequeue_xfer_locked(master, xfer);
4301dd728f5SVitor Soares 	spin_unlock_irqrestore(&master->xferqueue.lock, flags);
4311dd728f5SVitor Soares }
4321dd728f5SVitor Soares 
4331dd728f5SVitor Soares static void dw_i3c_master_end_xfer_locked(struct dw_i3c_master *master, u32 isr)
4341dd728f5SVitor Soares {
4351dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer = master->xferqueue.cur;
4361dd728f5SVitor Soares 	int i, ret = 0;
4371dd728f5SVitor Soares 	u32 nresp;
4381dd728f5SVitor Soares 
4391dd728f5SVitor Soares 	if (!xfer)
4401dd728f5SVitor Soares 		return;
4411dd728f5SVitor Soares 
4421dd728f5SVitor Soares 	nresp = readl(master->regs + QUEUE_STATUS_LEVEL);
4431dd728f5SVitor Soares 	nresp = QUEUE_STATUS_LEVEL_RESP(nresp);
4441dd728f5SVitor Soares 
4451dd728f5SVitor Soares 	for (i = 0; i < nresp; i++) {
4461dd728f5SVitor Soares 		struct dw_i3c_cmd *cmd;
4471dd728f5SVitor Soares 		u32 resp;
4481dd728f5SVitor Soares 
4491dd728f5SVitor Soares 		resp = readl(master->regs + RESPONSE_QUEUE_PORT);
4501dd728f5SVitor Soares 
4511dd728f5SVitor Soares 		cmd = &xfer->cmds[RESPONSE_PORT_TID(resp)];
4521dd728f5SVitor Soares 		cmd->rx_len = RESPONSE_PORT_DATA_LEN(resp);
4531dd728f5SVitor Soares 		cmd->error = RESPONSE_PORT_ERR_STATUS(resp);
4541dd728f5SVitor Soares 		if (cmd->rx_len && !cmd->error)
4551dd728f5SVitor Soares 			dw_i3c_master_read_rx_fifo(master, cmd->rx_buf,
4561dd728f5SVitor Soares 						   cmd->rx_len);
4571dd728f5SVitor Soares 	}
4581dd728f5SVitor Soares 
4591dd728f5SVitor Soares 	for (i = 0; i < nresp; i++) {
4601dd728f5SVitor Soares 		switch (xfer->cmds[i].error) {
4611dd728f5SVitor Soares 		case RESPONSE_NO_ERROR:
4621dd728f5SVitor Soares 			break;
4631dd728f5SVitor Soares 		case RESPONSE_ERROR_PARITY:
4641dd728f5SVitor Soares 		case RESPONSE_ERROR_IBA_NACK:
4651dd728f5SVitor Soares 		case RESPONSE_ERROR_TRANSF_ABORT:
4661dd728f5SVitor Soares 		case RESPONSE_ERROR_CRC:
4671dd728f5SVitor Soares 		case RESPONSE_ERROR_FRAME:
4681dd728f5SVitor Soares 			ret = -EIO;
4691dd728f5SVitor Soares 			break;
4701dd728f5SVitor Soares 		case RESPONSE_ERROR_OVER_UNDER_FLOW:
4711dd728f5SVitor Soares 			ret = -ENOSPC;
4721dd728f5SVitor Soares 			break;
4731dd728f5SVitor Soares 		case RESPONSE_ERROR_I2C_W_NACK_ERR:
4741dd728f5SVitor Soares 		case RESPONSE_ERROR_ADDRESS_NACK:
4751dd728f5SVitor Soares 		default:
4761dd728f5SVitor Soares 			ret = -EINVAL;
4771dd728f5SVitor Soares 			break;
4781dd728f5SVitor Soares 		}
4791dd728f5SVitor Soares 	}
4801dd728f5SVitor Soares 
4811dd728f5SVitor Soares 	xfer->ret = ret;
4821dd728f5SVitor Soares 	complete(&xfer->comp);
4831dd728f5SVitor Soares 
4841dd728f5SVitor Soares 	if (ret < 0) {
485f36c1f9aSJisheng Zhang 		dw_i3c_master_dequeue_xfer_locked(master, xfer);
4861dd728f5SVitor Soares 		writel(readl(master->regs + DEVICE_CTRL) | DEV_CTRL_RESUME,
4871dd728f5SVitor Soares 		       master->regs + DEVICE_CTRL);
4881dd728f5SVitor Soares 	}
4891dd728f5SVitor Soares 
4901dd728f5SVitor Soares 	xfer = list_first_entry_or_null(&master->xferqueue.list,
4911dd728f5SVitor Soares 					struct dw_i3c_xfer,
4921dd728f5SVitor Soares 					node);
4931dd728f5SVitor Soares 	if (xfer)
4941dd728f5SVitor Soares 		list_del_init(&xfer->node);
4951dd728f5SVitor Soares 
4961dd728f5SVitor Soares 	master->xferqueue.cur = xfer;
4971dd728f5SVitor Soares 	dw_i3c_master_start_xfer_locked(master);
4981dd728f5SVitor Soares }
4991dd728f5SVitor Soares 
5001dd728f5SVitor Soares static int dw_i3c_clk_cfg(struct dw_i3c_master *master)
5011dd728f5SVitor Soares {
5021dd728f5SVitor Soares 	unsigned long core_rate, core_period;
5031dd728f5SVitor Soares 	u32 scl_timing;
5041dd728f5SVitor Soares 	u8 hcnt, lcnt;
5051dd728f5SVitor Soares 
5061dd728f5SVitor Soares 	core_rate = clk_get_rate(master->core_clk);
5071dd728f5SVitor Soares 	if (!core_rate)
5081dd728f5SVitor Soares 		return -EINVAL;
5091dd728f5SVitor Soares 
5101dd728f5SVitor Soares 	core_period = DIV_ROUND_UP(1000000000, core_rate);
5111dd728f5SVitor Soares 
5121dd728f5SVitor Soares 	hcnt = DIV_ROUND_UP(I3C_BUS_THIGH_MAX_NS, core_period) - 1;
5131dd728f5SVitor Soares 	if (hcnt < SCL_I3C_TIMING_CNT_MIN)
5141dd728f5SVitor Soares 		hcnt = SCL_I3C_TIMING_CNT_MIN;
5151dd728f5SVitor Soares 
516510d2358SJack Chen 	lcnt = DIV_ROUND_UP(core_rate, master->base.bus.scl_rate.i3c) - hcnt;
5171dd728f5SVitor Soares 	if (lcnt < SCL_I3C_TIMING_CNT_MIN)
5181dd728f5SVitor Soares 		lcnt = SCL_I3C_TIMING_CNT_MIN;
5191dd728f5SVitor Soares 
5201dd728f5SVitor Soares 	scl_timing = SCL_I3C_TIMING_HCNT(hcnt) | SCL_I3C_TIMING_LCNT(lcnt);
5211dd728f5SVitor Soares 	writel(scl_timing, master->regs + SCL_I3C_PP_TIMING);
5221dd728f5SVitor Soares 
52366b32e3dSJeremy Kerr 	/*
52466b32e3dSJeremy Kerr 	 * In pure i3c mode, MST_FREE represents tCAS. In shared mode, this
52566b32e3dSJeremy Kerr 	 * will be set up by dw_i2c_clk_cfg as tLOW.
52666b32e3dSJeremy Kerr 	 */
52766b32e3dSJeremy Kerr 	if (master->base.bus.mode == I3C_BUS_MODE_PURE)
5281dd728f5SVitor Soares 		writel(BUS_I3C_MST_FREE(lcnt), master->regs + BUS_FREE_TIMING);
5291dd728f5SVitor Soares 
530510d2358SJack Chen 	lcnt = max_t(u8,
531510d2358SJack Chen 		     DIV_ROUND_UP(I3C_BUS_TLOW_OD_MIN_NS, core_period), lcnt);
5321dd728f5SVitor Soares 	scl_timing = SCL_I3C_TIMING_HCNT(hcnt) | SCL_I3C_TIMING_LCNT(lcnt);
5331dd728f5SVitor Soares 	writel(scl_timing, master->regs + SCL_I3C_OD_TIMING);
5341dd728f5SVitor Soares 
5351dd728f5SVitor Soares 	lcnt = DIV_ROUND_UP(core_rate, I3C_BUS_SDR1_SCL_RATE) - hcnt;
5361dd728f5SVitor Soares 	scl_timing = SCL_EXT_LCNT_1(lcnt);
5371dd728f5SVitor Soares 	lcnt = DIV_ROUND_UP(core_rate, I3C_BUS_SDR2_SCL_RATE) - hcnt;
5381dd728f5SVitor Soares 	scl_timing |= SCL_EXT_LCNT_2(lcnt);
5391dd728f5SVitor Soares 	lcnt = DIV_ROUND_UP(core_rate, I3C_BUS_SDR3_SCL_RATE) - hcnt;
5401dd728f5SVitor Soares 	scl_timing |= SCL_EXT_LCNT_3(lcnt);
5411dd728f5SVitor Soares 	lcnt = DIV_ROUND_UP(core_rate, I3C_BUS_SDR4_SCL_RATE) - hcnt;
5421dd728f5SVitor Soares 	scl_timing |= SCL_EXT_LCNT_4(lcnt);
5431dd728f5SVitor Soares 	writel(scl_timing, master->regs + SCL_EXT_LCNT_TIMING);
5441dd728f5SVitor Soares 
5451dd728f5SVitor Soares 	return 0;
5461dd728f5SVitor Soares }
5471dd728f5SVitor Soares 
5481dd728f5SVitor Soares static int dw_i2c_clk_cfg(struct dw_i3c_master *master)
5491dd728f5SVitor Soares {
5501dd728f5SVitor Soares 	unsigned long core_rate, core_period;
5511dd728f5SVitor Soares 	u16 hcnt, lcnt;
5521dd728f5SVitor Soares 	u32 scl_timing;
5531dd728f5SVitor Soares 
5541dd728f5SVitor Soares 	core_rate = clk_get_rate(master->core_clk);
5551dd728f5SVitor Soares 	if (!core_rate)
5561dd728f5SVitor Soares 		return -EINVAL;
5571dd728f5SVitor Soares 
5581dd728f5SVitor Soares 	core_period = DIV_ROUND_UP(1000000000, core_rate);
5591dd728f5SVitor Soares 
5601dd728f5SVitor Soares 	lcnt = DIV_ROUND_UP(I3C_BUS_I2C_FMP_TLOW_MIN_NS, core_period);
5611dd728f5SVitor Soares 	hcnt = DIV_ROUND_UP(core_rate, I3C_BUS_I2C_FM_PLUS_SCL_RATE) - lcnt;
5621dd728f5SVitor Soares 	scl_timing = SCL_I2C_FMP_TIMING_HCNT(hcnt) |
5631dd728f5SVitor Soares 		     SCL_I2C_FMP_TIMING_LCNT(lcnt);
5641dd728f5SVitor Soares 	writel(scl_timing, master->regs + SCL_I2C_FMP_TIMING);
5651dd728f5SVitor Soares 
5661dd728f5SVitor Soares 	lcnt = DIV_ROUND_UP(I3C_BUS_I2C_FM_TLOW_MIN_NS, core_period);
5671dd728f5SVitor Soares 	hcnt = DIV_ROUND_UP(core_rate, I3C_BUS_I2C_FM_SCL_RATE) - lcnt;
5681dd728f5SVitor Soares 	scl_timing = SCL_I2C_FM_TIMING_HCNT(hcnt) |
5691dd728f5SVitor Soares 		     SCL_I2C_FM_TIMING_LCNT(lcnt);
5701dd728f5SVitor Soares 	writel(scl_timing, master->regs + SCL_I2C_FM_TIMING);
5711dd728f5SVitor Soares 
5721dd728f5SVitor Soares 	writel(BUS_I3C_MST_FREE(lcnt), master->regs + BUS_FREE_TIMING);
5731dd728f5SVitor Soares 	writel(readl(master->regs + DEVICE_CTRL) | DEV_CTRL_I2C_SLAVE_PRESENT,
5741dd728f5SVitor Soares 	       master->regs + DEVICE_CTRL);
5751dd728f5SVitor Soares 
5761dd728f5SVitor Soares 	return 0;
5771dd728f5SVitor Soares }
5781dd728f5SVitor Soares 
5791dd728f5SVitor Soares static int dw_i3c_master_bus_init(struct i3c_master_controller *m)
5801dd728f5SVitor Soares {
5811dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
5821dd728f5SVitor Soares 	struct i3c_bus *bus = i3c_master_get_bus(m);
5831dd728f5SVitor Soares 	struct i3c_device_info info = { };
5841dd728f5SVitor Soares 	u32 thld_ctrl;
5851dd728f5SVitor Soares 	int ret;
5861dd728f5SVitor Soares 
587d782188cSJeremy Kerr 	ret = master->platform_ops->init(master);
588d782188cSJeremy Kerr 	if (ret)
589d782188cSJeremy Kerr 		return ret;
590d782188cSJeremy Kerr 
5911dd728f5SVitor Soares 	switch (bus->mode) {
5921dd728f5SVitor Soares 	case I3C_BUS_MODE_MIXED_FAST:
593f467907cSVitor Soares 	case I3C_BUS_MODE_MIXED_LIMITED:
5941dd728f5SVitor Soares 		ret = dw_i2c_clk_cfg(master);
5951dd728f5SVitor Soares 		if (ret)
5961dd728f5SVitor Soares 			return ret;
597df561f66SGustavo A. R. Silva 		fallthrough;
5981dd728f5SVitor Soares 	case I3C_BUS_MODE_PURE:
5991dd728f5SVitor Soares 		ret = dw_i3c_clk_cfg(master);
6001dd728f5SVitor Soares 		if (ret)
6011dd728f5SVitor Soares 			return ret;
6021dd728f5SVitor Soares 		break;
6031dd728f5SVitor Soares 	default:
6041dd728f5SVitor Soares 		return -EINVAL;
6051dd728f5SVitor Soares 	}
6061dd728f5SVitor Soares 
6071dd728f5SVitor Soares 	thld_ctrl = readl(master->regs + QUEUE_THLD_CTRL);
6081dd728f5SVitor Soares 	thld_ctrl &= ~QUEUE_THLD_CTRL_RESP_BUF_MASK;
6091dd728f5SVitor Soares 	writel(thld_ctrl, master->regs + QUEUE_THLD_CTRL);
6101dd728f5SVitor Soares 
6111dd728f5SVitor Soares 	thld_ctrl = readl(master->regs + DATA_BUFFER_THLD_CTRL);
6121dd728f5SVitor Soares 	thld_ctrl &= ~DATA_BUFFER_THLD_CTRL_RX_BUF;
6131dd728f5SVitor Soares 	writel(thld_ctrl, master->regs + DATA_BUFFER_THLD_CTRL);
6141dd728f5SVitor Soares 
6151dd728f5SVitor Soares 	writel(INTR_ALL, master->regs + INTR_STATUS);
6161dd728f5SVitor Soares 	writel(INTR_MASTER_MASK, master->regs + INTR_STATUS_EN);
6171dd728f5SVitor Soares 	writel(INTR_MASTER_MASK, master->regs + INTR_SIGNAL_EN);
6181dd728f5SVitor Soares 
6191dd728f5SVitor Soares 	ret = i3c_master_get_free_addr(m, 0);
6201dd728f5SVitor Soares 	if (ret < 0)
6211dd728f5SVitor Soares 		return ret;
6221dd728f5SVitor Soares 
6231dd728f5SVitor Soares 	writel(DEV_ADDR_DYNAMIC_ADDR_VALID | DEV_ADDR_DYNAMIC(ret),
6241dd728f5SVitor Soares 	       master->regs + DEVICE_ADDR);
6251dd728f5SVitor Soares 
6261dd728f5SVitor Soares 	memset(&info, 0, sizeof(info));
6271dd728f5SVitor Soares 	info.dyn_addr = ret;
6281dd728f5SVitor Soares 
6291dd728f5SVitor Soares 	ret = i3c_master_set_info(&master->base, &info);
6301dd728f5SVitor Soares 	if (ret)
6311dd728f5SVitor Soares 		return ret;
6321dd728f5SVitor Soares 
6331dd728f5SVitor Soares 	writel(IBI_REQ_REJECT_ALL, master->regs + IBI_SIR_REQ_REJECT);
6341dd728f5SVitor Soares 	writel(IBI_REQ_REJECT_ALL, master->regs + IBI_MR_REQ_REJECT);
6351dd728f5SVitor Soares 
6361dd728f5SVitor Soares 	/* For now don't support Hot-Join */
6371dd728f5SVitor Soares 	writel(readl(master->regs + DEVICE_CTRL) | DEV_CTRL_HOT_JOIN_NACK,
6381dd728f5SVitor Soares 	       master->regs + DEVICE_CTRL);
6391dd728f5SVitor Soares 
6401dd728f5SVitor Soares 	dw_i3c_master_enable(master);
6411dd728f5SVitor Soares 
6421dd728f5SVitor Soares 	return 0;
6431dd728f5SVitor Soares }
6441dd728f5SVitor Soares 
6451dd728f5SVitor Soares static void dw_i3c_master_bus_cleanup(struct i3c_master_controller *m)
6461dd728f5SVitor Soares {
6471dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
6481dd728f5SVitor Soares 
6491dd728f5SVitor Soares 	dw_i3c_master_disable(master);
6501dd728f5SVitor Soares }
6511dd728f5SVitor Soares 
6521dd728f5SVitor Soares static int dw_i3c_ccc_set(struct dw_i3c_master *master,
6531dd728f5SVitor Soares 			  struct i3c_ccc_cmd *ccc)
6541dd728f5SVitor Soares {
6551dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer;
6561dd728f5SVitor Soares 	struct dw_i3c_cmd *cmd;
6571dd728f5SVitor Soares 	int ret, pos = 0;
6581dd728f5SVitor Soares 
6591dd728f5SVitor Soares 	if (ccc->id & I3C_CCC_DIRECT) {
6601dd728f5SVitor Soares 		pos = dw_i3c_master_get_addr_pos(master, ccc->dests[0].addr);
6611dd728f5SVitor Soares 		if (pos < 0)
6621dd728f5SVitor Soares 			return pos;
6631dd728f5SVitor Soares 	}
6641dd728f5SVitor Soares 
6651dd728f5SVitor Soares 	xfer = dw_i3c_master_alloc_xfer(master, 1);
6661dd728f5SVitor Soares 	if (!xfer)
6671dd728f5SVitor Soares 		return -ENOMEM;
6681dd728f5SVitor Soares 
6691dd728f5SVitor Soares 	cmd = xfer->cmds;
6701dd728f5SVitor Soares 	cmd->tx_buf = ccc->dests[0].payload.data;
6711dd728f5SVitor Soares 	cmd->tx_len = ccc->dests[0].payload.len;
6721dd728f5SVitor Soares 
6731dd728f5SVitor Soares 	cmd->cmd_hi = COMMAND_PORT_ARG_DATA_LEN(ccc->dests[0].payload.len) |
6741dd728f5SVitor Soares 		      COMMAND_PORT_TRANSFER_ARG;
6751dd728f5SVitor Soares 
6761dd728f5SVitor Soares 	cmd->cmd_lo = COMMAND_PORT_CP |
6771dd728f5SVitor Soares 		      COMMAND_PORT_DEV_INDEX(pos) |
6781dd728f5SVitor Soares 		      COMMAND_PORT_CMD(ccc->id) |
6791dd728f5SVitor Soares 		      COMMAND_PORT_TOC |
6801dd728f5SVitor Soares 		      COMMAND_PORT_ROC;
6811dd728f5SVitor Soares 
6821dd728f5SVitor Soares 	dw_i3c_master_enqueue_xfer(master, xfer);
6831dd728f5SVitor Soares 	if (!wait_for_completion_timeout(&xfer->comp, XFER_TIMEOUT))
6841dd728f5SVitor Soares 		dw_i3c_master_dequeue_xfer(master, xfer);
6851dd728f5SVitor Soares 
6861dd728f5SVitor Soares 	ret = xfer->ret;
6871dd728f5SVitor Soares 	if (xfer->cmds[0].error == RESPONSE_ERROR_IBA_NACK)
6881dd728f5SVitor Soares 		ccc->err = I3C_ERROR_M2;
6891dd728f5SVitor Soares 
6901dd728f5SVitor Soares 	dw_i3c_master_free_xfer(xfer);
6911dd728f5SVitor Soares 
6921dd728f5SVitor Soares 	return ret;
6931dd728f5SVitor Soares }
6941dd728f5SVitor Soares 
6951dd728f5SVitor Soares static int dw_i3c_ccc_get(struct dw_i3c_master *master, struct i3c_ccc_cmd *ccc)
6961dd728f5SVitor Soares {
6971dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer;
6981dd728f5SVitor Soares 	struct dw_i3c_cmd *cmd;
6991dd728f5SVitor Soares 	int ret, pos;
7001dd728f5SVitor Soares 
7011dd728f5SVitor Soares 	pos = dw_i3c_master_get_addr_pos(master, ccc->dests[0].addr);
7021dd728f5SVitor Soares 	if (pos < 0)
7031dd728f5SVitor Soares 		return pos;
7041dd728f5SVitor Soares 
7051dd728f5SVitor Soares 	xfer = dw_i3c_master_alloc_xfer(master, 1);
7061dd728f5SVitor Soares 	if (!xfer)
7071dd728f5SVitor Soares 		return -ENOMEM;
7081dd728f5SVitor Soares 
7091dd728f5SVitor Soares 	cmd = xfer->cmds;
7101dd728f5SVitor Soares 	cmd->rx_buf = ccc->dests[0].payload.data;
7111dd728f5SVitor Soares 	cmd->rx_len = ccc->dests[0].payload.len;
7121dd728f5SVitor Soares 
7131dd728f5SVitor Soares 	cmd->cmd_hi = COMMAND_PORT_ARG_DATA_LEN(ccc->dests[0].payload.len) |
7141dd728f5SVitor Soares 		      COMMAND_PORT_TRANSFER_ARG;
7151dd728f5SVitor Soares 
7161dd728f5SVitor Soares 	cmd->cmd_lo = COMMAND_PORT_READ_TRANSFER |
7171dd728f5SVitor Soares 		      COMMAND_PORT_CP |
7181dd728f5SVitor Soares 		      COMMAND_PORT_DEV_INDEX(pos) |
7191dd728f5SVitor Soares 		      COMMAND_PORT_CMD(ccc->id) |
7201dd728f5SVitor Soares 		      COMMAND_PORT_TOC |
7211dd728f5SVitor Soares 		      COMMAND_PORT_ROC;
7221dd728f5SVitor Soares 
7231dd728f5SVitor Soares 	dw_i3c_master_enqueue_xfer(master, xfer);
7241dd728f5SVitor Soares 	if (!wait_for_completion_timeout(&xfer->comp, XFER_TIMEOUT))
7251dd728f5SVitor Soares 		dw_i3c_master_dequeue_xfer(master, xfer);
7261dd728f5SVitor Soares 
7271dd728f5SVitor Soares 	ret = xfer->ret;
7281dd728f5SVitor Soares 	if (xfer->cmds[0].error == RESPONSE_ERROR_IBA_NACK)
7291dd728f5SVitor Soares 		ccc->err = I3C_ERROR_M2;
7301dd728f5SVitor Soares 	dw_i3c_master_free_xfer(xfer);
7311dd728f5SVitor Soares 
7321dd728f5SVitor Soares 	return ret;
7331dd728f5SVitor Soares }
7341dd728f5SVitor Soares 
7351dd728f5SVitor Soares static int dw_i3c_master_send_ccc_cmd(struct i3c_master_controller *m,
7361dd728f5SVitor Soares 				      struct i3c_ccc_cmd *ccc)
7371dd728f5SVitor Soares {
7381dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
7391dd728f5SVitor Soares 	int ret = 0;
7401dd728f5SVitor Soares 
7411dd728f5SVitor Soares 	if (ccc->id == I3C_CCC_ENTDAA)
7421dd728f5SVitor Soares 		return -EINVAL;
7431dd728f5SVitor Soares 
7441dd728f5SVitor Soares 	if (ccc->rnw)
7451dd728f5SVitor Soares 		ret = dw_i3c_ccc_get(master, ccc);
7461dd728f5SVitor Soares 	else
7471dd728f5SVitor Soares 		ret = dw_i3c_ccc_set(master, ccc);
7481dd728f5SVitor Soares 
7491dd728f5SVitor Soares 	return ret;
7501dd728f5SVitor Soares }
7511dd728f5SVitor Soares 
7521dd728f5SVitor Soares static int dw_i3c_master_daa(struct i3c_master_controller *m)
7531dd728f5SVitor Soares {
7541dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
7551dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer;
7561dd728f5SVitor Soares 	struct dw_i3c_cmd *cmd;
7571dd728f5SVitor Soares 	u32 olddevs, newdevs;
7581dd728f5SVitor Soares 	u8 p, last_addr = 0;
7591dd728f5SVitor Soares 	int ret, pos;
7601dd728f5SVitor Soares 
7611dd728f5SVitor Soares 	olddevs = ~(master->free_pos);
7621dd728f5SVitor Soares 
7631dd728f5SVitor Soares 	/* Prepare DAT before launching DAA. */
7641dd728f5SVitor Soares 	for (pos = 0; pos < master->maxdevs; pos++) {
7651dd728f5SVitor Soares 		if (olddevs & BIT(pos))
7661dd728f5SVitor Soares 			continue;
7671dd728f5SVitor Soares 
7681dd728f5SVitor Soares 		ret = i3c_master_get_free_addr(m, last_addr + 1);
7691dd728f5SVitor Soares 		if (ret < 0)
7701dd728f5SVitor Soares 			return -ENOSPC;
7711dd728f5SVitor Soares 
772*e2d43101SJeremy Kerr 		master->devs[pos].addr = ret;
7731dd728f5SVitor Soares 		p = even_parity(ret);
7741dd728f5SVitor Soares 		last_addr = ret;
7751dd728f5SVitor Soares 		ret |= (p << 7);
7761dd728f5SVitor Soares 
7771dd728f5SVitor Soares 		writel(DEV_ADDR_TABLE_DYNAMIC_ADDR(ret),
7781dd728f5SVitor Soares 		       master->regs +
7791dd728f5SVitor Soares 		       DEV_ADDR_TABLE_LOC(master->datstartaddr, pos));
7801dd728f5SVitor Soares 	}
7811dd728f5SVitor Soares 
7821dd728f5SVitor Soares 	xfer = dw_i3c_master_alloc_xfer(master, 1);
7831dd728f5SVitor Soares 	if (!xfer)
7841dd728f5SVitor Soares 		return -ENOMEM;
7851dd728f5SVitor Soares 
7861dd728f5SVitor Soares 	pos = dw_i3c_master_get_free_pos(master);
78713462ba1STom Rix 	if (pos < 0) {
78813462ba1STom Rix 		dw_i3c_master_free_xfer(xfer);
78913462ba1STom Rix 		return pos;
79013462ba1STom Rix 	}
7911dd728f5SVitor Soares 	cmd = &xfer->cmds[0];
7921dd728f5SVitor Soares 	cmd->cmd_hi = 0x1;
7931dd728f5SVitor Soares 	cmd->cmd_lo = COMMAND_PORT_DEV_COUNT(master->maxdevs - pos) |
7941dd728f5SVitor Soares 		      COMMAND_PORT_DEV_INDEX(pos) |
7951dd728f5SVitor Soares 		      COMMAND_PORT_CMD(I3C_CCC_ENTDAA) |
7961dd728f5SVitor Soares 		      COMMAND_PORT_ADDR_ASSGN_CMD |
7971dd728f5SVitor Soares 		      COMMAND_PORT_TOC |
7981dd728f5SVitor Soares 		      COMMAND_PORT_ROC;
7991dd728f5SVitor Soares 
8001dd728f5SVitor Soares 	dw_i3c_master_enqueue_xfer(master, xfer);
8011dd728f5SVitor Soares 	if (!wait_for_completion_timeout(&xfer->comp, XFER_TIMEOUT))
8021dd728f5SVitor Soares 		dw_i3c_master_dequeue_xfer(master, xfer);
8031dd728f5SVitor Soares 
8041dd728f5SVitor Soares 	newdevs = GENMASK(master->maxdevs - cmd->rx_len - 1, 0);
8051dd728f5SVitor Soares 	newdevs &= ~olddevs;
8061dd728f5SVitor Soares 
8071dd728f5SVitor Soares 	for (pos = 0; pos < master->maxdevs; pos++) {
8081dd728f5SVitor Soares 		if (newdevs & BIT(pos))
809*e2d43101SJeremy Kerr 			i3c_master_add_i3c_dev_locked(m, master->devs[pos].addr);
8101dd728f5SVitor Soares 	}
8111dd728f5SVitor Soares 
8121dd728f5SVitor Soares 	dw_i3c_master_free_xfer(xfer);
8131dd728f5SVitor Soares 
8141dd728f5SVitor Soares 	return 0;
8151dd728f5SVitor Soares }
8161dd728f5SVitor Soares 
8171dd728f5SVitor Soares static int dw_i3c_master_priv_xfers(struct i3c_dev_desc *dev,
8181dd728f5SVitor Soares 				    struct i3c_priv_xfer *i3c_xfers,
8191dd728f5SVitor Soares 				    int i3c_nxfers)
8201dd728f5SVitor Soares {
8211dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev);
8221dd728f5SVitor Soares 	struct i3c_master_controller *m = i3c_dev_get_master(dev);
8231dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
8241dd728f5SVitor Soares 	unsigned int nrxwords = 0, ntxwords = 0;
8251dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer;
8261dd728f5SVitor Soares 	int i, ret = 0;
8271dd728f5SVitor Soares 
8281dd728f5SVitor Soares 	if (!i3c_nxfers)
8291dd728f5SVitor Soares 		return 0;
8301dd728f5SVitor Soares 
8311dd728f5SVitor Soares 	if (i3c_nxfers > master->caps.cmdfifodepth)
8321dd728f5SVitor Soares 		return -ENOTSUPP;
8331dd728f5SVitor Soares 
8341dd728f5SVitor Soares 	for (i = 0; i < i3c_nxfers; i++) {
8351dd728f5SVitor Soares 		if (i3c_xfers[i].rnw)
8361dd728f5SVitor Soares 			nrxwords += DIV_ROUND_UP(i3c_xfers[i].len, 4);
8371dd728f5SVitor Soares 		else
8381dd728f5SVitor Soares 			ntxwords += DIV_ROUND_UP(i3c_xfers[i].len, 4);
8391dd728f5SVitor Soares 	}
8401dd728f5SVitor Soares 
8411dd728f5SVitor Soares 	if (ntxwords > master->caps.datafifodepth ||
8421dd728f5SVitor Soares 	    nrxwords > master->caps.datafifodepth)
8431dd728f5SVitor Soares 		return -ENOTSUPP;
8441dd728f5SVitor Soares 
8451dd728f5SVitor Soares 	xfer = dw_i3c_master_alloc_xfer(master, i3c_nxfers);
8461dd728f5SVitor Soares 	if (!xfer)
8471dd728f5SVitor Soares 		return -ENOMEM;
8481dd728f5SVitor Soares 
8491dd728f5SVitor Soares 	for (i = 0; i < i3c_nxfers; i++) {
8501dd728f5SVitor Soares 		struct dw_i3c_cmd *cmd = &xfer->cmds[i];
8511dd728f5SVitor Soares 
8521dd728f5SVitor Soares 		cmd->cmd_hi = COMMAND_PORT_ARG_DATA_LEN(i3c_xfers[i].len) |
8531dd728f5SVitor Soares 			COMMAND_PORT_TRANSFER_ARG;
8541dd728f5SVitor Soares 
8551dd728f5SVitor Soares 		if (i3c_xfers[i].rnw) {
8561dd728f5SVitor Soares 			cmd->rx_buf = i3c_xfers[i].data.in;
8571dd728f5SVitor Soares 			cmd->rx_len = i3c_xfers[i].len;
8581dd728f5SVitor Soares 			cmd->cmd_lo = COMMAND_PORT_READ_TRANSFER |
8591dd728f5SVitor Soares 				      COMMAND_PORT_SPEED(dev->info.max_read_ds);
8601dd728f5SVitor Soares 
8611dd728f5SVitor Soares 		} else {
8621dd728f5SVitor Soares 			cmd->tx_buf = i3c_xfers[i].data.out;
8631dd728f5SVitor Soares 			cmd->tx_len = i3c_xfers[i].len;
8641dd728f5SVitor Soares 			cmd->cmd_lo =
8651dd728f5SVitor Soares 				COMMAND_PORT_SPEED(dev->info.max_write_ds);
8661dd728f5SVitor Soares 		}
8671dd728f5SVitor Soares 
8681dd728f5SVitor Soares 		cmd->cmd_lo |= COMMAND_PORT_TID(i) |
8691dd728f5SVitor Soares 			       COMMAND_PORT_DEV_INDEX(data->index) |
8701dd728f5SVitor Soares 			       COMMAND_PORT_ROC;
8711dd728f5SVitor Soares 
8721dd728f5SVitor Soares 		if (i == (i3c_nxfers - 1))
8731dd728f5SVitor Soares 			cmd->cmd_lo |= COMMAND_PORT_TOC;
8741dd728f5SVitor Soares 	}
8751dd728f5SVitor Soares 
8761dd728f5SVitor Soares 	dw_i3c_master_enqueue_xfer(master, xfer);
8771dd728f5SVitor Soares 	if (!wait_for_completion_timeout(&xfer->comp, XFER_TIMEOUT))
8781dd728f5SVitor Soares 		dw_i3c_master_dequeue_xfer(master, xfer);
8791dd728f5SVitor Soares 
88067df5ce9SMatt Johnston 	for (i = 0; i < i3c_nxfers; i++) {
88167df5ce9SMatt Johnston 		struct dw_i3c_cmd *cmd = &xfer->cmds[i];
88267df5ce9SMatt Johnston 
88367df5ce9SMatt Johnston 		if (i3c_xfers[i].rnw)
88467df5ce9SMatt Johnston 			i3c_xfers[i].len = cmd->rx_len;
88567df5ce9SMatt Johnston 	}
88667df5ce9SMatt Johnston 
8871dd728f5SVitor Soares 	ret = xfer->ret;
8881dd728f5SVitor Soares 	dw_i3c_master_free_xfer(xfer);
8891dd728f5SVitor Soares 
8901dd728f5SVitor Soares 	return ret;
8911dd728f5SVitor Soares }
8921dd728f5SVitor Soares 
8931dd728f5SVitor Soares static int dw_i3c_master_reattach_i3c_dev(struct i3c_dev_desc *dev,
8941dd728f5SVitor Soares 					  u8 old_dyn_addr)
8951dd728f5SVitor Soares {
8961dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev);
8971dd728f5SVitor Soares 	struct i3c_master_controller *m = i3c_dev_get_master(dev);
8981dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
8993952cf8fSVitor Soares 	int pos;
9003952cf8fSVitor Soares 
9013952cf8fSVitor Soares 	pos = dw_i3c_master_get_free_pos(master);
9023952cf8fSVitor Soares 
9033952cf8fSVitor Soares 	if (data->index > pos && pos > 0) {
9043952cf8fSVitor Soares 		writel(0,
9053952cf8fSVitor Soares 		       master->regs +
9063952cf8fSVitor Soares 		       DEV_ADDR_TABLE_LOC(master->datstartaddr, data->index));
9073952cf8fSVitor Soares 
908*e2d43101SJeremy Kerr 		master->devs[data->index].addr = 0;
9093952cf8fSVitor Soares 		master->free_pos |= BIT(data->index);
9103952cf8fSVitor Soares 
9113952cf8fSVitor Soares 		data->index = pos;
912*e2d43101SJeremy Kerr 		master->devs[pos].addr = dev->info.dyn_addr;
9133952cf8fSVitor Soares 		master->free_pos &= ~BIT(pos);
9143952cf8fSVitor Soares 	}
9151dd728f5SVitor Soares 
9161dd728f5SVitor Soares 	writel(DEV_ADDR_TABLE_DYNAMIC_ADDR(dev->info.dyn_addr),
9171dd728f5SVitor Soares 	       master->regs +
9181dd728f5SVitor Soares 	       DEV_ADDR_TABLE_LOC(master->datstartaddr, data->index));
9191dd728f5SVitor Soares 
920*e2d43101SJeremy Kerr 	master->devs[data->index].addr = dev->info.dyn_addr;
9211dd728f5SVitor Soares 
9221dd728f5SVitor Soares 	return 0;
9231dd728f5SVitor Soares }
9241dd728f5SVitor Soares 
9251dd728f5SVitor Soares static int dw_i3c_master_attach_i3c_dev(struct i3c_dev_desc *dev)
9261dd728f5SVitor Soares {
9271dd728f5SVitor Soares 	struct i3c_master_controller *m = i3c_dev_get_master(dev);
9281dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
9291dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data;
9301dd728f5SVitor Soares 	int pos;
9311dd728f5SVitor Soares 
9321dd728f5SVitor Soares 	pos = dw_i3c_master_get_free_pos(master);
9331dd728f5SVitor Soares 	if (pos < 0)
9341dd728f5SVitor Soares 		return pos;
9351dd728f5SVitor Soares 
9361dd728f5SVitor Soares 	data = kzalloc(sizeof(*data), GFP_KERNEL);
9371dd728f5SVitor Soares 	if (!data)
9381dd728f5SVitor Soares 		return -ENOMEM;
9391dd728f5SVitor Soares 
9401dd728f5SVitor Soares 	data->index = pos;
941*e2d43101SJeremy Kerr 	master->devs[pos].addr = dev->info.dyn_addr ? : dev->info.static_addr;
9421dd728f5SVitor Soares 	master->free_pos &= ~BIT(pos);
9431dd728f5SVitor Soares 	i3c_dev_set_master_data(dev, data);
9441dd728f5SVitor Soares 
945*e2d43101SJeremy Kerr 	writel(DEV_ADDR_TABLE_DYNAMIC_ADDR(master->devs[pos].addr),
9461dd728f5SVitor Soares 	       master->regs +
9471dd728f5SVitor Soares 	       DEV_ADDR_TABLE_LOC(master->datstartaddr, data->index));
9481dd728f5SVitor Soares 
9491dd728f5SVitor Soares 	return 0;
9501dd728f5SVitor Soares }
9511dd728f5SVitor Soares 
9521dd728f5SVitor Soares static void dw_i3c_master_detach_i3c_dev(struct i3c_dev_desc *dev)
9531dd728f5SVitor Soares {
9541dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data = i3c_dev_get_master_data(dev);
9551dd728f5SVitor Soares 	struct i3c_master_controller *m = i3c_dev_get_master(dev);
9561dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
9571dd728f5SVitor Soares 
9581dd728f5SVitor Soares 	writel(0,
9591dd728f5SVitor Soares 	       master->regs +
9601dd728f5SVitor Soares 	       DEV_ADDR_TABLE_LOC(master->datstartaddr, data->index));
9611dd728f5SVitor Soares 
9621dd728f5SVitor Soares 	i3c_dev_set_master_data(dev, NULL);
963*e2d43101SJeremy Kerr 	master->devs[data->index].addr = 0;
9641dd728f5SVitor Soares 	master->free_pos |= BIT(data->index);
9651dd728f5SVitor Soares 	kfree(data);
9661dd728f5SVitor Soares }
9671dd728f5SVitor Soares 
9681dd728f5SVitor Soares static int dw_i3c_master_i2c_xfers(struct i2c_dev_desc *dev,
9691dd728f5SVitor Soares 				   const struct i2c_msg *i2c_xfers,
9701dd728f5SVitor Soares 				   int i2c_nxfers)
9711dd728f5SVitor Soares {
9721dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data = i2c_dev_get_master_data(dev);
9731dd728f5SVitor Soares 	struct i3c_master_controller *m = i2c_dev_get_master(dev);
9741dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
9751dd728f5SVitor Soares 	unsigned int nrxwords = 0, ntxwords = 0;
9761dd728f5SVitor Soares 	struct dw_i3c_xfer *xfer;
9771dd728f5SVitor Soares 	int i, ret = 0;
9781dd728f5SVitor Soares 
9791dd728f5SVitor Soares 	if (!i2c_nxfers)
9801dd728f5SVitor Soares 		return 0;
9811dd728f5SVitor Soares 
9821dd728f5SVitor Soares 	if (i2c_nxfers > master->caps.cmdfifodepth)
9831dd728f5SVitor Soares 		return -ENOTSUPP;
9841dd728f5SVitor Soares 
9851dd728f5SVitor Soares 	for (i = 0; i < i2c_nxfers; i++) {
9861dd728f5SVitor Soares 		if (i2c_xfers[i].flags & I2C_M_RD)
9871dd728f5SVitor Soares 			nrxwords += DIV_ROUND_UP(i2c_xfers[i].len, 4);
9881dd728f5SVitor Soares 		else
9891dd728f5SVitor Soares 			ntxwords += DIV_ROUND_UP(i2c_xfers[i].len, 4);
9901dd728f5SVitor Soares 	}
9911dd728f5SVitor Soares 
9921dd728f5SVitor Soares 	if (ntxwords > master->caps.datafifodepth ||
9931dd728f5SVitor Soares 	    nrxwords > master->caps.datafifodepth)
9941dd728f5SVitor Soares 		return -ENOTSUPP;
9951dd728f5SVitor Soares 
9961dd728f5SVitor Soares 	xfer = dw_i3c_master_alloc_xfer(master, i2c_nxfers);
9971dd728f5SVitor Soares 	if (!xfer)
9981dd728f5SVitor Soares 		return -ENOMEM;
9991dd728f5SVitor Soares 
10001dd728f5SVitor Soares 	for (i = 0; i < i2c_nxfers; i++) {
10011dd728f5SVitor Soares 		struct dw_i3c_cmd *cmd = &xfer->cmds[i];
10021dd728f5SVitor Soares 
10031dd728f5SVitor Soares 		cmd->cmd_hi = COMMAND_PORT_ARG_DATA_LEN(i2c_xfers[i].len) |
10041dd728f5SVitor Soares 			COMMAND_PORT_TRANSFER_ARG;
10051dd728f5SVitor Soares 
10061dd728f5SVitor Soares 		cmd->cmd_lo = COMMAND_PORT_TID(i) |
10071dd728f5SVitor Soares 			      COMMAND_PORT_DEV_INDEX(data->index) |
10081dd728f5SVitor Soares 			      COMMAND_PORT_ROC;
10091dd728f5SVitor Soares 
10101dd728f5SVitor Soares 		if (i2c_xfers[i].flags & I2C_M_RD) {
10111dd728f5SVitor Soares 			cmd->cmd_lo |= COMMAND_PORT_READ_TRANSFER;
10121dd728f5SVitor Soares 			cmd->rx_buf = i2c_xfers[i].buf;
10131dd728f5SVitor Soares 			cmd->rx_len = i2c_xfers[i].len;
10141dd728f5SVitor Soares 		} else {
10151dd728f5SVitor Soares 			cmd->tx_buf = i2c_xfers[i].buf;
10161dd728f5SVitor Soares 			cmd->tx_len = i2c_xfers[i].len;
10171dd728f5SVitor Soares 		}
10181dd728f5SVitor Soares 
10191dd728f5SVitor Soares 		if (i == (i2c_nxfers - 1))
10201dd728f5SVitor Soares 			cmd->cmd_lo |= COMMAND_PORT_TOC;
10211dd728f5SVitor Soares 	}
10221dd728f5SVitor Soares 
10231dd728f5SVitor Soares 	dw_i3c_master_enqueue_xfer(master, xfer);
10241dd728f5SVitor Soares 	if (!wait_for_completion_timeout(&xfer->comp, XFER_TIMEOUT))
10251dd728f5SVitor Soares 		dw_i3c_master_dequeue_xfer(master, xfer);
10261dd728f5SVitor Soares 
10271dd728f5SVitor Soares 	ret = xfer->ret;
10281dd728f5SVitor Soares 	dw_i3c_master_free_xfer(xfer);
10291dd728f5SVitor Soares 
10301dd728f5SVitor Soares 	return ret;
10311dd728f5SVitor Soares }
10321dd728f5SVitor Soares 
10331dd728f5SVitor Soares static int dw_i3c_master_attach_i2c_dev(struct i2c_dev_desc *dev)
10341dd728f5SVitor Soares {
10351dd728f5SVitor Soares 	struct i3c_master_controller *m = i2c_dev_get_master(dev);
10361dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
10371dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data;
10381dd728f5SVitor Soares 	int pos;
10391dd728f5SVitor Soares 
10401dd728f5SVitor Soares 	pos = dw_i3c_master_get_free_pos(master);
10411dd728f5SVitor Soares 	if (pos < 0)
10421dd728f5SVitor Soares 		return pos;
10431dd728f5SVitor Soares 
10441dd728f5SVitor Soares 	data = kzalloc(sizeof(*data), GFP_KERNEL);
10451dd728f5SVitor Soares 	if (!data)
10461dd728f5SVitor Soares 		return -ENOMEM;
10471dd728f5SVitor Soares 
10481dd728f5SVitor Soares 	data->index = pos;
1049*e2d43101SJeremy Kerr 	master->devs[pos].addr = dev->addr;
10501dd728f5SVitor Soares 	master->free_pos &= ~BIT(pos);
10511dd728f5SVitor Soares 	i2c_dev_set_master_data(dev, data);
10521dd728f5SVitor Soares 
10531dd728f5SVitor Soares 	writel(DEV_ADDR_TABLE_LEGACY_I2C_DEV |
1054b1ac3a4bSPrzemyslaw Gaj 	       DEV_ADDR_TABLE_STATIC_ADDR(dev->addr),
10551dd728f5SVitor Soares 	       master->regs +
10561dd728f5SVitor Soares 	       DEV_ADDR_TABLE_LOC(master->datstartaddr, data->index));
10571dd728f5SVitor Soares 
10581dd728f5SVitor Soares 	return 0;
10591dd728f5SVitor Soares }
10601dd728f5SVitor Soares 
10611dd728f5SVitor Soares static void dw_i3c_master_detach_i2c_dev(struct i2c_dev_desc *dev)
10621dd728f5SVitor Soares {
10631dd728f5SVitor Soares 	struct dw_i3c_i2c_dev_data *data = i2c_dev_get_master_data(dev);
10641dd728f5SVitor Soares 	struct i3c_master_controller *m = i2c_dev_get_master(dev);
10651dd728f5SVitor Soares 	struct dw_i3c_master *master = to_dw_i3c_master(m);
10661dd728f5SVitor Soares 
10671dd728f5SVitor Soares 	writel(0,
10681dd728f5SVitor Soares 	       master->regs +
10691dd728f5SVitor Soares 	       DEV_ADDR_TABLE_LOC(master->datstartaddr, data->index));
10701dd728f5SVitor Soares 
10711dd728f5SVitor Soares 	i2c_dev_set_master_data(dev, NULL);
1072*e2d43101SJeremy Kerr 	master->devs[data->index].addr = 0;
10731dd728f5SVitor Soares 	master->free_pos |= BIT(data->index);
10741dd728f5SVitor Soares 	kfree(data);
10751dd728f5SVitor Soares }
10761dd728f5SVitor Soares 
10771dd728f5SVitor Soares static irqreturn_t dw_i3c_master_irq_handler(int irq, void *dev_id)
10781dd728f5SVitor Soares {
10791dd728f5SVitor Soares 	struct dw_i3c_master *master = dev_id;
10801dd728f5SVitor Soares 	u32 status;
10811dd728f5SVitor Soares 
10821dd728f5SVitor Soares 	status = readl(master->regs + INTR_STATUS);
10831dd728f5SVitor Soares 
10841dd728f5SVitor Soares 	if (!(status & readl(master->regs + INTR_STATUS_EN))) {
10851dd728f5SVitor Soares 		writel(INTR_ALL, master->regs + INTR_STATUS);
10861dd728f5SVitor Soares 		return IRQ_NONE;
10871dd728f5SVitor Soares 	}
10881dd728f5SVitor Soares 
10891dd728f5SVitor Soares 	spin_lock(&master->xferqueue.lock);
10901dd728f5SVitor Soares 	dw_i3c_master_end_xfer_locked(master, status);
10912b2b283cSColin Ian King 	if (status & INTR_TRANSFER_ERR_STAT)
10921dd728f5SVitor Soares 		writel(INTR_TRANSFER_ERR_STAT, master->regs + INTR_STATUS);
10931dd728f5SVitor Soares 	spin_unlock(&master->xferqueue.lock);
10941dd728f5SVitor Soares 
10951dd728f5SVitor Soares 	return IRQ_HANDLED;
10961dd728f5SVitor Soares }
10971dd728f5SVitor Soares 
10981dd728f5SVitor Soares static const struct i3c_master_controller_ops dw_mipi_i3c_ops = {
10991dd728f5SVitor Soares 	.bus_init = dw_i3c_master_bus_init,
11001dd728f5SVitor Soares 	.bus_cleanup = dw_i3c_master_bus_cleanup,
11011dd728f5SVitor Soares 	.attach_i3c_dev = dw_i3c_master_attach_i3c_dev,
11021dd728f5SVitor Soares 	.reattach_i3c_dev = dw_i3c_master_reattach_i3c_dev,
11031dd728f5SVitor Soares 	.detach_i3c_dev = dw_i3c_master_detach_i3c_dev,
11041dd728f5SVitor Soares 	.do_daa = dw_i3c_master_daa,
11051dd728f5SVitor Soares 	.supports_ccc_cmd = dw_i3c_master_supports_ccc_cmd,
11061dd728f5SVitor Soares 	.send_ccc_cmd = dw_i3c_master_send_ccc_cmd,
11071dd728f5SVitor Soares 	.priv_xfers = dw_i3c_master_priv_xfers,
11081dd728f5SVitor Soares 	.attach_i2c_dev = dw_i3c_master_attach_i2c_dev,
11091dd728f5SVitor Soares 	.detach_i2c_dev = dw_i3c_master_detach_i2c_dev,
11101dd728f5SVitor Soares 	.i2c_xfers = dw_i3c_master_i2c_xfers,
11111dd728f5SVitor Soares };
11121dd728f5SVitor Soares 
1113d782188cSJeremy Kerr /* default platform ops implementations */
1114d782188cSJeremy Kerr static int dw_i3c_platform_init_nop(struct dw_i3c_master *i3c)
11151dd728f5SVitor Soares {
1116d782188cSJeremy Kerr 	return 0;
1117d782188cSJeremy Kerr }
1118d782188cSJeremy Kerr 
1119d782188cSJeremy Kerr static const struct dw_i3c_platform_ops dw_i3c_platform_ops_default = {
1120d782188cSJeremy Kerr 	.init = dw_i3c_platform_init_nop,
1121d782188cSJeremy Kerr };
1122d782188cSJeremy Kerr 
1123d782188cSJeremy Kerr int dw_i3c_common_probe(struct dw_i3c_master *master,
1124d782188cSJeremy Kerr 			struct platform_device *pdev)
1125d782188cSJeremy Kerr {
11261dd728f5SVitor Soares 	int ret, irq;
11271dd728f5SVitor Soares 
1128d782188cSJeremy Kerr 	if (!master->platform_ops)
1129d782188cSJeremy Kerr 		master->platform_ops = &dw_i3c_platform_ops_default;
11301dd728f5SVitor Soares 
1131fae04237SYangtao Li 	master->regs = devm_platform_ioremap_resource(pdev, 0);
11321dd728f5SVitor Soares 	if (IS_ERR(master->regs))
11331dd728f5SVitor Soares 		return PTR_ERR(master->regs);
11341dd728f5SVitor Soares 
11351dd728f5SVitor Soares 	master->core_clk = devm_clk_get(&pdev->dev, NULL);
11361dd728f5SVitor Soares 	if (IS_ERR(master->core_clk))
11371dd728f5SVitor Soares 		return PTR_ERR(master->core_clk);
11381dd728f5SVitor Soares 
11391dd728f5SVitor Soares 	master->core_rst = devm_reset_control_get_optional_exclusive(&pdev->dev,
11401dd728f5SVitor Soares 								    "core_rst");
11411dd728f5SVitor Soares 	if (IS_ERR(master->core_rst))
11421dd728f5SVitor Soares 		return PTR_ERR(master->core_rst);
11431dd728f5SVitor Soares 
11441dd728f5SVitor Soares 	ret = clk_prepare_enable(master->core_clk);
11451dd728f5SVitor Soares 	if (ret)
11461dd728f5SVitor Soares 		goto err_disable_core_clk;
11471dd728f5SVitor Soares 
11481dd728f5SVitor Soares 	reset_control_deassert(master->core_rst);
11491dd728f5SVitor Soares 
11501dd728f5SVitor Soares 	spin_lock_init(&master->xferqueue.lock);
11511dd728f5SVitor Soares 	INIT_LIST_HEAD(&master->xferqueue.list);
11521dd728f5SVitor Soares 
11531dd728f5SVitor Soares 	writel(INTR_ALL, master->regs + INTR_STATUS);
11541dd728f5SVitor Soares 	irq = platform_get_irq(pdev, 0);
11551dd728f5SVitor Soares 	ret = devm_request_irq(&pdev->dev, irq,
11561dd728f5SVitor Soares 			       dw_i3c_master_irq_handler, 0,
11571dd728f5SVitor Soares 			       dev_name(&pdev->dev), master);
11581dd728f5SVitor Soares 	if (ret)
11591dd728f5SVitor Soares 		goto err_assert_rst;
11601dd728f5SVitor Soares 
11611dd728f5SVitor Soares 	platform_set_drvdata(pdev, master);
11621dd728f5SVitor Soares 
11631dd728f5SVitor Soares 	/* Information regarding the FIFOs/QUEUEs depth */
11641dd728f5SVitor Soares 	ret = readl(master->regs + QUEUE_STATUS_LEVEL);
11651dd728f5SVitor Soares 	master->caps.cmdfifodepth = QUEUE_STATUS_LEVEL_CMD(ret);
11661dd728f5SVitor Soares 
11671dd728f5SVitor Soares 	ret = readl(master->regs + DATA_BUFFER_STATUS_LEVEL);
11681dd728f5SVitor Soares 	master->caps.datafifodepth = DATA_BUFFER_STATUS_LEVEL_TX(ret);
11691dd728f5SVitor Soares 
11701dd728f5SVitor Soares 	ret = readl(master->regs + DEVICE_ADDR_TABLE_POINTER);
11711dd728f5SVitor Soares 	master->datstartaddr = ret;
11721dd728f5SVitor Soares 	master->maxdevs = ret >> 16;
11731dd728f5SVitor Soares 	master->free_pos = GENMASK(master->maxdevs - 1, 0);
11741dd728f5SVitor Soares 
11751dd728f5SVitor Soares 	ret = i3c_master_register(&master->base, &pdev->dev,
11761dd728f5SVitor Soares 				  &dw_mipi_i3c_ops, false);
11771dd728f5SVitor Soares 	if (ret)
11781dd728f5SVitor Soares 		goto err_assert_rst;
11791dd728f5SVitor Soares 
11801dd728f5SVitor Soares 	return 0;
11811dd728f5SVitor Soares 
11821dd728f5SVitor Soares err_assert_rst:
11831dd728f5SVitor Soares 	reset_control_assert(master->core_rst);
11841dd728f5SVitor Soares 
11851dd728f5SVitor Soares err_disable_core_clk:
11861dd728f5SVitor Soares 	clk_disable_unprepare(master->core_clk);
11871dd728f5SVitor Soares 
11881dd728f5SVitor Soares 	return ret;
11891dd728f5SVitor Soares }
1190d782188cSJeremy Kerr EXPORT_SYMBOL_GPL(dw_i3c_common_probe);
11911dd728f5SVitor Soares 
1192d782188cSJeremy Kerr void dw_i3c_common_remove(struct dw_i3c_master *master)
11931dd728f5SVitor Soares {
11940f74f8b6SUwe Kleine-König 	i3c_master_unregister(&master->base);
11951dd728f5SVitor Soares 
11961dd728f5SVitor Soares 	reset_control_assert(master->core_rst);
11971dd728f5SVitor Soares 
11981dd728f5SVitor Soares 	clk_disable_unprepare(master->core_clk);
11991dd728f5SVitor Soares }
1200d782188cSJeremy Kerr EXPORT_SYMBOL_GPL(dw_i3c_common_remove);
1201d782188cSJeremy Kerr 
1202d782188cSJeremy Kerr /* base platform implementation */
1203d782188cSJeremy Kerr 
1204d782188cSJeremy Kerr static int dw_i3c_probe(struct platform_device *pdev)
1205d782188cSJeremy Kerr {
1206d782188cSJeremy Kerr 	struct dw_i3c_master *master;
1207d782188cSJeremy Kerr 
1208d782188cSJeremy Kerr 	master = devm_kzalloc(&pdev->dev, sizeof(*master), GFP_KERNEL);
1209d782188cSJeremy Kerr 	if (!master)
1210d782188cSJeremy Kerr 		return -ENOMEM;
1211d782188cSJeremy Kerr 
1212d782188cSJeremy Kerr 	return dw_i3c_common_probe(master, pdev);
1213d782188cSJeremy Kerr }
1214d782188cSJeremy Kerr 
1215d782188cSJeremy Kerr static void dw_i3c_remove(struct platform_device *pdev)
1216d782188cSJeremy Kerr {
1217d782188cSJeremy Kerr 	struct dw_i3c_master *master = platform_get_drvdata(pdev);
1218d782188cSJeremy Kerr 
1219d782188cSJeremy Kerr 	dw_i3c_common_remove(master);
1220d782188cSJeremy Kerr }
12211dd728f5SVitor Soares 
12221dd728f5SVitor Soares static const struct of_device_id dw_i3c_master_of_match[] = {
12231dd728f5SVitor Soares 	{ .compatible = "snps,dw-i3c-master-1.00a", },
12241dd728f5SVitor Soares 	{},
12251dd728f5SVitor Soares };
12261dd728f5SVitor Soares MODULE_DEVICE_TABLE(of, dw_i3c_master_of_match);
12271dd728f5SVitor Soares 
12281dd728f5SVitor Soares static struct platform_driver dw_i3c_driver = {
12291dd728f5SVitor Soares 	.probe = dw_i3c_probe,
123004b5f1beSUwe Kleine-König 	.remove_new = dw_i3c_remove,
12311dd728f5SVitor Soares 	.driver = {
12321dd728f5SVitor Soares 		.name = "dw-i3c-master",
12331dae3f1dSKrzysztof Kozlowski 		.of_match_table = dw_i3c_master_of_match,
12341dd728f5SVitor Soares 	},
12351dd728f5SVitor Soares };
12361dd728f5SVitor Soares module_platform_driver(dw_i3c_driver);
12371dd728f5SVitor Soares 
12381dd728f5SVitor Soares MODULE_AUTHOR("Vitor Soares <vitor.soares@synopsys.com>");
12391dd728f5SVitor Soares MODULE_DESCRIPTION("DesignWare MIPI I3C driver");
12401dd728f5SVitor Soares MODULE_LICENSE("GPL v2");
1241