diff options
Diffstat (limited to 'arch/arm/mach-s3c64xx/include/mach/pll.h')
-rw-r--r-- | arch/arm/mach-s3c64xx/include/mach/pll.h | 35 |
1 files changed, 3 insertions, 32 deletions
diff --git a/arch/arm/mach-s3c64xx/include/mach/pll.h b/arch/arm/mach-s3c64xx/include/mach/pll.h index 90bbd72fdc4e..5ef0bb698ee0 100644 --- a/arch/arm/mach-s3c64xx/include/mach/pll.h +++ b/arch/arm/mach-s3c64xx/include/mach/pll.h | |||
@@ -20,6 +20,7 @@ | |||
20 | #define S3C6400_PLL_SDIV_SHIFT (0) | 20 | #define S3C6400_PLL_SDIV_SHIFT (0) |
21 | 21 | ||
22 | #include <asm/div64.h> | 22 | #include <asm/div64.h> |
23 | #include <plat/pll6553x.h> | ||
23 | 24 | ||
24 | static inline unsigned long s3c6400_get_pll(unsigned long baseclk, | 25 | static inline unsigned long s3c6400_get_pll(unsigned long baseclk, |
25 | u32 pllcon) | 26 | u32 pllcon) |
@@ -37,38 +38,8 @@ static inline unsigned long s3c6400_get_pll(unsigned long baseclk, | |||
37 | return (unsigned long)fvco; | 38 | return (unsigned long)fvco; |
38 | } | 39 | } |
39 | 40 | ||
40 | #define S3C6400_EPLL_MDIV_MASK ((1 << (23-16)) - 1) | ||
41 | #define S3C6400_EPLL_PDIV_MASK ((1 << (13-8)) - 1) | ||
42 | #define S3C6400_EPLL_SDIV_MASK ((1 << (2-0)) - 1) | ||
43 | #define S3C6400_EPLL_MDIV_SHIFT (16) | ||
44 | #define S3C6400_EPLL_PDIV_SHIFT (8) | ||
45 | #define S3C6400_EPLL_SDIV_SHIFT (0) | ||
46 | #define S3C6400_EPLL_KDIV_MASK (0xffff) | ||
47 | |||
48 | static inline unsigned long s3c6400_get_epll(unsigned long baseclk) | 41 | static inline unsigned long s3c6400_get_epll(unsigned long baseclk) |
49 | { | 42 | { |
50 | unsigned long result; | 43 | return s3c_get_pll6553x(baseclk, __raw_readl(S3C_EPLL_CON0), |
51 | u32 epll0 = __raw_readl(S3C_EPLL_CON0); | 44 | __raw_readl(S3C_EPLL_CON1)); |
52 | u32 epll1 = __raw_readl(S3C_EPLL_CON1); | ||
53 | u32 mdiv, pdiv, sdiv, kdiv; | ||
54 | u64 tmp; | ||
55 | |||
56 | mdiv = (epll0 >> S3C6400_EPLL_MDIV_SHIFT) & S3C6400_EPLL_MDIV_MASK; | ||
57 | pdiv = (epll0 >> S3C6400_EPLL_PDIV_SHIFT) & S3C6400_EPLL_PDIV_MASK; | ||
58 | sdiv = (epll0 >> S3C6400_EPLL_SDIV_SHIFT) & S3C6400_EPLL_SDIV_MASK; | ||
59 | kdiv = epll1 & S3C6400_EPLL_KDIV_MASK; | ||
60 | |||
61 | /* We need to multiple baseclk by mdiv (the integer part) and kdiv | ||
62 | * which is in 2^16ths, so shift mdiv up (does not overflow) and | ||
63 | * add kdiv before multiplying. The use of tmp is to avoid any | ||
64 | * overflows before shifting bac down into result when multipling | ||
65 | * by the mdiv and kdiv pair. | ||
66 | */ | ||
67 | |||
68 | tmp = baseclk; | ||
69 | tmp *= (mdiv << 16) + kdiv; | ||
70 | do_div(tmp, (pdiv << sdiv)); | ||
71 | result = tmp >> 16; | ||
72 | |||
73 | return result; | ||
74 | } | 45 | } |