drivers/usb/host/ehci-atmel.c: use devm_ functions
[linux-2.6/btrfs-unstable.git] / drivers / usb / host / ehci-atmel.c
blob411bb74152ebe2ba3b063fb0e5e3445626d61af1
1 /*
2 * Driver for EHCI UHP on Atmel chips
4 * Copyright (C) 2009 Atmel Corporation,
5 * Nicolas Ferre <nicolas.ferre@atmel.com>
7 * Based on various ehci-*.c drivers
9 * This file is subject to the terms and conditions of the GNU General Public
10 * License. See the file COPYING in the main directory of this archive for
11 * more details.
14 #include <linux/clk.h>
15 #include <linux/platform_device.h>
16 #include <linux/of.h>
17 #include <linux/of_platform.h>
19 /* interface and function clocks */
20 static struct clk *iclk, *fclk;
21 static int clocked;
23 /*-------------------------------------------------------------------------*/
25 static void atmel_start_clock(void)
27 clk_enable(iclk);
28 clk_enable(fclk);
29 clocked = 1;
32 static void atmel_stop_clock(void)
34 clk_disable(fclk);
35 clk_disable(iclk);
36 clocked = 0;
39 static void atmel_start_ehci(struct platform_device *pdev)
41 dev_dbg(&pdev->dev, "start\n");
42 atmel_start_clock();
45 static void atmel_stop_ehci(struct platform_device *pdev)
47 dev_dbg(&pdev->dev, "stop\n");
48 atmel_stop_clock();
51 /*-------------------------------------------------------------------------*/
53 static int ehci_atmel_setup(struct usb_hcd *hcd)
55 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
56 int retval;
58 /* registers start at offset 0x0 */
59 ehci->caps = hcd->regs;
61 retval = ehci_setup(hcd);
62 if (retval)
63 return retval;
65 ehci_port_power(ehci, 0);
67 return retval;
70 static const struct hc_driver ehci_atmel_hc_driver = {
71 .description = hcd_name,
72 .product_desc = "Atmel EHCI UHP HS",
73 .hcd_priv_size = sizeof(struct ehci_hcd),
75 /* generic hardware linkage */
76 .irq = ehci_irq,
77 .flags = HCD_MEMORY | HCD_USB2,
79 /* basic lifecycle operations */
80 .reset = ehci_atmel_setup,
81 .start = ehci_run,
82 .stop = ehci_stop,
83 .shutdown = ehci_shutdown,
85 /* managing i/o requests and associated device resources */
86 .urb_enqueue = ehci_urb_enqueue,
87 .urb_dequeue = ehci_urb_dequeue,
88 .endpoint_disable = ehci_endpoint_disable,
89 .endpoint_reset = ehci_endpoint_reset,
91 /* scheduling support */
92 .get_frame_number = ehci_get_frame,
94 /* root hub support */
95 .hub_status_data = ehci_hub_status_data,
96 .hub_control = ehci_hub_control,
97 .bus_suspend = ehci_bus_suspend,
98 .bus_resume = ehci_bus_resume,
99 .relinquish_port = ehci_relinquish_port,
100 .port_handed_over = ehci_port_handed_over,
102 .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
105 static u64 at91_ehci_dma_mask = DMA_BIT_MASK(32);
107 static int __devinit ehci_atmel_drv_probe(struct platform_device *pdev)
109 struct usb_hcd *hcd;
110 const struct hc_driver *driver = &ehci_atmel_hc_driver;
111 struct resource *res;
112 int irq;
113 int retval;
115 if (usb_disabled())
116 return -ENODEV;
118 pr_debug("Initializing Atmel-SoC USB Host Controller\n");
120 irq = platform_get_irq(pdev, 0);
121 if (irq <= 0) {
122 dev_err(&pdev->dev,
123 "Found HC with no IRQ. Check %s setup!\n",
124 dev_name(&pdev->dev));
125 retval = -ENODEV;
126 goto fail_create_hcd;
129 /* Right now device-tree probed devices don't get dma_mask set.
130 * Since shared usb code relies on it, set it here for now.
131 * Once we have dma capability bindings this can go away.
133 if (!pdev->dev.dma_mask)
134 pdev->dev.dma_mask = &at91_ehci_dma_mask;
136 hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
137 if (!hcd) {
138 retval = -ENOMEM;
139 goto fail_create_hcd;
142 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
143 if (!res) {
144 dev_err(&pdev->dev,
145 "Found HC with no register addr. Check %s setup!\n",
146 dev_name(&pdev->dev));
147 retval = -ENODEV;
148 goto fail_request_resource;
150 hcd->rsrc_start = res->start;
151 hcd->rsrc_len = resource_size(res);
153 hcd->regs = devm_request_and_ioremap(&pdev->dev, res);
154 if (hcd->regs == NULL) {
155 dev_dbg(&pdev->dev, "error mapping memory\n");
156 retval = -EFAULT;
157 goto fail_request_resource;
160 iclk = devm_clk_get(&pdev->dev, "ehci_clk");
161 if (IS_ERR(iclk)) {
162 dev_err(&pdev->dev, "Error getting interface clock\n");
163 retval = -ENOENT;
164 goto fail_request_resource;
166 fclk = devm_clk_get(&pdev->dev, "uhpck");
167 if (IS_ERR(fclk)) {
168 dev_err(&pdev->dev, "Error getting function clock\n");
169 retval = -ENOENT;
170 goto fail_request_resource;
173 atmel_start_ehci(pdev);
175 retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
176 if (retval)
177 goto fail_add_hcd;
179 return retval;
181 fail_add_hcd:
182 atmel_stop_ehci(pdev);
183 fail_request_resource:
184 usb_put_hcd(hcd);
185 fail_create_hcd:
186 dev_err(&pdev->dev, "init %s fail, %d\n",
187 dev_name(&pdev->dev), retval);
189 return retval;
192 static int __devexit ehci_atmel_drv_remove(struct platform_device *pdev)
194 struct usb_hcd *hcd = platform_get_drvdata(pdev);
196 ehci_shutdown(hcd);
197 usb_remove_hcd(hcd);
198 usb_put_hcd(hcd);
200 atmel_stop_ehci(pdev);
201 fclk = iclk = NULL;
203 return 0;
206 #ifdef CONFIG_OF
207 static const struct of_device_id atmel_ehci_dt_ids[] = {
208 { .compatible = "atmel,at91sam9g45-ehci" },
209 { /* sentinel */ }
212 MODULE_DEVICE_TABLE(of, atmel_ehci_dt_ids);
213 #endif
215 static struct platform_driver ehci_atmel_driver = {
216 .probe = ehci_atmel_drv_probe,
217 .remove = __devexit_p(ehci_atmel_drv_remove),
218 .shutdown = usb_hcd_platform_shutdown,
219 .driver = {
220 .name = "atmel-ehci",
221 .of_match_table = of_match_ptr(atmel_ehci_dt_ids),