2 * mtu3_dr.c - dual role switch and host glue layer
4 * Copyright (C) 2016 MediaTek Inc.
6 * Author: Chunfeng Yun <chunfeng.yun@mediatek.com>
8 * This software is licensed under the terms of the GNU General Public
9 * License version 2, as published by the Free Software Foundation, and
10 * may be copied, distributed, and modified under those terms.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
19 #include <linux/debugfs.h>
20 #include <linux/irq.h>
21 #include <linux/kernel.h>
22 #include <linux/of_device.h>
23 #include <linux/pinctrl/consumer.h>
24 #include <linux/seq_file.h>
25 #include <linux/uaccess.h>
33 enum mtu3_vbus_id_state
{
40 static void toggle_opstate(struct ssusb_mtk
*ssusb
)
42 if (!ssusb
->otg_switch
.is_u3_drd
) {
43 mtu3_setbits(ssusb
->mac_base
, U3D_DEVICE_CONTROL
, DC_SESSION
);
44 mtu3_setbits(ssusb
->mac_base
, U3D_POWER_MANAGEMENT
, SOFT_CONN
);
48 /* only port0 supports dual-role mode */
49 static int ssusb_port0_switch(struct ssusb_mtk
*ssusb
,
50 int version
, bool tohost
)
52 void __iomem
*ibase
= ssusb
->ippc_base
;
55 dev_dbg(ssusb
->dev
, "%s (switch u%d port0 to %s)\n", __func__
,
56 version
, tohost
? "host" : "device");
58 if (version
== USB2_PORT
) {
59 /* 1. power off and disable u2 port0 */
60 value
= mtu3_readl(ibase
, SSUSB_U2_CTRL(0));
61 value
|= SSUSB_U2_PORT_PDN
| SSUSB_U2_PORT_DIS
;
62 mtu3_writel(ibase
, SSUSB_U2_CTRL(0), value
);
64 /* 2. power on, enable u2 port0 and select its mode */
65 value
= mtu3_readl(ibase
, SSUSB_U2_CTRL(0));
66 value
&= ~(SSUSB_U2_PORT_PDN
| SSUSB_U2_PORT_DIS
);
67 value
= tohost
? (value
| SSUSB_U2_PORT_HOST_SEL
) :
68 (value
& (~SSUSB_U2_PORT_HOST_SEL
));
69 mtu3_writel(ibase
, SSUSB_U2_CTRL(0), value
);
71 /* 1. power off and disable u3 port0 */
72 value
= mtu3_readl(ibase
, SSUSB_U3_CTRL(0));
73 value
|= SSUSB_U3_PORT_PDN
| SSUSB_U3_PORT_DIS
;
74 mtu3_writel(ibase
, SSUSB_U3_CTRL(0), value
);
76 /* 2. power on, enable u3 port0 and select its mode */
77 value
= mtu3_readl(ibase
, SSUSB_U3_CTRL(0));
78 value
&= ~(SSUSB_U3_PORT_PDN
| SSUSB_U3_PORT_DIS
);
79 value
= tohost
? (value
| SSUSB_U3_PORT_HOST_SEL
) :
80 (value
& (~SSUSB_U3_PORT_HOST_SEL
));
81 mtu3_writel(ibase
, SSUSB_U3_CTRL(0), value
);
87 static void switch_port_to_host(struct ssusb_mtk
*ssusb
)
91 dev_dbg(ssusb
->dev
, "%s\n", __func__
);
93 ssusb_port0_switch(ssusb
, USB2_PORT
, true);
95 if (ssusb
->otg_switch
.is_u3_drd
) {
96 ssusb_port0_switch(ssusb
, USB3_PORT
, true);
97 check_clk
= SSUSB_U3_MAC_RST_B_STS
;
100 ssusb_check_clocks(ssusb
, check_clk
);
102 /* after all clocks are stable */
103 toggle_opstate(ssusb
);
106 static void switch_port_to_device(struct ssusb_mtk
*ssusb
)
110 dev_dbg(ssusb
->dev
, "%s\n", __func__
);
112 ssusb_port0_switch(ssusb
, USB2_PORT
, false);
114 if (ssusb
->otg_switch
.is_u3_drd
) {
115 ssusb_port0_switch(ssusb
, USB3_PORT
, false);
116 check_clk
= SSUSB_U3_MAC_RST_B_STS
;
119 ssusb_check_clocks(ssusb
, check_clk
);
122 int ssusb_set_vbus(struct otg_switch_mtk
*otg_sx
, int is_on
)
124 struct ssusb_mtk
*ssusb
=
125 container_of(otg_sx
, struct ssusb_mtk
, otg_switch
);
126 struct regulator
*vbus
= otg_sx
->vbus
;
129 /* vbus is optional */
133 dev_dbg(ssusb
->dev
, "%s: turn %s\n", __func__
, is_on
? "on" : "off");
136 ret
= regulator_enable(vbus
);
138 dev_err(ssusb
->dev
, "vbus regulator enable failed\n");
142 regulator_disable(vbus
);
149 * switch to host: -> MTU3_VBUS_OFF --> MTU3_ID_GROUND
150 * switch to device: -> MTU3_ID_FLOAT --> MTU3_VBUS_VALID
152 static void ssusb_set_mailbox(struct otg_switch_mtk
*otg_sx
,
153 enum mtu3_vbus_id_state status
)
155 struct ssusb_mtk
*ssusb
=
156 container_of(otg_sx
, struct ssusb_mtk
, otg_switch
);
157 struct mtu3
*mtu
= ssusb
->u3d
;
159 dev_dbg(ssusb
->dev
, "mailbox state(%d)\n", status
);
163 switch_port_to_host(ssusb
);
164 ssusb_set_vbus(otg_sx
, 1);
165 ssusb
->is_host
= true;
168 ssusb
->is_host
= false;
169 ssusb_set_vbus(otg_sx
, 0);
170 switch_port_to_device(ssusb
);
174 pm_relax(ssusb
->dev
);
176 case MTU3_VBUS_VALID
:
177 /* avoid suspend when works as device */
178 pm_stay_awake(ssusb
->dev
);
182 dev_err(ssusb
->dev
, "invalid state\n");
186 static int ssusb_id_notifier(struct notifier_block
*nb
,
187 unsigned long event
, void *ptr
)
189 struct otg_switch_mtk
*otg_sx
=
190 container_of(nb
, struct otg_switch_mtk
, id_nb
);
193 ssusb_set_mailbox(otg_sx
, MTU3_ID_GROUND
);
195 ssusb_set_mailbox(otg_sx
, MTU3_ID_FLOAT
);
200 static int ssusb_vbus_notifier(struct notifier_block
*nb
,
201 unsigned long event
, void *ptr
)
203 struct otg_switch_mtk
*otg_sx
=
204 container_of(nb
, struct otg_switch_mtk
, vbus_nb
);
207 ssusb_set_mailbox(otg_sx
, MTU3_VBUS_VALID
);
209 ssusb_set_mailbox(otg_sx
, MTU3_VBUS_OFF
);
214 static int ssusb_extcon_register(struct otg_switch_mtk
*otg_sx
)
216 struct ssusb_mtk
*ssusb
=
217 container_of(otg_sx
, struct ssusb_mtk
, otg_switch
);
218 struct extcon_dev
*edev
= otg_sx
->edev
;
221 /* extcon is optional */
225 otg_sx
->vbus_nb
.notifier_call
= ssusb_vbus_notifier
;
226 ret
= devm_extcon_register_notifier(ssusb
->dev
, edev
, EXTCON_USB
,
229 dev_err(ssusb
->dev
, "failed to register notifier for USB\n");
231 otg_sx
->id_nb
.notifier_call
= ssusb_id_notifier
;
232 ret
= devm_extcon_register_notifier(ssusb
->dev
, edev
, EXTCON_USB_HOST
,
235 dev_err(ssusb
->dev
, "failed to register notifier for USB-HOST\n");
237 dev_dbg(ssusb
->dev
, "EXTCON_USB: %d, EXTCON_USB_HOST: %d\n",
238 extcon_get_state(edev
, EXTCON_USB
),
239 extcon_get_state(edev
, EXTCON_USB_HOST
));
241 /* default as host, switch to device mode if needed */
242 if (extcon_get_state(edev
, EXTCON_USB_HOST
) == false)
243 ssusb_set_mailbox(otg_sx
, MTU3_ID_FLOAT
);
244 if (extcon_get_state(edev
, EXTCON_USB
) == true)
245 ssusb_set_mailbox(otg_sx
, MTU3_VBUS_VALID
);
250 static void extcon_register_dwork(struct work_struct
*work
)
252 struct delayed_work
*dwork
= to_delayed_work(work
);
253 struct otg_switch_mtk
*otg_sx
=
254 container_of(dwork
, struct otg_switch_mtk
, extcon_reg_dwork
);
256 ssusb_extcon_register(otg_sx
);
260 * We provide an interface via debugfs to switch between host and device modes
261 * depending on user input.
262 * This is useful in special cases, such as uses TYPE-A receptacle but also
263 * wants to support dual-role mode.
264 * It generates cable state changes by pulling up/down IDPIN and
265 * notifies driver to switch mode by "extcon-usb-gpio".
266 * NOTE: when use MICRO receptacle, should not enable this interface.
268 static void ssusb_mode_manual_switch(struct ssusb_mtk
*ssusb
, int to_host
)
270 struct otg_switch_mtk
*otg_sx
= &ssusb
->otg_switch
;
273 pinctrl_select_state(otg_sx
->id_pinctrl
, otg_sx
->id_ground
);
275 pinctrl_select_state(otg_sx
->id_pinctrl
, otg_sx
->id_float
);
279 static int ssusb_mode_show(struct seq_file
*sf
, void *unused
)
281 struct ssusb_mtk
*ssusb
= sf
->private;
283 seq_printf(sf
, "current mode: %s(%s drd)\n(echo device/host)\n",
284 ssusb
->is_host
? "host" : "device",
285 ssusb
->otg_switch
.manual_drd_enabled
? "manual" : "auto");
290 static int ssusb_mode_open(struct inode
*inode
, struct file
*file
)
292 return single_open(file
, ssusb_mode_show
, inode
->i_private
);
295 static ssize_t
ssusb_mode_write(struct file
*file
,
296 const char __user
*ubuf
, size_t count
, loff_t
*ppos
)
298 struct seq_file
*sf
= file
->private_data
;
299 struct ssusb_mtk
*ssusb
= sf
->private;
302 if (copy_from_user(&buf
, ubuf
, min_t(size_t, sizeof(buf
) - 1, count
)))
305 if (!strncmp(buf
, "host", 4) && !ssusb
->is_host
) {
306 ssusb_mode_manual_switch(ssusb
, 1);
307 } else if (!strncmp(buf
, "device", 6) && ssusb
->is_host
) {
308 ssusb_mode_manual_switch(ssusb
, 0);
310 dev_err(ssusb
->dev
, "wrong or duplicated setting\n");
317 static const struct file_operations ssusb_mode_fops
= {
318 .open
= ssusb_mode_open
,
319 .write
= ssusb_mode_write
,
322 .release
= single_release
,
325 static void ssusb_debugfs_init(struct ssusb_mtk
*ssusb
)
330 root
= debugfs_create_dir(dev_name(ssusb
->dev
), usb_debug_root
);
331 if (IS_ERR_OR_NULL(root
)) {
333 dev_err(ssusb
->dev
, "create debugfs root failed\n");
336 ssusb
->dbgfs_root
= root
;
338 file
= debugfs_create_file("mode", S_IRUGO
| S_IWUSR
, root
,
339 ssusb
, &ssusb_mode_fops
);
341 dev_dbg(ssusb
->dev
, "create debugfs mode failed\n");
344 static void ssusb_debugfs_exit(struct ssusb_mtk
*ssusb
)
346 debugfs_remove_recursive(ssusb
->dbgfs_root
);
349 int ssusb_otg_switch_init(struct ssusb_mtk
*ssusb
)
351 struct otg_switch_mtk
*otg_sx
= &ssusb
->otg_switch
;
353 INIT_DELAYED_WORK(&otg_sx
->extcon_reg_dwork
, extcon_register_dwork
);
355 if (otg_sx
->manual_drd_enabled
)
356 ssusb_debugfs_init(ssusb
);
358 /* It is enough to delay 1s for waiting for host initialization */
359 schedule_delayed_work(&otg_sx
->extcon_reg_dwork
, HZ
);
364 void ssusb_otg_switch_exit(struct ssusb_mtk
*ssusb
)
366 struct otg_switch_mtk
*otg_sx
= &ssusb
->otg_switch
;
368 cancel_delayed_work(&otg_sx
->extcon_reg_dwork
);
370 if (otg_sx
->manual_drd_enabled
)
371 ssusb_debugfs_exit(ssusb
);