1*2aec85b2SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2*2aec85b2SThomas Gleixner // Copyright (C) 2017 Broadcom
3787f2454SRaviteja Garimella
4787f2454SRaviteja Garimella #include <linux/delay.h>
5176aa360SChanwoo Choi #include <linux/extcon-provider.h>
6787f2454SRaviteja Garimella #include <linux/gpio.h>
7787f2454SRaviteja Garimella #include <linux/gpio/consumer.h>
8787f2454SRaviteja Garimella #include <linux/init.h>
9787f2454SRaviteja Garimella #include <linux/interrupt.h>
10787f2454SRaviteja Garimella #include <linux/io.h>
1101a45633SChunfeng Yun #include <linux/iopoll.h>
12787f2454SRaviteja Garimella #include <linux/irq.h>
13787f2454SRaviteja Garimella #include <linux/mfd/syscon.h>
14787f2454SRaviteja Garimella #include <linux/module.h>
15787f2454SRaviteja Garimella #include <linux/of.h>
16787f2454SRaviteja Garimella #include <linux/of_address.h>
17787f2454SRaviteja Garimella #include <linux/phy/phy.h>
18787f2454SRaviteja Garimella #include <linux/platform_device.h>
19787f2454SRaviteja Garimella #include <linux/regmap.h>
20787f2454SRaviteja Garimella #include <linux/slab.h>
21787f2454SRaviteja Garimella #include <linux/workqueue.h>
22787f2454SRaviteja Garimella
23787f2454SRaviteja Garimella #define ICFG_DRD_AFE 0x0
24787f2454SRaviteja Garimella #define ICFG_MISC_STAT 0x18
25787f2454SRaviteja Garimella #define ICFG_DRD_P0CTL 0x1C
26787f2454SRaviteja Garimella #define ICFG_STRAP_CTRL 0x20
27787f2454SRaviteja Garimella #define ICFG_FSM_CTRL 0x24
28787f2454SRaviteja Garimella
29787f2454SRaviteja Garimella #define ICFG_DEV_BIT BIT(2)
30787f2454SRaviteja Garimella #define IDM_RST_BIT BIT(0)
31787f2454SRaviteja Garimella #define AFE_CORERDY_VDDC BIT(18)
32787f2454SRaviteja Garimella #define PHY_PLL_RESETB BIT(15)
33787f2454SRaviteja Garimella #define PHY_RESETB BIT(14)
34787f2454SRaviteja Garimella #define PHY_PLL_LOCK BIT(0)
35787f2454SRaviteja Garimella
36787f2454SRaviteja Garimella #define DRD_DEV_MODE BIT(20)
37787f2454SRaviteja Garimella #define OHCI_OVRCUR_POL BIT(11)
38787f2454SRaviteja Garimella #define ICFG_OFF_MODE BIT(6)
39787f2454SRaviteja Garimella #define PLL_LOCK_RETRY 1000
40787f2454SRaviteja Garimella
41787f2454SRaviteja Garimella #define EVT_DEVICE 0
42787f2454SRaviteja Garimella #define EVT_HOST 1
43787f2454SRaviteja Garimella
44787f2454SRaviteja Garimella #define DRD_HOST_MODE (BIT(2) | BIT(3))
45787f2454SRaviteja Garimella #define DRD_DEVICE_MODE (BIT(4) | BIT(5))
46787f2454SRaviteja Garimella #define DRD_HOST_VAL 0x803
47787f2454SRaviteja Garimella #define DRD_DEV_VAL 0x807
48787f2454SRaviteja Garimella #define GPIO_DELAY 20
49787f2454SRaviteja Garimella
50787f2454SRaviteja Garimella struct ns2_phy_data;
51787f2454SRaviteja Garimella struct ns2_phy_driver {
52787f2454SRaviteja Garimella void __iomem *icfgdrd_regs;
53787f2454SRaviteja Garimella void __iomem *idmdrd_rst_ctrl;
54787f2454SRaviteja Garimella void __iomem *crmu_usb2_ctrl;
55787f2454SRaviteja Garimella void __iomem *usb2h_strap_reg;
56787f2454SRaviteja Garimella struct ns2_phy_data *data;
57787f2454SRaviteja Garimella struct extcon_dev *edev;
58787f2454SRaviteja Garimella struct gpio_desc *vbus_gpiod;
59787f2454SRaviteja Garimella struct gpio_desc *id_gpiod;
60787f2454SRaviteja Garimella int id_irq;
61787f2454SRaviteja Garimella int vbus_irq;
62787f2454SRaviteja Garimella unsigned long debounce_jiffies;
63787f2454SRaviteja Garimella struct delayed_work wq_extcon;
64787f2454SRaviteja Garimella };
65787f2454SRaviteja Garimella
66787f2454SRaviteja Garimella struct ns2_phy_data {
67787f2454SRaviteja Garimella struct ns2_phy_driver *driver;
68787f2454SRaviteja Garimella struct phy *phy;
69787f2454SRaviteja Garimella int new_state;
70787f2454SRaviteja Garimella };
71787f2454SRaviteja Garimella
72787f2454SRaviteja Garimella static const unsigned int usb_extcon_cable[] = {
73787f2454SRaviteja Garimella EXTCON_USB,
74787f2454SRaviteja Garimella EXTCON_USB_HOST,
75787f2454SRaviteja Garimella EXTCON_NONE,
76787f2454SRaviteja Garimella };
77787f2454SRaviteja Garimella
pll_lock_stat(u32 usb_reg,int reg_mask,struct ns2_phy_driver * driver)78787f2454SRaviteja Garimella static inline int pll_lock_stat(u32 usb_reg, int reg_mask,
79787f2454SRaviteja Garimella struct ns2_phy_driver *driver)
80787f2454SRaviteja Garimella {
81787f2454SRaviteja Garimella u32 val;
82787f2454SRaviteja Garimella
8301a45633SChunfeng Yun return readl_poll_timeout_atomic(driver->icfgdrd_regs + usb_reg,
8401a45633SChunfeng Yun val, (val & reg_mask), 1,
8501a45633SChunfeng Yun PLL_LOCK_RETRY);
86787f2454SRaviteja Garimella }
87787f2454SRaviteja Garimella
ns2_drd_phy_init(struct phy * phy)88787f2454SRaviteja Garimella static int ns2_drd_phy_init(struct phy *phy)
89787f2454SRaviteja Garimella {
90787f2454SRaviteja Garimella struct ns2_phy_data *data = phy_get_drvdata(phy);
91787f2454SRaviteja Garimella struct ns2_phy_driver *driver = data->driver;
92787f2454SRaviteja Garimella u32 val;
93787f2454SRaviteja Garimella
94787f2454SRaviteja Garimella val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL);
95787f2454SRaviteja Garimella
96787f2454SRaviteja Garimella if (data->new_state == EVT_HOST) {
97787f2454SRaviteja Garimella val &= ~DRD_DEVICE_MODE;
98787f2454SRaviteja Garimella val |= DRD_HOST_MODE;
99787f2454SRaviteja Garimella } else {
100787f2454SRaviteja Garimella val &= ~DRD_HOST_MODE;
101787f2454SRaviteja Garimella val |= DRD_DEVICE_MODE;
102787f2454SRaviteja Garimella }
103787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL);
104787f2454SRaviteja Garimella
105787f2454SRaviteja Garimella return 0;
106787f2454SRaviteja Garimella }
107787f2454SRaviteja Garimella
ns2_drd_phy_poweroff(struct phy * phy)108787f2454SRaviteja Garimella static int ns2_drd_phy_poweroff(struct phy *phy)
109787f2454SRaviteja Garimella {
110787f2454SRaviteja Garimella struct ns2_phy_data *data = phy_get_drvdata(phy);
111787f2454SRaviteja Garimella struct ns2_phy_driver *driver = data->driver;
112787f2454SRaviteja Garimella u32 val;
113787f2454SRaviteja Garimella
114787f2454SRaviteja Garimella val = readl(driver->crmu_usb2_ctrl);
115787f2454SRaviteja Garimella val &= ~AFE_CORERDY_VDDC;
116787f2454SRaviteja Garimella writel(val, driver->crmu_usb2_ctrl);
117787f2454SRaviteja Garimella
118787f2454SRaviteja Garimella val = readl(driver->crmu_usb2_ctrl);
119787f2454SRaviteja Garimella val &= ~DRD_DEV_MODE;
120787f2454SRaviteja Garimella writel(val, driver->crmu_usb2_ctrl);
121787f2454SRaviteja Garimella
122787f2454SRaviteja Garimella /* Disable Host and Device Mode */
123787f2454SRaviteja Garimella val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL);
124787f2454SRaviteja Garimella val &= ~(DRD_HOST_MODE | DRD_DEVICE_MODE | ICFG_OFF_MODE);
125787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL);
126787f2454SRaviteja Garimella
127787f2454SRaviteja Garimella return 0;
128787f2454SRaviteja Garimella }
129787f2454SRaviteja Garimella
ns2_drd_phy_poweron(struct phy * phy)130787f2454SRaviteja Garimella static int ns2_drd_phy_poweron(struct phy *phy)
131787f2454SRaviteja Garimella {
132787f2454SRaviteja Garimella struct ns2_phy_data *data = phy_get_drvdata(phy);
133787f2454SRaviteja Garimella struct ns2_phy_driver *driver = data->driver;
134787f2454SRaviteja Garimella u32 extcon_event = data->new_state;
135787f2454SRaviteja Garimella int ret;
136787f2454SRaviteja Garimella u32 val;
137787f2454SRaviteja Garimella
138787f2454SRaviteja Garimella if (extcon_event == EVT_DEVICE) {
139787f2454SRaviteja Garimella writel(DRD_DEV_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL);
140787f2454SRaviteja Garimella
141787f2454SRaviteja Garimella val = readl(driver->idmdrd_rst_ctrl);
142787f2454SRaviteja Garimella val &= ~IDM_RST_BIT;
143787f2454SRaviteja Garimella writel(val, driver->idmdrd_rst_ctrl);
144787f2454SRaviteja Garimella
145787f2454SRaviteja Garimella val = readl(driver->crmu_usb2_ctrl);
146787f2454SRaviteja Garimella val |= (AFE_CORERDY_VDDC | DRD_DEV_MODE);
147787f2454SRaviteja Garimella writel(val, driver->crmu_usb2_ctrl);
148787f2454SRaviteja Garimella
149787f2454SRaviteja Garimella /* Bring PHY and PHY_PLL out of Reset */
150787f2454SRaviteja Garimella val = readl(driver->crmu_usb2_ctrl);
151787f2454SRaviteja Garimella val |= (PHY_PLL_RESETB | PHY_RESETB);
152787f2454SRaviteja Garimella writel(val, driver->crmu_usb2_ctrl);
153787f2454SRaviteja Garimella
154787f2454SRaviteja Garimella ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver);
155787f2454SRaviteja Garimella if (ret < 0) {
156787f2454SRaviteja Garimella dev_err(&phy->dev, "Phy PLL lock failed\n");
157787f2454SRaviteja Garimella return ret;
158787f2454SRaviteja Garimella }
159787f2454SRaviteja Garimella } else {
160787f2454SRaviteja Garimella writel(DRD_HOST_VAL, driver->icfgdrd_regs + ICFG_DRD_P0CTL);
161787f2454SRaviteja Garimella
162787f2454SRaviteja Garimella val = readl(driver->crmu_usb2_ctrl);
163787f2454SRaviteja Garimella val |= AFE_CORERDY_VDDC;
164787f2454SRaviteja Garimella writel(val, driver->crmu_usb2_ctrl);
165787f2454SRaviteja Garimella
166787f2454SRaviteja Garimella ret = pll_lock_stat(ICFG_MISC_STAT, PHY_PLL_LOCK, driver);
167787f2454SRaviteja Garimella if (ret < 0) {
168787f2454SRaviteja Garimella dev_err(&phy->dev, "Phy PLL lock failed\n");
169787f2454SRaviteja Garimella return ret;
170787f2454SRaviteja Garimella }
171787f2454SRaviteja Garimella
172787f2454SRaviteja Garimella val = readl(driver->idmdrd_rst_ctrl);
173787f2454SRaviteja Garimella val &= ~IDM_RST_BIT;
174787f2454SRaviteja Garimella writel(val, driver->idmdrd_rst_ctrl);
175787f2454SRaviteja Garimella
176787f2454SRaviteja Garimella /* port over current Polarity */
177787f2454SRaviteja Garimella val = readl(driver->usb2h_strap_reg);
178787f2454SRaviteja Garimella val |= OHCI_OVRCUR_POL;
179787f2454SRaviteja Garimella writel(val, driver->usb2h_strap_reg);
180787f2454SRaviteja Garimella }
181787f2454SRaviteja Garimella
182787f2454SRaviteja Garimella return 0;
183787f2454SRaviteja Garimella }
184787f2454SRaviteja Garimella
connect_change(struct ns2_phy_driver * driver)185787f2454SRaviteja Garimella static void connect_change(struct ns2_phy_driver *driver)
186787f2454SRaviteja Garimella {
187787f2454SRaviteja Garimella u32 extcon_event;
188787f2454SRaviteja Garimella u32 val;
189787f2454SRaviteja Garimella
190787f2454SRaviteja Garimella extcon_event = driver->data->new_state;
191787f2454SRaviteja Garimella val = readl(driver->icfgdrd_regs + ICFG_FSM_CTRL);
192787f2454SRaviteja Garimella
193787f2454SRaviteja Garimella switch (extcon_event) {
194787f2454SRaviteja Garimella case EVT_DEVICE:
195787f2454SRaviteja Garimella val &= ~(DRD_HOST_MODE | DRD_DEVICE_MODE);
196787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL);
197787f2454SRaviteja Garimella
198787f2454SRaviteja Garimella val = (val & ~DRD_HOST_MODE) | DRD_DEVICE_MODE;
199787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL);
200787f2454SRaviteja Garimella
201787f2454SRaviteja Garimella val = readl(driver->icfgdrd_regs + ICFG_DRD_P0CTL);
202787f2454SRaviteja Garimella val |= ICFG_DEV_BIT;
203787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_DRD_P0CTL);
204787f2454SRaviteja Garimella break;
205787f2454SRaviteja Garimella
206787f2454SRaviteja Garimella case EVT_HOST:
207787f2454SRaviteja Garimella val &= ~(DRD_HOST_MODE | DRD_DEVICE_MODE);
208787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL);
209787f2454SRaviteja Garimella
210787f2454SRaviteja Garimella val = (val & ~DRD_DEVICE_MODE) | DRD_HOST_MODE;
211787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_FSM_CTRL);
212787f2454SRaviteja Garimella
213787f2454SRaviteja Garimella val = readl(driver->usb2h_strap_reg);
214787f2454SRaviteja Garimella val |= OHCI_OVRCUR_POL;
215787f2454SRaviteja Garimella writel(val, driver->usb2h_strap_reg);
216787f2454SRaviteja Garimella
217787f2454SRaviteja Garimella val = readl(driver->icfgdrd_regs + ICFG_DRD_P0CTL);
218787f2454SRaviteja Garimella val &= ~ICFG_DEV_BIT;
219787f2454SRaviteja Garimella writel(val, driver->icfgdrd_regs + ICFG_DRD_P0CTL);
220787f2454SRaviteja Garimella break;
221787f2454SRaviteja Garimella
222787f2454SRaviteja Garimella default:
223787f2454SRaviteja Garimella pr_err("Invalid extcon event\n");
224787f2454SRaviteja Garimella break;
225787f2454SRaviteja Garimella }
226787f2454SRaviteja Garimella }
227787f2454SRaviteja Garimella
extcon_work(struct work_struct * work)228787f2454SRaviteja Garimella static void extcon_work(struct work_struct *work)
229787f2454SRaviteja Garimella {
230787f2454SRaviteja Garimella struct ns2_phy_driver *driver;
231787f2454SRaviteja Garimella int vbus;
232787f2454SRaviteja Garimella int id;
233787f2454SRaviteja Garimella
234787f2454SRaviteja Garimella driver = container_of(to_delayed_work(work),
235787f2454SRaviteja Garimella struct ns2_phy_driver, wq_extcon);
236787f2454SRaviteja Garimella
237787f2454SRaviteja Garimella id = gpiod_get_value_cansleep(driver->id_gpiod);
238787f2454SRaviteja Garimella vbus = gpiod_get_value_cansleep(driver->vbus_gpiod);
239787f2454SRaviteja Garimella
240787f2454SRaviteja Garimella if (!id && vbus) { /* Host connected */
24102026de8SChanwoo Choi extcon_set_state_sync(driver->edev, EXTCON_USB_HOST, true);
242787f2454SRaviteja Garimella pr_debug("Host cable connected\n");
243787f2454SRaviteja Garimella driver->data->new_state = EVT_HOST;
244787f2454SRaviteja Garimella connect_change(driver);
245787f2454SRaviteja Garimella } else if (id && !vbus) { /* Disconnected */
24602026de8SChanwoo Choi extcon_set_state_sync(driver->edev, EXTCON_USB_HOST, false);
24702026de8SChanwoo Choi extcon_set_state_sync(driver->edev, EXTCON_USB, false);
248787f2454SRaviteja Garimella pr_debug("Cable disconnected\n");
249787f2454SRaviteja Garimella } else if (id && vbus) { /* Device connected */
25002026de8SChanwoo Choi extcon_set_state_sync(driver->edev, EXTCON_USB, true);
251787f2454SRaviteja Garimella pr_debug("Device cable connected\n");
252787f2454SRaviteja Garimella driver->data->new_state = EVT_DEVICE;
253787f2454SRaviteja Garimella connect_change(driver);
254787f2454SRaviteja Garimella }
255787f2454SRaviteja Garimella }
256787f2454SRaviteja Garimella
gpio_irq_handler(int irq,void * dev_id)257787f2454SRaviteja Garimella static irqreturn_t gpio_irq_handler(int irq, void *dev_id)
258787f2454SRaviteja Garimella {
259787f2454SRaviteja Garimella struct ns2_phy_driver *driver = dev_id;
260787f2454SRaviteja Garimella
261787f2454SRaviteja Garimella queue_delayed_work(system_power_efficient_wq, &driver->wq_extcon,
262787f2454SRaviteja Garimella driver->debounce_jiffies);
263787f2454SRaviteja Garimella
264787f2454SRaviteja Garimella return IRQ_HANDLED;
265787f2454SRaviteja Garimella }
266787f2454SRaviteja Garimella
267728ac1baSRikard Falkeborn static const struct phy_ops ops = {
268787f2454SRaviteja Garimella .init = ns2_drd_phy_init,
269787f2454SRaviteja Garimella .power_on = ns2_drd_phy_poweron,
270787f2454SRaviteja Garimella .power_off = ns2_drd_phy_poweroff,
271787f2454SRaviteja Garimella .owner = THIS_MODULE,
272787f2454SRaviteja Garimella };
273787f2454SRaviteja Garimella
274787f2454SRaviteja Garimella static const struct of_device_id ns2_drd_phy_dt_ids[] = {
275787f2454SRaviteja Garimella { .compatible = "brcm,ns2-drd-phy", },
276787f2454SRaviteja Garimella { }
277787f2454SRaviteja Garimella };
278787f2454SRaviteja Garimella MODULE_DEVICE_TABLE(of, ns2_drd_phy_dt_ids);
279787f2454SRaviteja Garimella
ns2_drd_phy_probe(struct platform_device * pdev)280787f2454SRaviteja Garimella static int ns2_drd_phy_probe(struct platform_device *pdev)
281787f2454SRaviteja Garimella {
282787f2454SRaviteja Garimella struct phy_provider *phy_provider;
283787f2454SRaviteja Garimella struct device *dev = &pdev->dev;
284787f2454SRaviteja Garimella struct ns2_phy_driver *driver;
285787f2454SRaviteja Garimella struct ns2_phy_data *data;
286787f2454SRaviteja Garimella int ret;
287787f2454SRaviteja Garimella u32 val;
288787f2454SRaviteja Garimella
289787f2454SRaviteja Garimella driver = devm_kzalloc(dev, sizeof(struct ns2_phy_driver),
290787f2454SRaviteja Garimella GFP_KERNEL);
291787f2454SRaviteja Garimella if (!driver)
292787f2454SRaviteja Garimella return -ENOMEM;
293787f2454SRaviteja Garimella
294787f2454SRaviteja Garimella driver->data = devm_kzalloc(dev, sizeof(struct ns2_phy_data),
295787f2454SRaviteja Garimella GFP_KERNEL);
296787f2454SRaviteja Garimella if (!driver->data)
297787f2454SRaviteja Garimella return -ENOMEM;
298787f2454SRaviteja Garimella
299f669bc8bSChunfeng Yun driver->icfgdrd_regs = devm_platform_ioremap_resource_byname(pdev, "icfg");
300787f2454SRaviteja Garimella if (IS_ERR(driver->icfgdrd_regs))
301787f2454SRaviteja Garimella return PTR_ERR(driver->icfgdrd_regs);
302787f2454SRaviteja Garimella
303f669bc8bSChunfeng Yun driver->idmdrd_rst_ctrl = devm_platform_ioremap_resource_byname(pdev, "rst-ctrl");
304787f2454SRaviteja Garimella if (IS_ERR(driver->idmdrd_rst_ctrl))
305787f2454SRaviteja Garimella return PTR_ERR(driver->idmdrd_rst_ctrl);
306787f2454SRaviteja Garimella
307f669bc8bSChunfeng Yun driver->crmu_usb2_ctrl = devm_platform_ioremap_resource_byname(pdev, "crmu-ctrl");
308787f2454SRaviteja Garimella if (IS_ERR(driver->crmu_usb2_ctrl))
309787f2454SRaviteja Garimella return PTR_ERR(driver->crmu_usb2_ctrl);
310787f2454SRaviteja Garimella
311f669bc8bSChunfeng Yun driver->usb2h_strap_reg = devm_platform_ioremap_resource_byname(pdev, "usb2-strap");
312787f2454SRaviteja Garimella if (IS_ERR(driver->usb2h_strap_reg))
313787f2454SRaviteja Garimella return PTR_ERR(driver->usb2h_strap_reg);
314787f2454SRaviteja Garimella
315787f2454SRaviteja Garimella /* create extcon */
316787f2454SRaviteja Garimella driver->id_gpiod = devm_gpiod_get(&pdev->dev, "id", GPIOD_IN);
317787f2454SRaviteja Garimella if (IS_ERR(driver->id_gpiod)) {
318787f2454SRaviteja Garimella dev_err(dev, "failed to get ID GPIO\n");
319787f2454SRaviteja Garimella return PTR_ERR(driver->id_gpiod);
320787f2454SRaviteja Garimella }
321787f2454SRaviteja Garimella driver->vbus_gpiod = devm_gpiod_get(&pdev->dev, "vbus", GPIOD_IN);
322787f2454SRaviteja Garimella if (IS_ERR(driver->vbus_gpiod)) {
323787f2454SRaviteja Garimella dev_err(dev, "failed to get VBUS GPIO\n");
324787f2454SRaviteja Garimella return PTR_ERR(driver->vbus_gpiod);
325787f2454SRaviteja Garimella }
326787f2454SRaviteja Garimella
327787f2454SRaviteja Garimella driver->edev = devm_extcon_dev_allocate(dev, usb_extcon_cable);
328787f2454SRaviteja Garimella if (IS_ERR(driver->edev)) {
329787f2454SRaviteja Garimella dev_err(dev, "failed to allocate extcon device\n");
330787f2454SRaviteja Garimella return -ENOMEM;
331787f2454SRaviteja Garimella }
332787f2454SRaviteja Garimella
333787f2454SRaviteja Garimella ret = devm_extcon_dev_register(dev, driver->edev);
334787f2454SRaviteja Garimella if (ret < 0) {
335787f2454SRaviteja Garimella dev_err(dev, "failed to register extcon device\n");
336787f2454SRaviteja Garimella return ret;
337787f2454SRaviteja Garimella }
338787f2454SRaviteja Garimella
339787f2454SRaviteja Garimella ret = gpiod_set_debounce(driver->id_gpiod, GPIO_DELAY * 1000);
340787f2454SRaviteja Garimella if (ret < 0)
341787f2454SRaviteja Garimella driver->debounce_jiffies = msecs_to_jiffies(GPIO_DELAY);
342787f2454SRaviteja Garimella
343787f2454SRaviteja Garimella INIT_DELAYED_WORK(&driver->wq_extcon, extcon_work);
344787f2454SRaviteja Garimella
345787f2454SRaviteja Garimella driver->id_irq = gpiod_to_irq(driver->id_gpiod);
346787f2454SRaviteja Garimella if (driver->id_irq < 0) {
347787f2454SRaviteja Garimella dev_err(dev, "failed to get ID IRQ\n");
348787f2454SRaviteja Garimella return driver->id_irq;
349787f2454SRaviteja Garimella }
350787f2454SRaviteja Garimella
351787f2454SRaviteja Garimella driver->vbus_irq = gpiod_to_irq(driver->vbus_gpiod);
352787f2454SRaviteja Garimella if (driver->vbus_irq < 0) {
353787f2454SRaviteja Garimella dev_err(dev, "failed to get ID IRQ\n");
354787f2454SRaviteja Garimella return driver->vbus_irq;
355787f2454SRaviteja Garimella }
356787f2454SRaviteja Garimella
357787f2454SRaviteja Garimella ret = devm_request_irq(dev, driver->id_irq, gpio_irq_handler,
358787f2454SRaviteja Garimella IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
359787f2454SRaviteja Garimella "usb_id", driver);
360787f2454SRaviteja Garimella if (ret < 0) {
361787f2454SRaviteja Garimella dev_err(dev, "failed to request handler for ID IRQ\n");
362787f2454SRaviteja Garimella return ret;
363787f2454SRaviteja Garimella }
364787f2454SRaviteja Garimella
365787f2454SRaviteja Garimella ret = devm_request_irq(dev, driver->vbus_irq, gpio_irq_handler,
366787f2454SRaviteja Garimella IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
367787f2454SRaviteja Garimella "usb_vbus", driver);
368787f2454SRaviteja Garimella if (ret < 0) {
369787f2454SRaviteja Garimella dev_err(dev, "failed to request handler for VBUS IRQ\n");
370787f2454SRaviteja Garimella return ret;
371787f2454SRaviteja Garimella }
372787f2454SRaviteja Garimella
373787f2454SRaviteja Garimella dev_set_drvdata(dev, driver);
374787f2454SRaviteja Garimella
375787f2454SRaviteja Garimella /* Shutdown all ports. They can be powered up as required */
376787f2454SRaviteja Garimella val = readl(driver->crmu_usb2_ctrl);
377787f2454SRaviteja Garimella val &= ~(AFE_CORERDY_VDDC | PHY_RESETB);
378787f2454SRaviteja Garimella writel(val, driver->crmu_usb2_ctrl);
379787f2454SRaviteja Garimella
380787f2454SRaviteja Garimella data = driver->data;
381787f2454SRaviteja Garimella data->phy = devm_phy_create(dev, dev->of_node, &ops);
382787f2454SRaviteja Garimella if (IS_ERR(data->phy)) {
383787f2454SRaviteja Garimella dev_err(dev, "Failed to create usb drd phy\n");
384787f2454SRaviteja Garimella return PTR_ERR(data->phy);
385787f2454SRaviteja Garimella }
386787f2454SRaviteja Garimella
387787f2454SRaviteja Garimella data->driver = driver;
388787f2454SRaviteja Garimella phy_set_drvdata(data->phy, data);
389787f2454SRaviteja Garimella
390787f2454SRaviteja Garimella phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
391787f2454SRaviteja Garimella if (IS_ERR(phy_provider)) {
392787f2454SRaviteja Garimella dev_err(dev, "Failed to register as phy provider\n");
393787f2454SRaviteja Garimella return PTR_ERR(phy_provider);
394787f2454SRaviteja Garimella }
395787f2454SRaviteja Garimella
396787f2454SRaviteja Garimella platform_set_drvdata(pdev, driver);
397787f2454SRaviteja Garimella
398787f2454SRaviteja Garimella dev_info(dev, "Registered NS2 DRD Phy device\n");
399787f2454SRaviteja Garimella queue_delayed_work(system_power_efficient_wq, &driver->wq_extcon,
400787f2454SRaviteja Garimella driver->debounce_jiffies);
401787f2454SRaviteja Garimella
402787f2454SRaviteja Garimella return 0;
403787f2454SRaviteja Garimella }
404787f2454SRaviteja Garimella
405787f2454SRaviteja Garimella static struct platform_driver ns2_drd_phy_driver = {
406787f2454SRaviteja Garimella .probe = ns2_drd_phy_probe,
407787f2454SRaviteja Garimella .driver = {
408787f2454SRaviteja Garimella .name = "bcm-ns2-usbphy",
409787f2454SRaviteja Garimella .of_match_table = of_match_ptr(ns2_drd_phy_dt_ids),
410787f2454SRaviteja Garimella },
411787f2454SRaviteja Garimella };
412787f2454SRaviteja Garimella module_platform_driver(ns2_drd_phy_driver);
413787f2454SRaviteja Garimella
414787f2454SRaviteja Garimella MODULE_ALIAS("platform:bcm-ns2-drd-phy");
415787f2454SRaviteja Garimella MODULE_AUTHOR("Broadcom");
416787f2454SRaviteja Garimella MODULE_DESCRIPTION("Broadcom NS2 USB2 PHY driver");
417787f2454SRaviteja Garimella MODULE_LICENSE("GPL v2");
418