Commit | Line | Data |
---|---|---|
99f6e1f5 JS |
1 | /* |
2 | * Copyright (C) 2011 Samsung Electronics Co.Ltd | |
3 | * Author: Joonyoung Shim <jy0922.shim@samsung.com> | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms of the GNU General Public License as published by the | |
7 | * Free Software Foundation; either version 2 of the License, or (at your | |
8 | * option) any later version. | |
9 | * | |
10 | */ | |
11 | ||
12 | #include <linux/clk.h> | |
13 | #include <linux/delay.h> | |
14 | #include <linux/err.h> | |
15 | #include <linux/io.h> | |
16 | #include <linux/platform_device.h> | |
17 | #include <mach/map.h> | |
18 | #include <mach/regs-sys.h> | |
19 | #include <plat/cpu.h> | |
20 | #include <plat/regs-usb-hsotg-phy.h> | |
21 | #include <plat/usb-phy.h> | |
22 | ||
23 | static int s3c_usb_otgphy_init(struct platform_device *pdev) | |
24 | { | |
25 | struct clk *xusbxti; | |
26 | u32 phyclk; | |
27 | ||
28 | writel(readl(S3C64XX_OTHERS) | S3C64XX_OTHERS_USBMASK, S3C64XX_OTHERS); | |
29 | ||
30 | /* set clock frequency for PLL */ | |
31 | phyclk = readl(S3C_PHYCLK) & ~S3C_PHYCLK_CLKSEL_MASK; | |
32 | ||
33 | xusbxti = clk_get(&pdev->dev, "xusbxti"); | |
34 | if (xusbxti && !IS_ERR(xusbxti)) { | |
35 | switch (clk_get_rate(xusbxti)) { | |
36 | case 12 * MHZ: | |
37 | phyclk |= S3C_PHYCLK_CLKSEL_12M; | |
38 | break; | |
39 | case 24 * MHZ: | |
40 | phyclk |= S3C_PHYCLK_CLKSEL_24M; | |
41 | break; | |
42 | default: | |
43 | case 48 * MHZ: | |
44 | /* default reference clock */ | |
45 | break; | |
46 | } | |
47 | clk_put(xusbxti); | |
48 | } | |
49 | ||
50 | /* TODO: select external clock/oscillator */ | |
51 | writel(phyclk | S3C_PHYCLK_CLK_FORCE, S3C_PHYCLK); | |
52 | ||
53 | /* set to normal OTG PHY */ | |
54 | writel((readl(S3C_PHYPWR) & ~S3C_PHYPWR_NORMAL_MASK), S3C_PHYPWR); | |
55 | mdelay(1); | |
56 | ||
57 | /* reset OTG PHY and Link */ | |
58 | writel(S3C_RSTCON_PHY | S3C_RSTCON_HCLK | S3C_RSTCON_PHYCLK, | |
59 | S3C_RSTCON); | |
60 | udelay(20); /* at-least 10uS */ | |
61 | writel(0, S3C_RSTCON); | |
62 | ||
63 | return 0; | |
64 | } | |
65 | ||
66 | static int s3c_usb_otgphy_exit(struct platform_device *pdev) | |
67 | { | |
68 | writel((readl(S3C_PHYPWR) | S3C_PHYPWR_ANALOG_POWERDOWN | | |
69 | S3C_PHYPWR_OTG_DISABLE), S3C_PHYPWR); | |
70 | ||
71 | writel(readl(S3C64XX_OTHERS) & ~S3C64XX_OTHERS_USBMASK, S3C64XX_OTHERS); | |
72 | ||
73 | return 0; | |
74 | } | |
75 | ||
76 | int s5p_usb_phy_init(struct platform_device *pdev, int type) | |
77 | { | |
78 | if (type == S5P_USB_PHY_DEVICE) | |
79 | return s3c_usb_otgphy_init(pdev); | |
80 | ||
81 | return -EINVAL; | |
82 | } | |
83 | ||
84 | int s5p_usb_phy_exit(struct platform_device *pdev, int type) | |
85 | { | |
86 | if (type == S5P_USB_PHY_DEVICE) | |
87 | return s3c_usb_otgphy_exit(pdev); | |
88 | ||
89 | return -EINVAL; | |
90 | } |