hc
2023-05-26 a23f51ed7a39e452c1037343a84d7db1ca2c5bd7
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
/*
 * Cirrus Logic EP93xx PLL support.
 *
 * Copyright (C) 2009 Matthias Kaehlcke <matthias@kaehlcke.net>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <asm/arch/ep93xx.h>
#include <asm/io.h>
#include <div64.h>
 
/*
 * CONFIG_SYS_CLK_FREQ should be defined as the input frequency of the PLL.
 *
 * get_FCLK(), get_HCLK(), get_PCLK() and get_UCLK() return the clock of
 * the specified bus in HZ.
 */
 
/*
 * return the PLL output frequency
 *
 * PLL rate = CONFIG_SYS_CLK_FREQ * (X1FBD + 1) * (X2FBD + 1)
 * / (X2IPD + 1) / 2^PS
 */
static ulong get_PLLCLK(uint32_t *pllreg)
{
   uint8_t i;
   const uint32_t clkset = readl(pllreg);
   uint64_t rate = CONFIG_SYS_CLK_FREQ;
   rate *= ((clkset >> SYSCON_CLKSET_PLL_X1FBD1_SHIFT) & 0x1f) + 1;
   rate *= ((clkset >> SYSCON_CLKSET_PLL_X2FBD2_SHIFT) & 0x3f) + 1;
   do_div(rate, (clkset  & 0x1f) + 1);            /* X2IPD */
   for (i = 0; i < ((clkset >> SYSCON_CLKSET_PLL_PS_SHIFT) & 3); i++)
       rate >>= 1;
 
   return (ulong)rate;
}
 
/* return FCLK frequency */
ulong get_FCLK(void)
{
   const uint8_t fclk_divisors[] = { 1, 2, 4, 8, 16, 1, 1, 1 };
   struct syscon_regs *syscon = (struct syscon_regs *)SYSCON_BASE;
 
   const uint32_t clkset1 = readl(&syscon->clkset1);
   const uint8_t fclk_div =
       fclk_divisors[(clkset1 >> SYSCON_CLKSET1_FCLK_DIV_SHIFT) & 7];
   const ulong fclk_rate = get_PLLCLK(&syscon->clkset1) / fclk_div;
 
   return fclk_rate;
}
 
/* return HCLK frequency */
ulong get_HCLK(void)
{
   const uint8_t hclk_divisors[] = { 1, 2, 4, 5, 6, 8, 16, 32 };
   struct syscon_regs *syscon = (struct syscon_regs *)SYSCON_BASE;
 
   const uint32_t clkset1 = readl(&syscon->clkset1);
   const uint8_t hclk_div =
       hclk_divisors[(clkset1 >> SYSCON_CLKSET1_HCLK_DIV_SHIFT) & 7];
   const ulong hclk_rate = get_PLLCLK(&syscon->clkset1) / hclk_div;
 
   return hclk_rate;
}
 
/* return PCLK frequency */
ulong get_PCLK(void)
{
   const uint8_t pclk_divisors[] = { 1, 2, 4, 8 };
   struct syscon_regs *syscon = (struct syscon_regs *)SYSCON_BASE;
 
   const uint32_t clkset1 = readl(&syscon->clkset1);
   const uint8_t pclk_div =
       pclk_divisors[(clkset1 >> SYSCON_CLKSET1_PCLK_DIV_SHIFT) & 3];
   const ulong pclk_rate = get_HCLK() / pclk_div;
 
   return pclk_rate;
}
 
/* return UCLK frequency */
ulong get_UCLK(void)
{
   struct syscon_regs *syscon = (struct syscon_regs *)SYSCON_BASE;
   ulong uclk_rate;
 
   const uint32_t value = readl(&syscon->pwrcnt);
   if (value & SYSCON_PWRCNT_UART_BAUD)
       uclk_rate = CONFIG_SYS_CLK_FREQ;
   else
       uclk_rate = CONFIG_SYS_CLK_FREQ / 2;
 
   return uclk_rate;
}