1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (c) 2016 Linaro Ltd.
4  */
5 
6 #include <linux/device.h>
7 #include <linux/usb/chipidea.h>
8 #include <linux/ulpi/interface.h>
9 
10 #include "ci.h"
11 
12 #define ULPI_WAKEUP		BIT(31)
13 #define ULPI_RUN		BIT(30)
14 #define ULPI_WRITE		BIT(29)
15 #define ULPI_SYNC_STATE		BIT(27)
16 #define ULPI_ADDR(n)		((n) << 16)
17 #define ULPI_DATA(n)		(n)
18 
ci_ulpi_wait(struct ci_hdrc * ci,u32 mask)19 static int ci_ulpi_wait(struct ci_hdrc *ci, u32 mask)
20 {
21 	unsigned long usec = 10000;
22 
23 	while (usec--) {
24 		if (!hw_read(ci, OP_ULPI_VIEWPORT, mask))
25 			return 0;
26 
27 		udelay(1);
28 	}
29 
30 	return -ETIMEDOUT;
31 }
32 
ci_ulpi_read(struct device * dev,u8 addr)33 static int ci_ulpi_read(struct device *dev, u8 addr)
34 {
35 	struct ci_hdrc *ci = dev_get_drvdata(dev);
36 	int ret;
37 
38 	hw_write(ci, OP_ULPI_VIEWPORT, 0xffffffff, ULPI_WRITE | ULPI_WAKEUP);
39 	ret = ci_ulpi_wait(ci, ULPI_WAKEUP);
40 	if (ret)
41 		return ret;
42 
43 	hw_write(ci, OP_ULPI_VIEWPORT, 0xffffffff, ULPI_RUN | ULPI_ADDR(addr));
44 	ret = ci_ulpi_wait(ci, ULPI_RUN);
45 	if (ret)
46 		return ret;
47 
48 	return hw_read(ci, OP_ULPI_VIEWPORT, GENMASK(15, 8)) >> 8;
49 }
50 
ci_ulpi_write(struct device * dev,u8 addr,u8 val)51 static int ci_ulpi_write(struct device *dev, u8 addr, u8 val)
52 {
53 	struct ci_hdrc *ci = dev_get_drvdata(dev);
54 	int ret;
55 
56 	hw_write(ci, OP_ULPI_VIEWPORT, 0xffffffff, ULPI_WRITE | ULPI_WAKEUP);
57 	ret = ci_ulpi_wait(ci, ULPI_WAKEUP);
58 	if (ret)
59 		return ret;
60 
61 	hw_write(ci, OP_ULPI_VIEWPORT, 0xffffffff,
62 		 ULPI_RUN | ULPI_WRITE | ULPI_ADDR(addr) | val);
63 	return ci_ulpi_wait(ci, ULPI_RUN);
64 }
65 
ci_ulpi_init(struct ci_hdrc * ci)66 int ci_ulpi_init(struct ci_hdrc *ci)
67 {
68 	if (ci->platdata->phy_mode != USBPHY_INTERFACE_MODE_ULPI)
69 		return 0;
70 
71 	/*
72 	 * Set PORTSC correctly so we can read/write ULPI registers for
73 	 * identification purposes
74 	 */
75 	hw_phymode_configure(ci);
76 
77 	ci->ulpi_ops.read = ci_ulpi_read;
78 	ci->ulpi_ops.write = ci_ulpi_write;
79 	ci->ulpi = ulpi_register_interface(ci->dev, &ci->ulpi_ops);
80 	if (IS_ERR(ci->ulpi))
81 		dev_err(ci->dev, "failed to register ULPI interface");
82 
83 	return PTR_ERR_OR_ZERO(ci->ulpi);
84 }
85 
ci_ulpi_exit(struct ci_hdrc * ci)86 void ci_ulpi_exit(struct ci_hdrc *ci)
87 {
88 	if (ci->ulpi) {
89 		ulpi_unregister_interface(ci->ulpi);
90 		ci->ulpi = NULL;
91 	}
92 }
93 
ci_ulpi_resume(struct ci_hdrc * ci)94 int ci_ulpi_resume(struct ci_hdrc *ci)
95 {
96 	int cnt = 100000;
97 
98 	if (ci->platdata->phy_mode != USBPHY_INTERFACE_MODE_ULPI)
99 		return 0;
100 
101 	while (cnt-- > 0) {
102 		if (hw_read(ci, OP_ULPI_VIEWPORT, ULPI_SYNC_STATE))
103 			return 0;
104 		udelay(1);
105 	}
106 
107 	return -ETIMEDOUT;
108 }
109