xref: /openbmc/u-boot/drivers/usb/host/ohci-generic.c (revision 4de512018ba7d57f1672be21c7459281f7c97514)
1 /*
2  * Copyright (C) 2015 Alexey Brodkin <abrodkin@synopsys.com>
3  *
4  * SPDX-License-Identifier:	GPL-2.0+
5  */
6 
7 #include <common.h>
8 #include <clk.h>
9 #include <dm.h>
10 #include <dm/ofnode.h>
11 #include <generic-phy.h>
12 #include <reset.h>
13 #include "ohci.h"
14 
15 #if !defined(CONFIG_USB_OHCI_NEW)
16 # error "Generic OHCI driver requires CONFIG_USB_OHCI_NEW"
17 #endif
18 
19 struct generic_ohci {
20 	ohci_t ohci;
21 	struct clk *clocks;	/* clock list */
22 	struct reset_ctl *resets; /* reset list */
23 	struct phy phy;
24 	int clock_count;	/* number of clock in clock list */
25 	int reset_count;	/* number of reset in reset list */
26 };
27 
28 static int ohci_usb_probe(struct udevice *dev)
29 {
30 	struct ohci_regs *regs = (struct ohci_regs *)devfdt_get_addr(dev);
31 	struct generic_ohci *priv = dev_get_priv(dev);
32 	int i, err, ret, clock_nb, reset_nb;
33 
34 	err = 0;
35 	priv->clock_count = 0;
36 	clock_nb = dev_count_phandle_with_args(dev, "clocks", "#clock-cells");
37 	if (clock_nb > 0) {
38 		priv->clocks = devm_kcalloc(dev, clock_nb, sizeof(struct clk),
39 					    GFP_KERNEL);
40 		if (!priv->clocks)
41 			return -ENOMEM;
42 
43 		for (i = 0; i < clock_nb; i++) {
44 			err = clk_get_by_index(dev, i, &priv->clocks[i]);
45 			if (err < 0)
46 				break;
47 
48 			err = clk_enable(&priv->clocks[i]);
49 			if (err) {
50 				error("failed to enable clock %d\n", i);
51 				clk_free(&priv->clocks[i]);
52 				goto clk_err;
53 			}
54 			priv->clock_count++;
55 		}
56 	} else if (clock_nb != -ENOENT) {
57 		error("failed to get clock phandle(%d)\n", clock_nb);
58 		return clock_nb;
59 	}
60 
61 	priv->reset_count = 0;
62 	reset_nb = dev_count_phandle_with_args(dev, "resets", "#reset-cells");
63 	if (reset_nb > 0) {
64 		priv->resets = devm_kcalloc(dev, reset_nb,
65 					    sizeof(struct reset_ctl),
66 					    GFP_KERNEL);
67 		if (!priv->resets)
68 			return -ENOMEM;
69 
70 		for (i = 0; i < reset_nb; i++) {
71 			err = reset_get_by_index(dev, i, &priv->resets[i]);
72 			if (err < 0)
73 				break;
74 
75 			err = reset_deassert(&priv->resets[i]);
76 			if (err) {
77 				error("failed to deassert reset %d\n", i);
78 				reset_free(&priv->resets[i]);
79 				goto reset_err;
80 			}
81 			priv->reset_count++;
82 		}
83 	} else if (reset_nb != -ENOENT) {
84 		error("failed to get reset phandle(%d)\n", reset_nb);
85 		goto clk_err;
86 	}
87 
88 	err = generic_phy_get_by_index(dev, 0, &priv->phy);
89 	if (err) {
90 		if (err != -ENOENT) {
91 			error("failed to get usb phy\n");
92 			goto reset_err;
93 		}
94 	}
95 
96 	err = generic_phy_init(&priv->phy);
97 	if (err) {
98 		error("failed to init usb phy\n");
99 		goto reset_err;
100 	}
101 
102 	err = ohci_register(dev, regs);
103 	if (err)
104 		goto phy_err;
105 
106 	return 0;
107 
108 phy_err:
109 	if (generic_phy_valid(&priv->phy)) {
110 		ret = generic_phy_exit(&priv->phy);
111 		if (ret)
112 			error("failed to release phy\n");
113 	}
114 
115 reset_err:
116 	ret = reset_release_all(priv->resets, priv->reset_count);
117 	if (ret)
118 		error("failed to assert all resets\n");
119 clk_err:
120 	ret = clk_release_all(priv->clocks, priv->clock_count);
121 	if (ret)
122 		error("failed to disable all clocks\n");
123 
124 	return err;
125 }
126 
127 static int ohci_usb_remove(struct udevice *dev)
128 {
129 	struct generic_ohci *priv = dev_get_priv(dev);
130 	int ret;
131 
132 	ret = ohci_deregister(dev);
133 	if (ret)
134 		return ret;
135 
136 	if (generic_phy_valid(&priv->phy)) {
137 		ret = generic_phy_exit(&priv->phy);
138 		if (ret)
139 			return ret;
140 	}
141 
142 	ret = reset_release_all(priv->resets, priv->reset_count);
143 	if (ret)
144 		return ret;
145 
146 	return clk_release_all(priv->clocks, priv->clock_count);
147 }
148 
149 static const struct udevice_id ohci_usb_ids[] = {
150 	{ .compatible = "generic-ohci" },
151 	{ }
152 };
153 
154 U_BOOT_DRIVER(ohci_generic) = {
155 	.name	= "ohci_generic",
156 	.id	= UCLASS_USB,
157 	.of_match = ohci_usb_ids,
158 	.probe = ohci_usb_probe,
159 	.remove = ohci_usb_remove,
160 	.ops	= &ohci_usb_ops,
161 	.priv_auto_alloc_size = sizeof(struct generic_ohci),
162 	.flags	= DM_FLAG_ALLOC_PRIV_DMA,
163 };
164