hc
2024-08-12 233ab1bd4c5697f5cdec94e60206e8c6ac609b4c
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
/*
 * Exynos PLL helper functions for clock drivers.
 * Copyright (C) 2016 Samsung Electronics
 * Thomas Abraham <thomas.ab@samsung.com>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <asm/io.h>
#include <div64.h>
 
#define PLL145X_MDIV_SHIFT    16
#define PLL145X_MDIV_MASK    0x3ff
#define PLL145X_PDIV_SHIFT    8
#define PLL145X_PDIV_MASK    0x3f
#define PLL145X_SDIV_SHIFT    0
#define PLL145X_SDIV_MASK    0x7
 
unsigned long pll145x_get_rate(unsigned int *con1, unsigned long fin_freq)
{
   unsigned long pll_con1 = readl(con1);
   unsigned long mdiv, sdiv, pdiv;
   uint64_t fvco = fin_freq;
 
   mdiv = (pll_con1 >> PLL145X_MDIV_SHIFT) & PLL145X_MDIV_MASK;
   pdiv = (pll_con1 >> PLL145X_PDIV_SHIFT) & PLL145X_PDIV_MASK;
   sdiv = (pll_con1 >> PLL145X_SDIV_SHIFT) & PLL145X_SDIV_MASK;
 
   fvco *= mdiv;
   do_div(fvco, (pdiv << sdiv));
   return (unsigned long)fvco;
}