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 | |
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, reg: OP_ULPI_VIEWPORT, mask)) |
25 | return 0; |
26 | |
27 | udelay(1); |
28 | } |
29 | |
30 | return -ETIMEDOUT; |
31 | } |
32 | |
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, reg: OP_ULPI_VIEWPORT, mask: 0xffffffff, ULPI_WRITE | ULPI_WAKEUP); |
39 | ret = ci_ulpi_wait(ci, ULPI_WAKEUP); |
40 | if (ret) |
41 | return ret; |
42 | |
43 | hw_write(ci, reg: OP_ULPI_VIEWPORT, mask: 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, reg: OP_ULPI_VIEWPORT, GENMASK(15, 8)) >> 8; |
49 | } |
50 | |
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, reg: OP_ULPI_VIEWPORT, mask: 0xffffffff, ULPI_WRITE | ULPI_WAKEUP); |
57 | ret = ci_ulpi_wait(ci, ULPI_WAKEUP); |
58 | if (ret) |
59 | return ret; |
60 | |
61 | hw_write(ci, reg: OP_ULPI_VIEWPORT, mask: 0xffffffff, |
62 | ULPI_RUN | ULPI_WRITE | ULPI_ADDR(addr) | val); |
63 | return ci_ulpi_wait(ci, ULPI_RUN); |
64 | } |
65 | |
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(ptr: ci->ulpi)) |
81 | dev_err(ci->dev, "failed to register ULPI interface" ); |
82 | |
83 | return PTR_ERR_OR_ZERO(ptr: ci->ulpi); |
84 | } |
85 | |
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 | |
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, reg: OP_ULPI_VIEWPORT, ULPI_SYNC_STATE)) |
103 | return 0; |
104 | udelay(1); |
105 | } |
106 | |
107 | return -ETIMEDOUT; |
108 | } |
109 | |