xref: /linux/drivers/gpu/drm/bridge/parade-ps8640.c (revision f8378c0403813fd7cdf0eb5cb878b1ff290046c4)
1bc1aee7fSJitao Shi // SPDX-License-Identifier: GPL-2.0-only
2bc1aee7fSJitao Shi /*
3bc1aee7fSJitao Shi  * Copyright (c) 2016 MediaTek Inc.
4bc1aee7fSJitao Shi  */
5bc1aee7fSJitao Shi 
6bc1aee7fSJitao Shi #include <linux/delay.h>
7bc1aee7fSJitao Shi #include <linux/err.h>
8bc1aee7fSJitao Shi #include <linux/gpio/consumer.h>
9bc1aee7fSJitao Shi #include <linux/i2c.h>
10bc1aee7fSJitao Shi #include <linux/module.h>
11bc1aee7fSJitao Shi #include <linux/of_graph.h>
12826cff3fSPhilip Chen #include <linux/pm_runtime.h>
13692d8db0SPhilip Chen #include <linux/regmap.h>
14bc1aee7fSJitao Shi #include <linux/regulator/consumer.h>
15bc1aee7fSJitao Shi 
16bc1aee7fSJitao Shi #include <drm/drm_bridge.h>
17e9d9f958SPhilip Chen #include <drm/drm_dp_aux_bus.h>
1813afcdd7SPhilip Chen #include <drm/drm_dp_helper.h>
19bc1aee7fSJitao Shi #include <drm/drm_mipi_dsi.h>
20bc1aee7fSJitao Shi #include <drm/drm_of.h>
21bc1aee7fSJitao Shi #include <drm/drm_panel.h>
22bc1aee7fSJitao Shi #include <drm/drm_print.h>
23bc1aee7fSJitao Shi 
2413afcdd7SPhilip Chen #define PAGE0_AUXCH_CFG3	0x76
2513afcdd7SPhilip Chen #define  AUXCH_CFG3_RESET	0xff
2613afcdd7SPhilip Chen #define PAGE0_SWAUX_ADDR_7_0	0x7d
2713afcdd7SPhilip Chen #define PAGE0_SWAUX_ADDR_15_8	0x7e
2813afcdd7SPhilip Chen #define PAGE0_SWAUX_ADDR_23_16	0x7f
2913afcdd7SPhilip Chen #define  SWAUX_ADDR_MASK	GENMASK(19, 0)
3013afcdd7SPhilip Chen #define PAGE0_SWAUX_LENGTH	0x80
3113afcdd7SPhilip Chen #define  SWAUX_LENGTH_MASK	GENMASK(3, 0)
3213afcdd7SPhilip Chen #define  SWAUX_NO_PAYLOAD	BIT(7)
3313afcdd7SPhilip Chen #define PAGE0_SWAUX_WDATA	0x81
3413afcdd7SPhilip Chen #define PAGE0_SWAUX_RDATA	0x82
3513afcdd7SPhilip Chen #define PAGE0_SWAUX_CTRL	0x83
3613afcdd7SPhilip Chen #define  SWAUX_SEND		BIT(0)
3713afcdd7SPhilip Chen #define PAGE0_SWAUX_STATUS	0x84
3813afcdd7SPhilip Chen #define  SWAUX_M_MASK		GENMASK(4, 0)
3913afcdd7SPhilip Chen #define  SWAUX_STATUS_MASK	GENMASK(7, 5)
4013afcdd7SPhilip Chen #define  SWAUX_STATUS_NACK	(0x1 << 5)
4113afcdd7SPhilip Chen #define  SWAUX_STATUS_DEFER	(0x2 << 5)
4213afcdd7SPhilip Chen #define  SWAUX_STATUS_ACKM	(0x3 << 5)
4313afcdd7SPhilip Chen #define  SWAUX_STATUS_INVALID	(0x4 << 5)
4413afcdd7SPhilip Chen #define  SWAUX_STATUS_I2C_NACK	(0x5 << 5)
4513afcdd7SPhilip Chen #define  SWAUX_STATUS_I2C_DEFER	(0x6 << 5)
4613afcdd7SPhilip Chen #define  SWAUX_STATUS_TIMEOUT	(0x7 << 5)
4713afcdd7SPhilip Chen 
48bc1aee7fSJitao Shi #define PAGE2_GPIO_H		0xa7
49bc1aee7fSJitao Shi #define  PS_GPIO9		BIT(1)
50bc1aee7fSJitao Shi #define PAGE2_I2C_BYPASS	0xea
51bc1aee7fSJitao Shi #define  I2C_BYPASS_EN		0xd0
52bc1aee7fSJitao Shi #define PAGE2_MCS_EN		0xf3
53bc1aee7fSJitao Shi #define  MCS_EN			BIT(0)
5428210a3fSPhilip Chen 
55bc1aee7fSJitao Shi #define PAGE3_SET_ADD		0xfe
56bc1aee7fSJitao Shi #define  VDO_CTL_ADD		0x13
57bc1aee7fSJitao Shi #define  VDO_DIS		0x18
58bc1aee7fSJitao Shi #define  VDO_EN			0x1c
5928210a3fSPhilip Chen 
6028210a3fSPhilip Chen #define NUM_MIPI_LANES		4
61bc1aee7fSJitao Shi 
62692d8db0SPhilip Chen #define COMMON_PS8640_REGMAP_CONFIG \
63692d8db0SPhilip Chen 	.reg_bits = 8, \
64692d8db0SPhilip Chen 	.val_bits = 8, \
65692d8db0SPhilip Chen 	.cache_type = REGCACHE_NONE
66692d8db0SPhilip Chen 
67bc1aee7fSJitao Shi /*
68bc1aee7fSJitao Shi  * PS8640 uses multiple addresses:
69bc1aee7fSJitao Shi  * page[0]: for DP control
70bc1aee7fSJitao Shi  * page[1]: for VIDEO Bridge
71bc1aee7fSJitao Shi  * page[2]: for control top
72bc1aee7fSJitao Shi  * page[3]: for DSI Link Control1
73bc1aee7fSJitao Shi  * page[4]: for MIPI Phy
74bc1aee7fSJitao Shi  * page[5]: for VPLL
75bc1aee7fSJitao Shi  * page[6]: for DSI Link Control2
76bc1aee7fSJitao Shi  * page[7]: for SPI ROM mapping
77bc1aee7fSJitao Shi  */
78bc1aee7fSJitao Shi enum page_addr_offset {
79bc1aee7fSJitao Shi 	PAGE0_DP_CNTL = 0,
80bc1aee7fSJitao Shi 	PAGE1_VDO_BDG,
81bc1aee7fSJitao Shi 	PAGE2_TOP_CNTL,
82bc1aee7fSJitao Shi 	PAGE3_DSI_CNTL1,
83bc1aee7fSJitao Shi 	PAGE4_MIPI_PHY,
84bc1aee7fSJitao Shi 	PAGE5_VPLL,
85bc1aee7fSJitao Shi 	PAGE6_DSI_CNTL2,
86bc1aee7fSJitao Shi 	PAGE7_SPI_CNTL,
87bc1aee7fSJitao Shi 	MAX_DEVS
88bc1aee7fSJitao Shi };
89bc1aee7fSJitao Shi 
90bc1aee7fSJitao Shi enum ps8640_vdo_control {
91bc1aee7fSJitao Shi 	DISABLE = VDO_DIS,
92bc1aee7fSJitao Shi 	ENABLE = VDO_EN,
93bc1aee7fSJitao Shi };
94bc1aee7fSJitao Shi 
95bc1aee7fSJitao Shi struct ps8640 {
96bc1aee7fSJitao Shi 	struct drm_bridge bridge;
97bc1aee7fSJitao Shi 	struct drm_bridge *panel_bridge;
9813afcdd7SPhilip Chen 	struct drm_dp_aux aux;
99bc1aee7fSJitao Shi 	struct mipi_dsi_device *dsi;
100bc1aee7fSJitao Shi 	struct i2c_client *page[MAX_DEVS];
101692d8db0SPhilip Chen 	struct regmap	*regmap[MAX_DEVS];
102bc1aee7fSJitao Shi 	struct regulator_bulk_data supplies[2];
103bc1aee7fSJitao Shi 	struct gpio_desc *gpio_reset;
104bc1aee7fSJitao Shi 	struct gpio_desc *gpio_powerdown;
105826cff3fSPhilip Chen 	bool pre_enabled;
106bc1aee7fSJitao Shi };
107bc1aee7fSJitao Shi 
108692d8db0SPhilip Chen static const struct regmap_config ps8640_regmap_config[] = {
109692d8db0SPhilip Chen 	[PAGE0_DP_CNTL] = {
110692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
111692d8db0SPhilip Chen 		.max_register = 0xbf,
112692d8db0SPhilip Chen 	},
113692d8db0SPhilip Chen 	[PAGE1_VDO_BDG] = {
114692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
115692d8db0SPhilip Chen 		.max_register = 0xff,
116692d8db0SPhilip Chen 	},
117692d8db0SPhilip Chen 	[PAGE2_TOP_CNTL] = {
118692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
119692d8db0SPhilip Chen 		.max_register = 0xff,
120692d8db0SPhilip Chen 	},
121692d8db0SPhilip Chen 	[PAGE3_DSI_CNTL1] = {
122692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
123692d8db0SPhilip Chen 		.max_register = 0xff,
124692d8db0SPhilip Chen 	},
125692d8db0SPhilip Chen 	[PAGE4_MIPI_PHY] = {
126692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
127692d8db0SPhilip Chen 		.max_register = 0xff,
128692d8db0SPhilip Chen 	},
129692d8db0SPhilip Chen 	[PAGE5_VPLL] = {
130692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
131692d8db0SPhilip Chen 		.max_register = 0x7f,
132692d8db0SPhilip Chen 	},
133692d8db0SPhilip Chen 	[PAGE6_DSI_CNTL2] = {
134692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
135692d8db0SPhilip Chen 		.max_register = 0xff,
136692d8db0SPhilip Chen 	},
137692d8db0SPhilip Chen 	[PAGE7_SPI_CNTL] = {
138692d8db0SPhilip Chen 		COMMON_PS8640_REGMAP_CONFIG,
139692d8db0SPhilip Chen 		.max_register = 0xff,
140692d8db0SPhilip Chen 	},
141692d8db0SPhilip Chen };
142692d8db0SPhilip Chen 
143bc1aee7fSJitao Shi static inline struct ps8640 *bridge_to_ps8640(struct drm_bridge *e)
144bc1aee7fSJitao Shi {
145bc1aee7fSJitao Shi 	return container_of(e, struct ps8640, bridge);
146bc1aee7fSJitao Shi }
147bc1aee7fSJitao Shi 
14813afcdd7SPhilip Chen static inline struct ps8640 *aux_to_ps8640(struct drm_dp_aux *aux)
14913afcdd7SPhilip Chen {
15013afcdd7SPhilip Chen 	return container_of(aux, struct ps8640, aux);
15113afcdd7SPhilip Chen }
15213afcdd7SPhilip Chen 
153e9d9f958SPhilip Chen static bool ps8640_of_panel_on_aux_bus(struct device *dev)
154e9d9f958SPhilip Chen {
155e9d9f958SPhilip Chen 	struct device_node *bus, *panel;
156e9d9f958SPhilip Chen 
157e9d9f958SPhilip Chen 	bus = of_get_child_by_name(dev->of_node, "aux-bus");
158e9d9f958SPhilip Chen 	if (!bus)
159e9d9f958SPhilip Chen 		return false;
160e9d9f958SPhilip Chen 
161e9d9f958SPhilip Chen 	panel = of_get_child_by_name(bus, "panel");
162e9d9f958SPhilip Chen 	of_node_put(bus);
163e9d9f958SPhilip Chen 	if (!panel)
164e9d9f958SPhilip Chen 		return false;
165e9d9f958SPhilip Chen 	of_node_put(panel);
166e9d9f958SPhilip Chen 
167e9d9f958SPhilip Chen 	return true;
168e9d9f958SPhilip Chen }
169e9d9f958SPhilip Chen 
170826cff3fSPhilip Chen static int ps8640_ensure_hpd(struct ps8640 *ps_bridge)
171826cff3fSPhilip Chen {
172826cff3fSPhilip Chen 	struct regmap *map = ps_bridge->regmap[PAGE2_TOP_CNTL];
173826cff3fSPhilip Chen 	struct device *dev = &ps_bridge->page[PAGE2_TOP_CNTL]->dev;
174826cff3fSPhilip Chen 	int status;
175826cff3fSPhilip Chen 	int ret;
176826cff3fSPhilip Chen 
177826cff3fSPhilip Chen 	/*
178826cff3fSPhilip Chen 	 * Apparently something about the firmware in the chip signals that
179826cff3fSPhilip Chen 	 * HPD goes high by reporting GPIO9 as high (even though HPD isn't
180826cff3fSPhilip Chen 	 * actually connected to GPIO9).
181826cff3fSPhilip Chen 	 */
182826cff3fSPhilip Chen 	ret = regmap_read_poll_timeout(map, PAGE2_GPIO_H, status,
183826cff3fSPhilip Chen 				       status & PS_GPIO9, 20 * 1000, 200 * 1000);
184826cff3fSPhilip Chen 
185826cff3fSPhilip Chen 	if (ret < 0)
186826cff3fSPhilip Chen 		dev_warn(dev, "HPD didn't go high: %d\n", ret);
187826cff3fSPhilip Chen 
188826cff3fSPhilip Chen 	return ret;
189826cff3fSPhilip Chen }
190826cff3fSPhilip Chen 
191826cff3fSPhilip Chen static ssize_t ps8640_aux_transfer_msg(struct drm_dp_aux *aux,
19213afcdd7SPhilip Chen 				       struct drm_dp_aux_msg *msg)
19313afcdd7SPhilip Chen {
19413afcdd7SPhilip Chen 	struct ps8640 *ps_bridge = aux_to_ps8640(aux);
19513afcdd7SPhilip Chen 	struct regmap *map = ps_bridge->regmap[PAGE0_DP_CNTL];
19613afcdd7SPhilip Chen 	struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
19713afcdd7SPhilip Chen 	unsigned int len = msg->size;
19813afcdd7SPhilip Chen 	unsigned int data;
19913afcdd7SPhilip Chen 	unsigned int base;
20013afcdd7SPhilip Chen 	int ret;
20113afcdd7SPhilip Chen 	u8 request = msg->request &
20213afcdd7SPhilip Chen 		     ~(DP_AUX_I2C_MOT | DP_AUX_I2C_WRITE_STATUS_UPDATE);
20313afcdd7SPhilip Chen 	u8 *buf = msg->buffer;
20413afcdd7SPhilip Chen 	u8 addr_len[PAGE0_SWAUX_LENGTH + 1 - PAGE0_SWAUX_ADDR_7_0];
20513afcdd7SPhilip Chen 	u8 i;
20613afcdd7SPhilip Chen 	bool is_native_aux = false;
20713afcdd7SPhilip Chen 
20813afcdd7SPhilip Chen 	if (len > DP_AUX_MAX_PAYLOAD_BYTES)
20913afcdd7SPhilip Chen 		return -EINVAL;
21013afcdd7SPhilip Chen 
21113afcdd7SPhilip Chen 	if (msg->address & ~SWAUX_ADDR_MASK)
21213afcdd7SPhilip Chen 		return -EINVAL;
21313afcdd7SPhilip Chen 
21413afcdd7SPhilip Chen 	switch (request) {
21513afcdd7SPhilip Chen 	case DP_AUX_NATIVE_WRITE:
21613afcdd7SPhilip Chen 	case DP_AUX_NATIVE_READ:
21713afcdd7SPhilip Chen 		is_native_aux = true;
21813afcdd7SPhilip Chen 		fallthrough;
21913afcdd7SPhilip Chen 	case DP_AUX_I2C_WRITE:
22013afcdd7SPhilip Chen 	case DP_AUX_I2C_READ:
22113afcdd7SPhilip Chen 		break;
22213afcdd7SPhilip Chen 	default:
22313afcdd7SPhilip Chen 		return -EINVAL;
22413afcdd7SPhilip Chen 	}
22513afcdd7SPhilip Chen 
22613afcdd7SPhilip Chen 	ret = regmap_write(map, PAGE0_AUXCH_CFG3, AUXCH_CFG3_RESET);
22713afcdd7SPhilip Chen 	if (ret) {
22813afcdd7SPhilip Chen 		DRM_DEV_ERROR(dev, "failed to write PAGE0_AUXCH_CFG3: %d\n",
22913afcdd7SPhilip Chen 			      ret);
23013afcdd7SPhilip Chen 		return ret;
23113afcdd7SPhilip Chen 	}
23213afcdd7SPhilip Chen 
23313afcdd7SPhilip Chen 	/* Assume it's good */
23413afcdd7SPhilip Chen 	msg->reply = 0;
23513afcdd7SPhilip Chen 
23613afcdd7SPhilip Chen 	base = PAGE0_SWAUX_ADDR_7_0;
23713afcdd7SPhilip Chen 	addr_len[PAGE0_SWAUX_ADDR_7_0 - base] = msg->address;
23813afcdd7SPhilip Chen 	addr_len[PAGE0_SWAUX_ADDR_15_8 - base] = msg->address >> 8;
23913afcdd7SPhilip Chen 	addr_len[PAGE0_SWAUX_ADDR_23_16 - base] = (msg->address >> 16) |
24013afcdd7SPhilip Chen 						  (msg->request << 4);
24113afcdd7SPhilip Chen 	addr_len[PAGE0_SWAUX_LENGTH - base] = (len == 0) ? SWAUX_NO_PAYLOAD :
24213afcdd7SPhilip Chen 					      ((len - 1) & SWAUX_LENGTH_MASK);
24313afcdd7SPhilip Chen 
24413afcdd7SPhilip Chen 	regmap_bulk_write(map, PAGE0_SWAUX_ADDR_7_0, addr_len,
24513afcdd7SPhilip Chen 			  ARRAY_SIZE(addr_len));
24613afcdd7SPhilip Chen 
24713afcdd7SPhilip Chen 	if (len && (request == DP_AUX_NATIVE_WRITE ||
24813afcdd7SPhilip Chen 		    request == DP_AUX_I2C_WRITE)) {
24913afcdd7SPhilip Chen 		/* Write to the internal FIFO buffer */
25013afcdd7SPhilip Chen 		for (i = 0; i < len; i++) {
25113afcdd7SPhilip Chen 			ret = regmap_write(map, PAGE0_SWAUX_WDATA, buf[i]);
25213afcdd7SPhilip Chen 			if (ret) {
25313afcdd7SPhilip Chen 				DRM_DEV_ERROR(dev,
25413afcdd7SPhilip Chen 					      "failed to write WDATA: %d\n",
25513afcdd7SPhilip Chen 					      ret);
25613afcdd7SPhilip Chen 				return ret;
25713afcdd7SPhilip Chen 			}
25813afcdd7SPhilip Chen 		}
25913afcdd7SPhilip Chen 	}
26013afcdd7SPhilip Chen 
26113afcdd7SPhilip Chen 	regmap_write(map, PAGE0_SWAUX_CTRL, SWAUX_SEND);
26213afcdd7SPhilip Chen 
26313afcdd7SPhilip Chen 	/* Zero delay loop because i2c transactions are slow already */
26413afcdd7SPhilip Chen 	regmap_read_poll_timeout(map, PAGE0_SWAUX_CTRL, data,
26513afcdd7SPhilip Chen 				 !(data & SWAUX_SEND), 0, 50 * 1000);
26613afcdd7SPhilip Chen 
26713afcdd7SPhilip Chen 	regmap_read(map, PAGE0_SWAUX_STATUS, &data);
26813afcdd7SPhilip Chen 	if (ret) {
26913afcdd7SPhilip Chen 		DRM_DEV_ERROR(dev, "failed to read PAGE0_SWAUX_STATUS: %d\n",
27013afcdd7SPhilip Chen 			      ret);
27113afcdd7SPhilip Chen 		return ret;
27213afcdd7SPhilip Chen 	}
27313afcdd7SPhilip Chen 
27413afcdd7SPhilip Chen 	switch (data & SWAUX_STATUS_MASK) {
27513afcdd7SPhilip Chen 	/* Ignore the DEFER cases as they are already handled in hardware */
27613afcdd7SPhilip Chen 	case SWAUX_STATUS_NACK:
27713afcdd7SPhilip Chen 	case SWAUX_STATUS_I2C_NACK:
27813afcdd7SPhilip Chen 		/*
27913afcdd7SPhilip Chen 		 * The programming guide is not clear about whether a I2C NACK
28013afcdd7SPhilip Chen 		 * would trigger SWAUX_STATUS_NACK or SWAUX_STATUS_I2C_NACK. So
28113afcdd7SPhilip Chen 		 * we handle both cases together.
28213afcdd7SPhilip Chen 		 */
28313afcdd7SPhilip Chen 		if (is_native_aux)
28413afcdd7SPhilip Chen 			msg->reply |= DP_AUX_NATIVE_REPLY_NACK;
28513afcdd7SPhilip Chen 		else
28613afcdd7SPhilip Chen 			msg->reply |= DP_AUX_I2C_REPLY_NACK;
28713afcdd7SPhilip Chen 
28813afcdd7SPhilip Chen 		fallthrough;
28913afcdd7SPhilip Chen 	case SWAUX_STATUS_ACKM:
29013afcdd7SPhilip Chen 		len = data & SWAUX_M_MASK;
29113afcdd7SPhilip Chen 		break;
29213afcdd7SPhilip Chen 	case SWAUX_STATUS_INVALID:
29313afcdd7SPhilip Chen 		return -EOPNOTSUPP;
29413afcdd7SPhilip Chen 	case SWAUX_STATUS_TIMEOUT:
29513afcdd7SPhilip Chen 		return -ETIMEDOUT;
29613afcdd7SPhilip Chen 	}
29713afcdd7SPhilip Chen 
29813afcdd7SPhilip Chen 	if (len && (request == DP_AUX_NATIVE_READ ||
29913afcdd7SPhilip Chen 		    request == DP_AUX_I2C_READ)) {
30013afcdd7SPhilip Chen 		/* Read from the internal FIFO buffer */
30113afcdd7SPhilip Chen 		for (i = 0; i < len; i++) {
30213afcdd7SPhilip Chen 			ret = regmap_read(map, PAGE0_SWAUX_RDATA, &data);
30313afcdd7SPhilip Chen 			if (ret) {
30413afcdd7SPhilip Chen 				DRM_DEV_ERROR(dev,
30513afcdd7SPhilip Chen 					      "failed to read RDATA: %d\n",
30613afcdd7SPhilip Chen 					      ret);
30713afcdd7SPhilip Chen 				return ret;
30813afcdd7SPhilip Chen 			}
30913afcdd7SPhilip Chen 
31013afcdd7SPhilip Chen 			buf[i] = data;
31113afcdd7SPhilip Chen 		}
31213afcdd7SPhilip Chen 	}
31313afcdd7SPhilip Chen 
31413afcdd7SPhilip Chen 	return len;
31513afcdd7SPhilip Chen }
31613afcdd7SPhilip Chen 
317826cff3fSPhilip Chen static ssize_t ps8640_aux_transfer(struct drm_dp_aux *aux,
318826cff3fSPhilip Chen 				   struct drm_dp_aux_msg *msg)
319826cff3fSPhilip Chen {
320826cff3fSPhilip Chen 	struct ps8640 *ps_bridge = aux_to_ps8640(aux);
321826cff3fSPhilip Chen 	struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
322826cff3fSPhilip Chen 	int ret;
323826cff3fSPhilip Chen 
324826cff3fSPhilip Chen 	pm_runtime_get_sync(dev);
325826cff3fSPhilip Chen 	ret = ps8640_ensure_hpd(ps_bridge);
326826cff3fSPhilip Chen 	if (!ret)
327826cff3fSPhilip Chen 		ret = ps8640_aux_transfer_msg(aux, msg);
328826cff3fSPhilip Chen 	pm_runtime_mark_last_busy(dev);
329826cff3fSPhilip Chen 	pm_runtime_put_autosuspend(dev);
330826cff3fSPhilip Chen 
331826cff3fSPhilip Chen 	return ret;
332826cff3fSPhilip Chen }
333826cff3fSPhilip Chen 
334826cff3fSPhilip Chen static void ps8640_bridge_vdo_control(struct ps8640 *ps_bridge,
335bc1aee7fSJitao Shi 				      const enum ps8640_vdo_control ctrl)
336bc1aee7fSJitao Shi {
337692d8db0SPhilip Chen 	struct regmap *map = ps_bridge->regmap[PAGE3_DSI_CNTL1];
338826cff3fSPhilip Chen 	struct device *dev = &ps_bridge->page[PAGE3_DSI_CNTL1]->dev;
339bc1aee7fSJitao Shi 	u8 vdo_ctrl_buf[] = { VDO_CTL_ADD, ctrl };
340bc1aee7fSJitao Shi 	int ret;
341bc1aee7fSJitao Shi 
342692d8db0SPhilip Chen 	ret = regmap_bulk_write(map, PAGE3_SET_ADD,
343692d8db0SPhilip Chen 				vdo_ctrl_buf, sizeof(vdo_ctrl_buf));
344692d8db0SPhilip Chen 
345826cff3fSPhilip Chen 	if (ret < 0)
346826cff3fSPhilip Chen 		dev_err(dev, "failed to %sable VDO: %d\n",
34794d4c132SEnric Balletbo i Serra 			ctrl == ENABLE ? "en" : "dis", ret);
34894d4c132SEnric Balletbo i Serra }
349bc1aee7fSJitao Shi 
350826cff3fSPhilip Chen static int __maybe_unused ps8640_resume(struct device *dev)
351bc1aee7fSJitao Shi {
352826cff3fSPhilip Chen 	struct ps8640 *ps_bridge = dev_get_drvdata(dev);
353826cff3fSPhilip Chen 	int ret;
35446f20630SEnric Balletbo i Serra 
355bc1aee7fSJitao Shi 	ret = regulator_bulk_enable(ARRAY_SIZE(ps_bridge->supplies),
356bc1aee7fSJitao Shi 				    ps_bridge->supplies);
357bc1aee7fSJitao Shi 	if (ret < 0) {
358826cff3fSPhilip Chen 		dev_err(dev, "cannot enable regulators %d\n", ret);
359826cff3fSPhilip Chen 		return ret;
360bc1aee7fSJitao Shi 	}
361bc1aee7fSJitao Shi 
362bc1aee7fSJitao Shi 	gpiod_set_value(ps_bridge->gpio_powerdown, 0);
363bc1aee7fSJitao Shi 	gpiod_set_value(ps_bridge->gpio_reset, 1);
364bc1aee7fSJitao Shi 	usleep_range(2000, 2500);
365bc1aee7fSJitao Shi 	gpiod_set_value(ps_bridge->gpio_reset, 0);
366bc1aee7fSJitao Shi 
367bc1aee7fSJitao Shi 	/*
368826cff3fSPhilip Chen 	 * Mystery 200 ms delay for the "MCU to be ready". It's unclear if
369826cff3fSPhilip Chen 	 * this is truly necessary since the MCU will already signal that
370826cff3fSPhilip Chen 	 * things are "good to go" by signaling HPD on "gpio 9". See
371826cff3fSPhilip Chen 	 * ps8640_ensure_hpd(). For now we'll keep this mystery delay just in
372826cff3fSPhilip Chen 	 * case.
373bc1aee7fSJitao Shi 	 */
374bc1aee7fSJitao Shi 	msleep(200);
375bc1aee7fSJitao Shi 
376826cff3fSPhilip Chen 	return 0;
377bc1aee7fSJitao Shi }
378bc1aee7fSJitao Shi 
379826cff3fSPhilip Chen static int __maybe_unused ps8640_suspend(struct device *dev)
380826cff3fSPhilip Chen {
381826cff3fSPhilip Chen 	struct ps8640 *ps_bridge = dev_get_drvdata(dev);
382826cff3fSPhilip Chen 	int ret;
383826cff3fSPhilip Chen 
384826cff3fSPhilip Chen 	gpiod_set_value(ps_bridge->gpio_reset, 1);
385826cff3fSPhilip Chen 	gpiod_set_value(ps_bridge->gpio_powerdown, 1);
386826cff3fSPhilip Chen 	ret = regulator_bulk_disable(ARRAY_SIZE(ps_bridge->supplies),
387826cff3fSPhilip Chen 				     ps_bridge->supplies);
388826cff3fSPhilip Chen 	if (ret < 0)
389826cff3fSPhilip Chen 		dev_err(dev, "cannot disable regulators %d\n", ret);
390826cff3fSPhilip Chen 
391826cff3fSPhilip Chen 	return ret;
392826cff3fSPhilip Chen }
393826cff3fSPhilip Chen 
394826cff3fSPhilip Chen static const struct dev_pm_ops ps8640_pm_ops = {
395826cff3fSPhilip Chen 	SET_RUNTIME_PM_OPS(ps8640_suspend, ps8640_resume, NULL)
396826cff3fSPhilip Chen 	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
397826cff3fSPhilip Chen 				pm_runtime_force_resume)
398826cff3fSPhilip Chen };
399826cff3fSPhilip Chen 
400826cff3fSPhilip Chen static void ps8640_pre_enable(struct drm_bridge *bridge)
401826cff3fSPhilip Chen {
402826cff3fSPhilip Chen 	struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
403826cff3fSPhilip Chen 	struct regmap *map = ps_bridge->regmap[PAGE2_TOP_CNTL];
404826cff3fSPhilip Chen 	struct device *dev = &ps_bridge->page[PAGE0_DP_CNTL]->dev;
405826cff3fSPhilip Chen 	int ret;
406826cff3fSPhilip Chen 
407826cff3fSPhilip Chen 	pm_runtime_get_sync(dev);
408826cff3fSPhilip Chen 	ps8640_ensure_hpd(ps_bridge);
409bc1aee7fSJitao Shi 
410bc1aee7fSJitao Shi 	/*
411bc1aee7fSJitao Shi 	 * The Manufacturer Command Set (MCS) is a device dependent interface
412bc1aee7fSJitao Shi 	 * intended for factory programming of the display module default
413bc1aee7fSJitao Shi 	 * parameters. Once the display module is configured, the MCS shall be
414bc1aee7fSJitao Shi 	 * disabled by the manufacturer. Once disabled, all MCS commands are
415bc1aee7fSJitao Shi 	 * ignored by the display interface.
416bc1aee7fSJitao Shi 	 */
417bc1aee7fSJitao Shi 
418692d8db0SPhilip Chen 	ret = regmap_update_bits(map, PAGE2_MCS_EN, MCS_EN, 0);
419826cff3fSPhilip Chen 	if (ret < 0)
420826cff3fSPhilip Chen 		dev_warn(dev, "failed write PAGE2_MCS_EN: %d\n", ret);
421bc1aee7fSJitao Shi 
422bc1aee7fSJitao Shi 	/* Switch access edp panel's edid through i2c */
423692d8db0SPhilip Chen 	ret = regmap_write(map, PAGE2_I2C_BYPASS, I2C_BYPASS_EN);
424bc1aee7fSJitao Shi 	if (ret < 0)
425826cff3fSPhilip Chen 		dev_warn(dev, "failed write PAGE2_MCS_EN: %d\n", ret);
42646f20630SEnric Balletbo i Serra 
427826cff3fSPhilip Chen 	ps8640_bridge_vdo_control(ps_bridge, ENABLE);
42846f20630SEnric Balletbo i Serra 
429826cff3fSPhilip Chen 	ps_bridge->pre_enabled = true;
43046f20630SEnric Balletbo i Serra }
43146f20630SEnric Balletbo i Serra 
43246f20630SEnric Balletbo i Serra static void ps8640_post_disable(struct drm_bridge *bridge)
43346f20630SEnric Balletbo i Serra {
43446f20630SEnric Balletbo i Serra 	struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
43546f20630SEnric Balletbo i Serra 
436826cff3fSPhilip Chen 	ps_bridge->pre_enabled = false;
437826cff3fSPhilip Chen 
43846f20630SEnric Balletbo i Serra 	ps8640_bridge_vdo_control(ps_bridge, DISABLE);
439826cff3fSPhilip Chen 	pm_runtime_put_sync_suspend(&ps_bridge->page[PAGE0_DP_CNTL]->dev);
440bc1aee7fSJitao Shi }
441bc1aee7fSJitao Shi 
442a25b988fSLaurent Pinchart static int ps8640_bridge_attach(struct drm_bridge *bridge,
443a25b988fSLaurent Pinchart 				enum drm_bridge_attach_flags flags)
444bc1aee7fSJitao Shi {
445bc1aee7fSJitao Shi 	struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
446bc1aee7fSJitao Shi 	struct device *dev = &ps_bridge->page[0]->dev;
447bc1aee7fSJitao Shi 	int ret;
448812a65baSEnric Balletbo i Serra 
449812a65baSEnric Balletbo i Serra 	if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR))
450812a65baSEnric Balletbo i Serra 		return -EINVAL;
451812a65baSEnric Balletbo i Serra 
452*f8378c04SDouglas Anderson 	ps_bridge->aux.drm_dev = bridge->dev;
45313afcdd7SPhilip Chen 	ret = drm_dp_aux_register(&ps_bridge->aux);
45413afcdd7SPhilip Chen 	if (ret) {
45513afcdd7SPhilip Chen 		dev_err(dev, "failed to register DP AUX channel: %d\n", ret);
456fe93ae80SMaxime Ripard 		return ret;
45713afcdd7SPhilip Chen 	}
458bc1aee7fSJitao Shi 
459bc1aee7fSJitao Shi 	/* Attach the panel-bridge to the dsi bridge */
460bc1aee7fSJitao Shi 	return drm_bridge_attach(bridge->encoder, ps_bridge->panel_bridge,
461a25b988fSLaurent Pinchart 				 &ps_bridge->bridge, flags);
462bc1aee7fSJitao Shi }
463bc1aee7fSJitao Shi 
46413afcdd7SPhilip Chen static void ps8640_bridge_detach(struct drm_bridge *bridge)
46513afcdd7SPhilip Chen {
46613afcdd7SPhilip Chen 	drm_dp_aux_unregister(&bridge_to_ps8640(bridge)->aux);
46713afcdd7SPhilip Chen }
46813afcdd7SPhilip Chen 
469d82c12abSEnric Balletbo i Serra static struct edid *ps8640_bridge_get_edid(struct drm_bridge *bridge,
470d82c12abSEnric Balletbo i Serra 					   struct drm_connector *connector)
471d82c12abSEnric Balletbo i Serra {
472d82c12abSEnric Balletbo i Serra 	struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
473826cff3fSPhilip Chen 	bool poweroff = !ps_bridge->pre_enabled;
47446f20630SEnric Balletbo i Serra 	struct edid *edid;
475d82c12abSEnric Balletbo i Serra 
47646f20630SEnric Balletbo i Serra 	/*
47746f20630SEnric Balletbo i Serra 	 * When we end calling get_edid() triggered by an ioctl, i.e
47846f20630SEnric Balletbo i Serra 	 *
47946f20630SEnric Balletbo i Serra 	 *   drm_mode_getconnector (ioctl)
48046f20630SEnric Balletbo i Serra 	 *     -> drm_helper_probe_single_connector_modes
48146f20630SEnric Balletbo i Serra 	 *        -> drm_bridge_connector_get_modes
48246f20630SEnric Balletbo i Serra 	 *           -> ps8640_bridge_get_edid
48346f20630SEnric Balletbo i Serra 	 *
48446f20630SEnric Balletbo i Serra 	 * We need to make sure that what we need is enabled before reading
48546f20630SEnric Balletbo i Serra 	 * EDID, for this chip, we need to do a full poweron, otherwise it will
48646f20630SEnric Balletbo i Serra 	 * fail.
48746f20630SEnric Balletbo i Serra 	 */
48846f20630SEnric Balletbo i Serra 	drm_bridge_chain_pre_enable(bridge);
48946f20630SEnric Balletbo i Serra 
49046f20630SEnric Balletbo i Serra 	edid = drm_get_edid(connector,
491d82c12abSEnric Balletbo i Serra 			    ps_bridge->page[PAGE0_DP_CNTL]->adapter);
49246f20630SEnric Balletbo i Serra 
49346f20630SEnric Balletbo i Serra 	/*
49446f20630SEnric Balletbo i Serra 	 * If we call the get_edid() function without having enabled the chip
49546f20630SEnric Balletbo i Serra 	 * before, return the chip to its original power state.
49646f20630SEnric Balletbo i Serra 	 */
49746f20630SEnric Balletbo i Serra 	if (poweroff)
49846f20630SEnric Balletbo i Serra 		drm_bridge_chain_post_disable(bridge);
49946f20630SEnric Balletbo i Serra 
50046f20630SEnric Balletbo i Serra 	return edid;
501d82c12abSEnric Balletbo i Serra }
502d82c12abSEnric Balletbo i Serra 
503826cff3fSPhilip Chen static void ps8640_runtime_disable(void *data)
504826cff3fSPhilip Chen {
505826cff3fSPhilip Chen 	pm_runtime_dont_use_autosuspend(data);
506826cff3fSPhilip Chen 	pm_runtime_disable(data);
507826cff3fSPhilip Chen }
508826cff3fSPhilip Chen 
509bc1aee7fSJitao Shi static const struct drm_bridge_funcs ps8640_bridge_funcs = {
510bc1aee7fSJitao Shi 	.attach = ps8640_bridge_attach,
51113afcdd7SPhilip Chen 	.detach = ps8640_bridge_detach,
512d82c12abSEnric Balletbo i Serra 	.get_edid = ps8640_bridge_get_edid,
513bc1aee7fSJitao Shi 	.post_disable = ps8640_post_disable,
514bc1aee7fSJitao Shi 	.pre_enable = ps8640_pre_enable,
515bc1aee7fSJitao Shi };
516bc1aee7fSJitao Shi 
5177abbc26fSMaxime Ripard static int ps8640_bridge_host_attach(struct device *dev, struct ps8640 *ps_bridge)
5187abbc26fSMaxime Ripard {
5197abbc26fSMaxime Ripard 	struct device_node *in_ep, *dsi_node;
5207abbc26fSMaxime Ripard 	struct mipi_dsi_device *dsi;
5217abbc26fSMaxime Ripard 	struct mipi_dsi_host *host;
5227abbc26fSMaxime Ripard 	int ret;
5237abbc26fSMaxime Ripard 	const struct mipi_dsi_device_info info = { .type = "ps8640",
5247abbc26fSMaxime Ripard 						   .channel = 0,
5257abbc26fSMaxime Ripard 						   .node = NULL,
5267abbc26fSMaxime Ripard 						 };
5277abbc26fSMaxime Ripard 
5287abbc26fSMaxime Ripard 	/* port@0 is ps8640 dsi input port */
5297abbc26fSMaxime Ripard 	in_ep = of_graph_get_endpoint_by_regs(dev->of_node, 0, -1);
5307abbc26fSMaxime Ripard 	if (!in_ep)
5317abbc26fSMaxime Ripard 		return -ENODEV;
5327abbc26fSMaxime Ripard 
5337abbc26fSMaxime Ripard 	dsi_node = of_graph_get_remote_port_parent(in_ep);
5347abbc26fSMaxime Ripard 	of_node_put(in_ep);
5357abbc26fSMaxime Ripard 	if (!dsi_node)
5367abbc26fSMaxime Ripard 		return -ENODEV;
5377abbc26fSMaxime Ripard 
5387abbc26fSMaxime Ripard 	host = of_find_mipi_dsi_host_by_node(dsi_node);
5397abbc26fSMaxime Ripard 	of_node_put(dsi_node);
5407abbc26fSMaxime Ripard 	if (!host)
5417abbc26fSMaxime Ripard 		return -EPROBE_DEFER;
5427abbc26fSMaxime Ripard 
5437abbc26fSMaxime Ripard 	dsi = devm_mipi_dsi_device_register_full(dev, host, &info);
5447abbc26fSMaxime Ripard 	if (IS_ERR(dsi)) {
5457abbc26fSMaxime Ripard 		dev_err(dev, "failed to create dsi device\n");
5467abbc26fSMaxime Ripard 		return PTR_ERR(dsi);
5477abbc26fSMaxime Ripard 	}
5487abbc26fSMaxime Ripard 
5497abbc26fSMaxime Ripard 	ps_bridge->dsi = dsi;
5507abbc26fSMaxime Ripard 
5517abbc26fSMaxime Ripard 	dsi->host = host;
5527abbc26fSMaxime Ripard 	dsi->mode_flags = MIPI_DSI_MODE_VIDEO |
5537abbc26fSMaxime Ripard 			  MIPI_DSI_MODE_VIDEO_SYNC_PULSE;
5547abbc26fSMaxime Ripard 	dsi->format = MIPI_DSI_FMT_RGB888;
5557abbc26fSMaxime Ripard 	dsi->lanes = NUM_MIPI_LANES;
5567abbc26fSMaxime Ripard 
5577abbc26fSMaxime Ripard 	ret = devm_mipi_dsi_attach(dev, dsi);
5587abbc26fSMaxime Ripard 	if (ret)
5597abbc26fSMaxime Ripard 		return ret;
5607abbc26fSMaxime Ripard 
5617abbc26fSMaxime Ripard 	return 0;
5627abbc26fSMaxime Ripard }
5637abbc26fSMaxime Ripard 
564bc1aee7fSJitao Shi static int ps8640_probe(struct i2c_client *client)
565bc1aee7fSJitao Shi {
566bc1aee7fSJitao Shi 	struct device *dev = &client->dev;
567bc1aee7fSJitao Shi 	struct device_node *np = dev->of_node;
568bc1aee7fSJitao Shi 	struct ps8640 *ps_bridge;
569bc1aee7fSJitao Shi 	struct drm_panel *panel;
570bc1aee7fSJitao Shi 	int ret;
571bc1aee7fSJitao Shi 	u32 i;
572bc1aee7fSJitao Shi 
573bc1aee7fSJitao Shi 	ps_bridge = devm_kzalloc(dev, sizeof(*ps_bridge), GFP_KERNEL);
574bc1aee7fSJitao Shi 	if (!ps_bridge)
575bc1aee7fSJitao Shi 		return -ENOMEM;
576bc1aee7fSJitao Shi 
577bc1aee7fSJitao Shi 	ps_bridge->supplies[0].supply = "vdd33";
578bc1aee7fSJitao Shi 	ps_bridge->supplies[1].supply = "vdd12";
579bc1aee7fSJitao Shi 	ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(ps_bridge->supplies),
580bc1aee7fSJitao Shi 				      ps_bridge->supplies);
581bc1aee7fSJitao Shi 	if (ret)
582bc1aee7fSJitao Shi 		return ret;
583bc1aee7fSJitao Shi 
584bc1aee7fSJitao Shi 	ps_bridge->gpio_powerdown = devm_gpiod_get(&client->dev, "powerdown",
585bc1aee7fSJitao Shi 						   GPIOD_OUT_HIGH);
586bc1aee7fSJitao Shi 	if (IS_ERR(ps_bridge->gpio_powerdown))
587bc1aee7fSJitao Shi 		return PTR_ERR(ps_bridge->gpio_powerdown);
588bc1aee7fSJitao Shi 
589bc1aee7fSJitao Shi 	/*
590bc1aee7fSJitao Shi 	 * Assert the reset to avoid the bridge being initialized prematurely
591bc1aee7fSJitao Shi 	 */
592bc1aee7fSJitao Shi 	ps_bridge->gpio_reset = devm_gpiod_get(&client->dev, "reset",
593bc1aee7fSJitao Shi 					       GPIOD_OUT_HIGH);
594bc1aee7fSJitao Shi 	if (IS_ERR(ps_bridge->gpio_reset))
595bc1aee7fSJitao Shi 		return PTR_ERR(ps_bridge->gpio_reset);
596bc1aee7fSJitao Shi 
597bc1aee7fSJitao Shi 	ps_bridge->bridge.funcs = &ps8640_bridge_funcs;
598bc1aee7fSJitao Shi 	ps_bridge->bridge.of_node = dev->of_node;
599d82c12abSEnric Balletbo i Serra 	ps_bridge->bridge.type = DRM_MODE_CONNECTOR_eDP;
600bc1aee7fSJitao Shi 
601e9d9f958SPhilip Chen 	/*
602e9d9f958SPhilip Chen 	 * In the device tree, if panel is listed under aux-bus of the bridge
603e9d9f958SPhilip Chen 	 * node, panel driver should be able to retrieve EDID by itself using
604e9d9f958SPhilip Chen 	 * aux-bus. So let's not set DRM_BRIDGE_OP_EDID here.
605e9d9f958SPhilip Chen 	 */
606e9d9f958SPhilip Chen 	if (!ps8640_of_panel_on_aux_bus(&client->dev))
607e9d9f958SPhilip Chen 		ps_bridge->bridge.ops = DRM_BRIDGE_OP_EDID;
608e9d9f958SPhilip Chen 
609bc1aee7fSJitao Shi 	ps_bridge->page[PAGE0_DP_CNTL] = client;
610bc1aee7fSJitao Shi 
611692d8db0SPhilip Chen 	ps_bridge->regmap[PAGE0_DP_CNTL] = devm_regmap_init_i2c(client, ps8640_regmap_config);
612692d8db0SPhilip Chen 	if (IS_ERR(ps_bridge->regmap[PAGE0_DP_CNTL]))
613692d8db0SPhilip Chen 		return PTR_ERR(ps_bridge->regmap[PAGE0_DP_CNTL]);
614692d8db0SPhilip Chen 
615bc1aee7fSJitao Shi 	for (i = 1; i < ARRAY_SIZE(ps_bridge->page); i++) {
616bc1aee7fSJitao Shi 		ps_bridge->page[i] = devm_i2c_new_dummy_device(&client->dev,
617bc1aee7fSJitao Shi 							     client->adapter,
618bc1aee7fSJitao Shi 							     client->addr + i);
619692d8db0SPhilip Chen 		if (IS_ERR(ps_bridge->page[i]))
620bc1aee7fSJitao Shi 			return PTR_ERR(ps_bridge->page[i]);
621692d8db0SPhilip Chen 
622692d8db0SPhilip Chen 		ps_bridge->regmap[i] = devm_regmap_init_i2c(ps_bridge->page[i],
623692d8db0SPhilip Chen 							    ps8640_regmap_config + i);
624692d8db0SPhilip Chen 		if (IS_ERR(ps_bridge->regmap[i]))
625692d8db0SPhilip Chen 			return PTR_ERR(ps_bridge->regmap[i]);
626bc1aee7fSJitao Shi 	}
627bc1aee7fSJitao Shi 
628bc1aee7fSJitao Shi 	i2c_set_clientdata(client, ps_bridge);
629bc1aee7fSJitao Shi 
63013afcdd7SPhilip Chen 	ps_bridge->aux.name = "parade-ps8640-aux";
63113afcdd7SPhilip Chen 	ps_bridge->aux.dev = dev;
63213afcdd7SPhilip Chen 	ps_bridge->aux.transfer = ps8640_aux_transfer;
63313afcdd7SPhilip Chen 	drm_dp_aux_init(&ps_bridge->aux);
63413afcdd7SPhilip Chen 
635826cff3fSPhilip Chen 	pm_runtime_enable(dev);
636826cff3fSPhilip Chen 	/*
637826cff3fSPhilip Chen 	 * Powering on ps8640 takes ~300ms. To avoid wasting time on power
638aa70a099Syangcong 	 * cycling ps8640 too often, set autosuspend_delay to 1000ms to ensure
639826cff3fSPhilip Chen 	 * the bridge wouldn't suspend in between each _aux_transfer_msg() call
640826cff3fSPhilip Chen 	 * during EDID read (~20ms in my experiment) and in between the last
641826cff3fSPhilip Chen 	 * _aux_transfer_msg() call during EDID read and the _pre_enable() call
642826cff3fSPhilip Chen 	 * (~100ms in my experiment).
643826cff3fSPhilip Chen 	 */
644aa70a099Syangcong 	pm_runtime_set_autosuspend_delay(dev, 1000);
645826cff3fSPhilip Chen 	pm_runtime_use_autosuspend(dev);
646826cff3fSPhilip Chen 	pm_suspend_ignore_children(dev, true);
647826cff3fSPhilip Chen 	ret = devm_add_action_or_reset(dev, ps8640_runtime_disable, dev);
648826cff3fSPhilip Chen 	if (ret)
649826cff3fSPhilip Chen 		return ret;
650826cff3fSPhilip Chen 
651e9d9f958SPhilip Chen 	devm_of_dp_aux_populate_ep_devices(&ps_bridge->aux);
652e9d9f958SPhilip Chen 
653e9d9f958SPhilip Chen 	/* port@1 is ps8640 output port */
654e9d9f958SPhilip Chen 	ret = drm_of_find_panel_or_bridge(np, 1, 0, &panel, NULL);
655e9d9f958SPhilip Chen 	if (ret < 0)
656e9d9f958SPhilip Chen 		return ret;
657e9d9f958SPhilip Chen 	if (!panel)
658e9d9f958SPhilip Chen 		return -ENODEV;
659e9d9f958SPhilip Chen 
660e9d9f958SPhilip Chen 	ps_bridge->panel_bridge = devm_drm_panel_bridge_add(dev, panel);
661e9d9f958SPhilip Chen 	if (IS_ERR(ps_bridge->panel_bridge))
662e9d9f958SPhilip Chen 		return PTR_ERR(ps_bridge->panel_bridge);
663e9d9f958SPhilip Chen 
664bc1aee7fSJitao Shi 	drm_bridge_add(&ps_bridge->bridge);
665bc1aee7fSJitao Shi 
6667abbc26fSMaxime Ripard 	ret = ps8640_bridge_host_attach(dev, ps_bridge);
6677abbc26fSMaxime Ripard 	if (ret)
6687abbc26fSMaxime Ripard 		goto err_bridge_remove;
6697abbc26fSMaxime Ripard 
670bc1aee7fSJitao Shi 	return 0;
6717abbc26fSMaxime Ripard 
6727abbc26fSMaxime Ripard err_bridge_remove:
6737abbc26fSMaxime Ripard 	drm_bridge_remove(&ps_bridge->bridge);
6747abbc26fSMaxime Ripard 	return ret;
675bc1aee7fSJitao Shi }
676bc1aee7fSJitao Shi 
677bc1aee7fSJitao Shi static int ps8640_remove(struct i2c_client *client)
678bc1aee7fSJitao Shi {
679bc1aee7fSJitao Shi 	struct ps8640 *ps_bridge = i2c_get_clientdata(client);
680bc1aee7fSJitao Shi 
681bc1aee7fSJitao Shi 	drm_bridge_remove(&ps_bridge->bridge);
682bc1aee7fSJitao Shi 
683bc1aee7fSJitao Shi 	return 0;
684bc1aee7fSJitao Shi }
685bc1aee7fSJitao Shi 
686bc1aee7fSJitao Shi static const struct of_device_id ps8640_match[] = {
687bc1aee7fSJitao Shi 	{ .compatible = "parade,ps8640" },
688bc1aee7fSJitao Shi 	{ }
689bc1aee7fSJitao Shi };
690bc1aee7fSJitao Shi MODULE_DEVICE_TABLE(of, ps8640_match);
691bc1aee7fSJitao Shi 
692bc1aee7fSJitao Shi static struct i2c_driver ps8640_driver = {
693bc1aee7fSJitao Shi 	.probe_new = ps8640_probe,
694bc1aee7fSJitao Shi 	.remove = ps8640_remove,
695bc1aee7fSJitao Shi 	.driver = {
696bc1aee7fSJitao Shi 		.name = "ps8640",
697bc1aee7fSJitao Shi 		.of_match_table = ps8640_match,
698826cff3fSPhilip Chen 		.pm = &ps8640_pm_ops,
699bc1aee7fSJitao Shi 	},
700bc1aee7fSJitao Shi };
701bc1aee7fSJitao Shi module_i2c_driver(ps8640_driver);
702bc1aee7fSJitao Shi 
703bc1aee7fSJitao Shi MODULE_AUTHOR("Jitao Shi <jitao.shi@mediatek.com>");
704bc1aee7fSJitao Shi MODULE_AUTHOR("CK Hu <ck.hu@mediatek.com>");
705bc1aee7fSJitao Shi MODULE_AUTHOR("Enric Balletbo i Serra <enric.balletbo@collabora.com>");
706bc1aee7fSJitao Shi MODULE_DESCRIPTION("PARADE ps8640 DSI-eDP converter driver");
707bc1aee7fSJitao Shi MODULE_LICENSE("GPL v2");
708