[S390] Remove error checking from copy_oldmem_page()
[linux/fpc-iii.git] / drivers / usb / gadget / fsl_mxc_udc.c
blob43a49ecc1f36ed1009eb836350bd07800a4d8c09
1 /*
2 * Copyright (C) 2009
3 * Guennadi Liakhovetski, DENX Software Engineering, <lg@denx.de>
5 * Description:
6 * Helper routines for i.MX3x SoCs from Freescale, needed by the fsl_usb2_udc.c
7 * driver to function correctly on these systems.
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
14 #include <linux/clk.h>
15 #include <linux/delay.h>
16 #include <linux/err.h>
17 #include <linux/fsl_devices.h>
18 #include <linux/platform_device.h>
20 #include <mach/hardware.h>
22 static struct clk *mxc_ahb_clk;
23 static struct clk *mxc_usb_clk;
25 /* workaround ENGcm09152 for i.MX35 */
26 #define USBPHYCTRL_OTGBASE_OFFSET 0x608
27 #define USBPHYCTRL_EVDO (1 << 23)
29 int fsl_udc_clk_init(struct platform_device *pdev)
31 struct fsl_usb2_platform_data *pdata;
32 unsigned long freq;
33 int ret;
35 pdata = pdev->dev.platform_data;
37 if (!cpu_is_mx35() && !cpu_is_mx25()) {
38 mxc_ahb_clk = clk_get(&pdev->dev, "usb_ahb");
39 if (IS_ERR(mxc_ahb_clk))
40 return PTR_ERR(mxc_ahb_clk);
42 ret = clk_enable(mxc_ahb_clk);
43 if (ret < 0) {
44 dev_err(&pdev->dev, "clk_enable(\"usb_ahb\") failed\n");
45 goto eenahb;
49 /* make sure USB_CLK is running at 60 MHz +/- 1000 Hz */
50 mxc_usb_clk = clk_get(&pdev->dev, "usb");
51 if (IS_ERR(mxc_usb_clk)) {
52 dev_err(&pdev->dev, "clk_get(\"usb\") failed\n");
53 ret = PTR_ERR(mxc_usb_clk);
54 goto egusb;
57 if (!cpu_is_mx51()) {
58 freq = clk_get_rate(mxc_usb_clk);
59 if (pdata->phy_mode != FSL_USB2_PHY_ULPI &&
60 (freq < 59999000 || freq > 60001000)) {
61 dev_err(&pdev->dev, "USB_CLK=%lu, should be 60MHz\n", freq);
62 ret = -EINVAL;
63 goto eclkrate;
67 ret = clk_enable(mxc_usb_clk);
68 if (ret < 0) {
69 dev_err(&pdev->dev, "clk_enable(\"usb_clk\") failed\n");
70 goto eenusb;
73 return 0;
75 eenusb:
76 eclkrate:
77 clk_put(mxc_usb_clk);
78 mxc_usb_clk = NULL;
79 egusb:
80 if (!cpu_is_mx35())
81 clk_disable(mxc_ahb_clk);
82 eenahb:
83 if (!cpu_is_mx35())
84 clk_put(mxc_ahb_clk);
85 return ret;
88 void fsl_udc_clk_finalize(struct platform_device *pdev)
90 struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data;
91 #if defined(CONFIG_SOC_IMX35)
92 if (cpu_is_mx35()) {
93 unsigned int v;
95 /* workaround ENGcm09152 for i.MX35 */
96 if (pdata->workaround & FLS_USB2_WORKAROUND_ENGCM09152) {
97 v = readl(MX35_IO_ADDRESS(MX35_USB_BASE_ADDR +
98 USBPHYCTRL_OTGBASE_OFFSET));
99 writel(v | USBPHYCTRL_EVDO,
100 MX35_IO_ADDRESS(MX35_USB_BASE_ADDR +
101 USBPHYCTRL_OTGBASE_OFFSET));
104 #endif
106 /* ULPI transceivers don't need usbpll */
107 if (pdata->phy_mode == FSL_USB2_PHY_ULPI) {
108 clk_disable(mxc_usb_clk);
109 clk_put(mxc_usb_clk);
110 mxc_usb_clk = NULL;
114 void fsl_udc_clk_release(void)
116 if (mxc_usb_clk) {
117 clk_disable(mxc_usb_clk);
118 clk_put(mxc_usb_clk);
120 if (!cpu_is_mx35()) {
121 clk_disable(mxc_ahb_clk);
122 clk_put(mxc_ahb_clk);