hc
2023-10-25 6c2073b7aa40e29d0eca7d571dd7bc590c7ecaa7
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2009
 * Guennadi Liakhovetski, DENX Software Engineering, <lg@denx.de>
 *
 * Description:
 * Helper routines for i.MX3x SoCs from Freescale, needed by the fsl_usb2_udc.c
 * driver to function correctly on these systems.
 */
#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/err.h>
#include <linux/fsl_devices.h>
#include <linux/mod_devicetable.h>
#include <linux/platform_device.h>
#include <linux/io.h>
 
#include "fsl_usb2_udc.h"
 
static struct clk *mxc_ahb_clk;
static struct clk *mxc_per_clk;
static struct clk *mxc_ipg_clk;
 
/* workaround ENGcm09152 for i.MX35 */
#define MX35_USBPHYCTRL_OFFSET        0x600
#define USBPHYCTRL_OTGBASE_OFFSET    0x8
#define USBPHYCTRL_EVDO            (1 << 23)
 
int fsl_udc_clk_init(struct platform_device *pdev)
{
   struct fsl_usb2_platform_data *pdata;
   unsigned long freq;
   int ret;
 
   pdata = dev_get_platdata(&pdev->dev);
 
   mxc_ipg_clk = devm_clk_get(&pdev->dev, "ipg");
   if (IS_ERR(mxc_ipg_clk)) {
       dev_err(&pdev->dev, "clk_get(\"ipg\") failed\n");
       return PTR_ERR(mxc_ipg_clk);
   }
 
   mxc_ahb_clk = devm_clk_get(&pdev->dev, "ahb");
   if (IS_ERR(mxc_ahb_clk)) {
       dev_err(&pdev->dev, "clk_get(\"ahb\") failed\n");
       return PTR_ERR(mxc_ahb_clk);
   }
 
   mxc_per_clk = devm_clk_get(&pdev->dev, "per");
   if (IS_ERR(mxc_per_clk)) {
       dev_err(&pdev->dev, "clk_get(\"per\") failed\n");
       return PTR_ERR(mxc_per_clk);
   }
 
   clk_prepare_enable(mxc_ipg_clk);
   clk_prepare_enable(mxc_ahb_clk);
   clk_prepare_enable(mxc_per_clk);
 
   /* make sure USB_CLK is running at 60 MHz +/- 1000 Hz */
   if (!strcmp(pdev->id_entry->name, "imx-udc-mx27")) {
       freq = clk_get_rate(mxc_per_clk);
       if (pdata->phy_mode != FSL_USB2_PHY_ULPI &&
           (freq < 59999000 || freq > 60001000)) {
           dev_err(&pdev->dev, "USB_CLK=%lu, should be 60MHz\n", freq);
           ret = -EINVAL;
           goto eclkrate;
       }
   }
 
   return 0;
 
eclkrate:
   clk_disable_unprepare(mxc_ipg_clk);
   clk_disable_unprepare(mxc_ahb_clk);
   clk_disable_unprepare(mxc_per_clk);
   mxc_per_clk = NULL;
   return ret;
}
 
int fsl_udc_clk_finalize(struct platform_device *pdev)
{
   struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
   int ret = 0;
 
   /* workaround ENGcm09152 for i.MX35 */
   if (pdata->workaround & FLS_USB2_WORKAROUND_ENGCM09152) {
       unsigned int v;
       struct resource *res = platform_get_resource
           (pdev, IORESOURCE_MEM, 0);
       void __iomem *phy_regs = ioremap(res->start +
                       MX35_USBPHYCTRL_OFFSET, 512);
       if (!phy_regs) {
           dev_err(&pdev->dev, "ioremap for phy address fails\n");
           ret = -EINVAL;
           goto ioremap_err;
       }
 
       v = readl(phy_regs + USBPHYCTRL_OTGBASE_OFFSET);
       writel(v | USBPHYCTRL_EVDO,
           phy_regs + USBPHYCTRL_OTGBASE_OFFSET);
 
       iounmap(phy_regs);
   }
 
 
ioremap_err:
   /* ULPI transceivers don't need usbpll */
   if (pdata->phy_mode == FSL_USB2_PHY_ULPI) {
       clk_disable_unprepare(mxc_per_clk);
       mxc_per_clk = NULL;
   }
 
   return ret;
}
 
void fsl_udc_clk_release(void)
{
   if (mxc_per_clk)
       clk_disable_unprepare(mxc_per_clk);
   clk_disable_unprepare(mxc_ahb_clk);
   clk_disable_unprepare(mxc_ipg_clk);
}