 f1a788ff1f
			
		
	
	
	f1a788ff1f
	
	
	
		
			
			This patch extend the range of possible frequencies of the fs432c65 and fs660c32 Quad frequency synthesizers. Signed-off-by: Gabriel Fernandez <gabriel.fernandez@linaro.org> Acked-by: Peter Griffin <peter.griffin@linaro.org> Signed-off-by: Mike Turquette <mturquette@linaro.org>
		
			
				
	
	
		
			1194 lines
		
	
	
	
		
			34 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1194 lines
		
	
	
	
		
			34 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (C) 2014 STMicroelectronics R&D Ltd
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License version 2 as
 | |
|  * published by the Free Software Foundation.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * Authors:
 | |
|  * Stephen Gallimore <stephen.gallimore@st.com>,
 | |
|  * Pankaj Dev <pankaj.dev@st.com>.
 | |
|  */
 | |
| 
 | |
| #include <linux/slab.h>
 | |
| #include <linux/of_address.h>
 | |
| #include <linux/clk-provider.h>
 | |
| 
 | |
| #include "clkgen.h"
 | |
| 
 | |
| /*
 | |
|  * Maximum input clock to the PLL before we divide it down by 2
 | |
|  * although in reality in actual systems this has never been seen to
 | |
|  * be used.
 | |
|  */
 | |
| #define QUADFS_NDIV_THRESHOLD 30000000
 | |
| 
 | |
| #define PLL_BW_GOODREF   (0L)
 | |
| #define PLL_BW_VBADREF   (1L)
 | |
| #define PLL_BW_BADREF    (2L)
 | |
| #define PLL_BW_VGOODREF  (3L)
 | |
| 
 | |
| #define QUADFS_MAX_CHAN 4
 | |
| 
 | |
| struct stm_fs {
 | |
| 	unsigned long ndiv;
 | |
| 	unsigned long mdiv;
 | |
| 	unsigned long pe;
 | |
| 	unsigned long sdiv;
 | |
| 	unsigned long nsdiv;
 | |
| };
 | |
| 
 | |
| static const struct stm_fs fs216c65_rtbl[] = {
 | |
| 	{ .mdiv = 0x1f, .pe = 0x0,	.sdiv = 0x7,	.nsdiv = 0 },	/* 312.5 Khz */
 | |
| 	{ .mdiv = 0x17, .pe = 0x25ed,	.sdiv = 0x1,	.nsdiv = 0 },	/* 27    MHz */
 | |
| 	{ .mdiv = 0x1a, .pe = 0x7b36,	.sdiv = 0x2,	.nsdiv = 1 },	/* 36.87 MHz */
 | |
| 	{ .mdiv = 0x13, .pe = 0x0,	.sdiv = 0x2,	.nsdiv = 1 },	/* 48    MHz */
 | |
| 	{ .mdiv = 0x11, .pe = 0x1c72,	.sdiv = 0x1,	.nsdiv = 1 },	/* 108   MHz */
 | |
| };
 | |
| 
 | |
| static const struct stm_fs fs432c65_rtbl[] = {
 | |
| 	{ .mdiv = 0x1f, .pe = 0x0,	.sdiv = 0x7,	.nsdiv = 0 },	/* 625     Khz */
 | |
| 	{ .mdiv = 0x13, .pe = 0x777c,	.sdiv = 0x4,	.nsdiv = 1 },	/* 25.175  MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0x4d35,	.sdiv = 0x2,	.nsdiv = 0 },	/* 25.200  MHz */
 | |
| 	{ .mdiv = 0x11, .pe = 0x1c72,	.sdiv = 0x4,	.nsdiv = 1 },	/* 27.000  MHz */
 | |
| 	{ .mdiv = 0x17, .pe = 0x28f5,	.sdiv = 0x2,	.nsdiv = 0 },	/* 27.027  MHz */
 | |
| 	{ .mdiv = 0x16, .pe = 0x3359,	.sdiv = 0x2,	.nsdiv = 0 },	/* 28.320  MHz */
 | |
| 	{ .mdiv = 0x1f, .pe = 0x2083,	.sdiv = 0x3,	.nsdiv = 1 },	/* 30.240  MHz */
 | |
| 	{ .mdiv = 0x1e, .pe = 0x430d,	.sdiv = 0x3,	.nsdiv = 1 },	/* 31.500  MHz */
 | |
| 	{ .mdiv = 0x17, .pe = 0x0,	.sdiv = 0x3,	.nsdiv = 1 },	/* 40.000  MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0x121a,	.sdiv = 0x1,	.nsdiv = 0 },	/* 49.500  MHz */
 | |
| 	{ .mdiv = 0x13, .pe = 0x6667,	.sdiv = 0x3,	.nsdiv = 1 },	/* 50.000  MHz */
 | |
| 	{ .mdiv = 0x10, .pe = 0x1ee6,	.sdiv = 0x3,	.nsdiv = 1 },	/* 57.284  MHz */
 | |
| 	{ .mdiv = 0x1d, .pe = 0x3b14,	.sdiv = 0x2,	.nsdiv = 1 },	/* 65.000  MHz */
 | |
| 	{ .mdiv = 0x12, .pe = 0x7c65,	.sdiv = 0x1,	.nsdiv = 0 },	/* 71.000  MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0xecd,	.sdiv = 0x2,	.nsdiv = 1 },	/* 74.176  MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0x121a,	.sdiv = 0x2,	.nsdiv = 1 },	/* 74.250  MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0x3334,	.sdiv = 0x2,	.nsdiv = 1 },	/* 75.000  MHz */
 | |
| 	{ .mdiv = 0x18, .pe = 0x5138,	.sdiv = 0x2,	.nsdiv = 1 },	/* 78.800  MHz */
 | |
| 	{ .mdiv = 0x1d, .pe = 0x77d,	.sdiv = 0x0,	.nsdiv = 0 },	/* 85.500  MHz */
 | |
| 	{ .mdiv = 0x1c, .pe = 0x13d5,	.sdiv = 0x0,	.nsdiv = 0 },	/* 88.750  MHz */
 | |
| 	{ .mdiv = 0x11, .pe = 0x1c72,	.sdiv = 0x2,	.nsdiv = 1 },	/* 108.000 MHz */
 | |
| 	{ .mdiv = 0x17, .pe = 0x28f5,	.sdiv = 0x0,	.nsdiv = 0 },	/* 108.108 MHz */
 | |
| 	{ .mdiv = 0x10, .pe = 0x6e26,	.sdiv = 0x2,	.nsdiv = 1 },	/* 118.963 MHz */
 | |
| 	{ .mdiv = 0x15, .pe = 0x3e63,	.sdiv = 0x0,	.nsdiv = 0 },	/* 119.000 MHz */
 | |
| 	{ .mdiv = 0x1c, .pe = 0x471d,	.sdiv = 0x1,	.nsdiv = 1 },	/* 135.000 MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0xecd,	.sdiv = 0x1,	.nsdiv = 1 },	/* 148.352 MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0x121a,	.sdiv = 0x1,	.nsdiv = 1 },	/* 148.500 MHz */
 | |
| 	{ .mdiv = 0x19, .pe = 0x121a,	.sdiv = 0x0,	.nsdiv = 1 },	/* 297     MHz */
 | |
| };
 | |
| 
 | |
| static const struct stm_fs fs660c32_rtbl[] = {
 | |
| 	{ .mdiv = 0x14, .pe = 0x376b,	.sdiv = 0x4,	.nsdiv = 1 },	/* 25.175  MHz */
 | |
| 	{ .mdiv = 0x14, .pe = 0x30c3,	.sdiv = 0x4,	.nsdiv = 1 },	/* 25.200  MHz */
 | |
| 	{ .mdiv = 0x10, .pe = 0x71c7,	.sdiv = 0x4,	.nsdiv = 1 },	/* 27.000  MHz */
 | |
| 	{ .mdiv = 0x00, .pe = 0x47af,	.sdiv = 0x3,	.nsdiv = 0 },	/* 27.027  MHz */
 | |
| 	{ .mdiv = 0x0e, .pe = 0x4e1a,	.sdiv = 0x4,	.nsdiv = 1 },	/* 28.320  MHz */
 | |
| 	{ .mdiv = 0x0b, .pe = 0x534d,	.sdiv = 0x4,	.nsdiv = 1 },	/* 30.240  MHz */
 | |
| 	{ .mdiv = 0x17, .pe = 0x6fbf,	.sdiv = 0x2,	.nsdiv = 0 },	/* 31.500  MHz */
 | |
| 	{ .mdiv = 0x01, .pe = 0x0,	.sdiv = 0x4,	.nsdiv = 1 },	/* 40.000  MHz */
 | |
| 	{ .mdiv = 0x15, .pe = 0x2aab,	.sdiv = 0x3,	.nsdiv = 1 },	/* 49.500  MHz */
 | |
| 	{ .mdiv = 0x14, .pe = 0x6666,	.sdiv = 0x3,	.nsdiv = 1 },	/* 50.000  MHz */
 | |
| 	{ .mdiv = 0x1d, .pe = 0x395f,	.sdiv = 0x1,	.nsdiv = 0 },	/* 57.284  MHz */
 | |
| 	{ .mdiv = 0x08, .pe = 0x4ec5,	.sdiv = 0x3,	.nsdiv = 1 },	/* 65.000  MHz */
 | |
| 	{ .mdiv = 0x05, .pe = 0x1770,	.sdiv = 0x3,	.nsdiv = 1 },	/* 71.000  MHz */
 | |
| 	{ .mdiv = 0x03, .pe = 0x4ba7,	.sdiv = 0x3,	.nsdiv = 1 },	/* 74.176  MHz */
 | |
| 	{ .mdiv = 0x0f, .pe = 0x3426,	.sdiv = 0x1,	.nsdiv = 0 },	/* 74.250  MHz */
 | |
| 	{ .mdiv = 0x0e, .pe = 0x7777,	.sdiv = 0x1,	.nsdiv = 0 },	/* 75.000  MHz */
 | |
| 	{ .mdiv = 0x01, .pe = 0x4053,	.sdiv = 0x3,	.nsdiv = 1 },	/* 78.800  MHz */
 | |
| 	{ .mdiv = 0x09, .pe = 0x15b5,	.sdiv = 0x1,	.nsdiv = 0 },	/* 85.500  MHz */
 | |
| 	{ .mdiv = 0x1b, .pe = 0x3f19,	.sdiv = 0x2,	.nsdiv = 1 },	/* 88.750  MHz */
 | |
| 	{ .mdiv = 0x10, .pe = 0x71c7,	.sdiv = 0x2,	.nsdiv = 1 },	/* 108.000 MHz */
 | |
| 	{ .mdiv = 0x00, .pe = 0x47af,	.sdiv = 0x1,	.nsdiv = 0 },	/* 108.108 MHz */
 | |
| 	{ .mdiv = 0x0c, .pe = 0x3118,	.sdiv = 0x2,	.nsdiv = 1 },	/* 118.963 MHz */
 | |
| 	{ .mdiv = 0x0c, .pe = 0x2f54,	.sdiv = 0x2,	.nsdiv = 1 },	/* 119.000 MHz */
 | |
| 	{ .mdiv = 0x07, .pe = 0xe39,	.sdiv = 0x2,	.nsdiv = 1 },	/* 135.000 MHz */
 | |
| 	{ .mdiv = 0x03, .pe = 0x4ba7,	.sdiv = 0x2,	.nsdiv = 1 },	/* 148.352 MHz */
 | |
| 	{ .mdiv = 0x0f, .pe = 0x3426,	.sdiv = 0x0,	.nsdiv = 0 },	/* 148.500 MHz */
 | |
| 	{ .mdiv = 0x03, .pe = 0x4ba7,	.sdiv = 0x1,	.nsdiv = 1 },	/* 296.704 MHz */
 | |
| 	{ .mdiv = 0x03, .pe = 0x471c,	.sdiv = 0x1,	.nsdiv = 1 },	/* 297.000 MHz */
 | |
| 	{ .mdiv = 0x00, .pe = 0x295f,	.sdiv = 0x1,	.nsdiv = 1 },	/* 326.700 MHz */
 | |
| 	{ .mdiv = 0x1f, .pe = 0x3633,	.sdiv = 0x0,	.nsdiv = 1 },	/* 333.000 MHz */
 | |
| 	{ .mdiv = 0x1c, .pe = 0x0,	.sdiv = 0x0,	.nsdiv = 1 },	/* 352.000 Mhz */
 | |
| };
 | |
| 
 | |
| struct clkgen_quadfs_data {
 | |
| 	bool reset_present;
 | |
| 	bool bwfilter_present;
 | |
| 	bool lockstatus_present;
 | |
| 	bool powerup_polarity;
 | |
| 	bool standby_polarity;
 | |
| 	bool nsdiv_present;
 | |
| 	bool nrst_present;
 | |
| 	struct clkgen_field ndiv;
 | |
| 	struct clkgen_field ref_bw;
 | |
| 	struct clkgen_field nreset;
 | |
| 	struct clkgen_field npda;
 | |
| 	struct clkgen_field lock_status;
 | |
| 
 | |
| 	struct clkgen_field nrst[QUADFS_MAX_CHAN];
 | |
| 	struct clkgen_field nsb[QUADFS_MAX_CHAN];
 | |
| 	struct clkgen_field en[QUADFS_MAX_CHAN];
 | |
| 	struct clkgen_field mdiv[QUADFS_MAX_CHAN];
 | |
| 	struct clkgen_field pe[QUADFS_MAX_CHAN];
 | |
| 	struct clkgen_field sdiv[QUADFS_MAX_CHAN];
 | |
| 	struct clkgen_field nsdiv[QUADFS_MAX_CHAN];
 | |
| 
 | |
| 	const struct clk_ops *pll_ops;
 | |
| 	const struct stm_fs *rtbl;
 | |
| 	u8 rtbl_cnt;
 | |
| 	int  (*get_rate)(unsigned long , const struct stm_fs *,
 | |
| 			unsigned long *);
 | |
| };
 | |
| 
 | |
| static const struct clk_ops st_quadfs_pll_c65_ops;
 | |
| static const struct clk_ops st_quadfs_pll_c32_ops;
 | |
| static const struct clk_ops st_quadfs_fs216c65_ops;
 | |
| static const struct clk_ops st_quadfs_fs432c65_ops;
 | |
| static const struct clk_ops st_quadfs_fs660c32_ops;
 | |
| 
 | |
| static int clk_fs216c65_get_rate(unsigned long, const struct stm_fs *,
 | |
| 		unsigned long *);
 | |
| static int clk_fs432c65_get_rate(unsigned long, const struct stm_fs *,
 | |
| 		unsigned long *);
 | |
| static int clk_fs660c32_dig_get_rate(unsigned long, const struct stm_fs *,
 | |
| 		unsigned long *);
 | |
| /*
 | |
|  * Values for all of the standalone instances of this clock
 | |
|  * generator found in STiH415 and STiH416 SYSCFG register banks. Note
 | |
|  * that the individual channel standby control bits (nsb) are in the
 | |
|  * first register along with the PLL control bits.
 | |
|  */
 | |
| static const struct clkgen_quadfs_data st_fs216c65_416 = {
 | |
| 	/* 416 specific */
 | |
| 	.npda	= CLKGEN_FIELD(0x0, 0x1, 14),
 | |
| 	.nsb	= { CLKGEN_FIELD(0x0, 0x1, 10),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 11),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 12),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 13) },
 | |
| 	.nsdiv_present = true,
 | |
| 	.nsdiv	= { CLKGEN_FIELD(0x0, 0x1, 18),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 19),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 20),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 21) },
 | |
| 	.mdiv	= { CLKGEN_FIELD(0x4, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x14, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x24, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x34, 0x1f, 0) },
 | |
| 	.en	= { CLKGEN_FIELD(0x10, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x20, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x30, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x40, 0x1, 0) },
 | |
| 	.ndiv	= CLKGEN_FIELD(0x0, 0x1, 15),
 | |
| 	.bwfilter_present = true,
 | |
| 	.ref_bw = CLKGEN_FIELD(0x0, 0x3, 16),
 | |
| 	.pe	= { CLKGEN_FIELD(0x8, 0xffff, 0),
 | |
| 		    CLKGEN_FIELD(0x18, 0xffff, 0),
 | |
| 		    CLKGEN_FIELD(0x28, 0xffff, 0),
 | |
| 		    CLKGEN_FIELD(0x38, 0xffff, 0) },
 | |
| 	.sdiv	= { CLKGEN_FIELD(0xC, 0x7, 0),
 | |
| 		    CLKGEN_FIELD(0x1C, 0x7, 0),
 | |
| 		    CLKGEN_FIELD(0x2C, 0x7, 0),
 | |
| 		    CLKGEN_FIELD(0x3C, 0x7, 0) },
 | |
| 	.pll_ops	= &st_quadfs_pll_c65_ops,
 | |
| 	.rtbl		= fs216c65_rtbl,
 | |
| 	.rtbl_cnt	= ARRAY_SIZE(fs216c65_rtbl),
 | |
| 	.get_rate	= clk_fs216c65_get_rate,
 | |
| };
 | |
| 
 | |
| static const struct clkgen_quadfs_data st_fs432c65_416 = {
 | |
| 	.npda	= CLKGEN_FIELD(0x0, 0x1, 14),
 | |
| 	.nsb	= { CLKGEN_FIELD(0x0, 0x1, 10),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 11),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 12),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 13) },
 | |
| 	.nsdiv_present = true,
 | |
| 	.nsdiv	= { CLKGEN_FIELD(0x0, 0x1, 18),
 | |
| 		   CLKGEN_FIELD(0x0, 0x1, 19),
 | |
| 		   CLKGEN_FIELD(0x0, 0x1, 20),
 | |
| 		   CLKGEN_FIELD(0x0, 0x1, 21) },
 | |
| 	.mdiv	= { CLKGEN_FIELD(0x4, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x14, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x24, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x34, 0x1f, 0) },
 | |
| 	.en	= { CLKGEN_FIELD(0x10, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x20, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x30, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x40, 0x1, 0) },
 | |
| 	.ndiv	= CLKGEN_FIELD(0x0, 0x1, 15),
 | |
| 	.bwfilter_present = true,
 | |
| 	.ref_bw = CLKGEN_FIELD(0x0, 0x3, 16),
 | |
| 	.pe	= { CLKGEN_FIELD(0x8, 0xffff, 0),
 | |
| 		    CLKGEN_FIELD(0x18, 0xffff, 0),
 | |
| 		    CLKGEN_FIELD(0x28, 0xffff, 0),
 | |
| 		    CLKGEN_FIELD(0x38, 0xffff, 0) },
 | |
| 	.sdiv	= { CLKGEN_FIELD(0xC, 0x7, 0),
 | |
| 		    CLKGEN_FIELD(0x1C, 0x7, 0),
 | |
| 		    CLKGEN_FIELD(0x2C, 0x7, 0),
 | |
| 		    CLKGEN_FIELD(0x3C, 0x7, 0) },
 | |
| 	.pll_ops	= &st_quadfs_pll_c65_ops,
 | |
| 	.rtbl		= fs432c65_rtbl,
 | |
| 	.rtbl_cnt	= ARRAY_SIZE(fs432c65_rtbl),
 | |
| 	.get_rate	= clk_fs432c65_get_rate,
 | |
| };
 | |
| 
 | |
| static const struct clkgen_quadfs_data st_fs660c32_E_416 = {
 | |
| 	.npda	= CLKGEN_FIELD(0x0, 0x1, 14),
 | |
| 	.nsb	= { CLKGEN_FIELD(0x0, 0x1, 10),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 11),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 12),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 13) },
 | |
| 	.nsdiv_present = true,
 | |
| 	.nsdiv	= { CLKGEN_FIELD(0x0, 0x1, 18),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 19),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 20),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 21) },
 | |
| 	.mdiv	= { CLKGEN_FIELD(0x4, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x14, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x24, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x34, 0x1f, 0) },
 | |
| 	.en	= { CLKGEN_FIELD(0x10, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x20, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x30, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x40, 0x1, 0) },
 | |
| 	.ndiv	= CLKGEN_FIELD(0x0, 0x7, 15),
 | |
| 	.pe	= { CLKGEN_FIELD(0x8, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x18, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x28, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x38, 0x7fff, 0) },
 | |
| 	.sdiv	= { CLKGEN_FIELD(0xC, 0xf, 0),
 | |
| 		    CLKGEN_FIELD(0x1C, 0xf, 0),
 | |
| 		    CLKGEN_FIELD(0x2C, 0xf, 0),
 | |
| 		    CLKGEN_FIELD(0x3C, 0xf, 0) },
 | |
| 	.lockstatus_present = true,
 | |
| 	.lock_status = CLKGEN_FIELD(0xAC, 0x1, 0),
 | |
| 	.pll_ops	= &st_quadfs_pll_c32_ops,
 | |
| 	.rtbl		= fs660c32_rtbl,
 | |
| 	.rtbl_cnt	= ARRAY_SIZE(fs660c32_rtbl),
 | |
| 	.get_rate	= clk_fs660c32_dig_get_rate,
 | |
| };
 | |
| 
 | |
| static const struct clkgen_quadfs_data st_fs660c32_F_416 = {
 | |
| 	.npda	= CLKGEN_FIELD(0x0, 0x1, 14),
 | |
| 	.nsb	= { CLKGEN_FIELD(0x0, 0x1, 10),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 11),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 12),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 13) },
 | |
| 	.nsdiv_present = true,
 | |
| 	.nsdiv	= { CLKGEN_FIELD(0x0, 0x1, 18),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 19),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 20),
 | |
| 		    CLKGEN_FIELD(0x0, 0x1, 21) },
 | |
| 	.mdiv	= { CLKGEN_FIELD(0x4, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x14, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x24, 0x1f, 0),
 | |
| 		    CLKGEN_FIELD(0x34, 0x1f, 0) },
 | |
| 	.en	= { CLKGEN_FIELD(0x10, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x20, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x30, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x40, 0x1, 0) },
 | |
| 	.ndiv	= CLKGEN_FIELD(0x0, 0x7, 15),
 | |
| 	.pe	= { CLKGEN_FIELD(0x8, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x18, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x28, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x38, 0x7fff, 0) },
 | |
| 	.sdiv	= { CLKGEN_FIELD(0xC, 0xf, 0),
 | |
| 		    CLKGEN_FIELD(0x1C, 0xf, 0),
 | |
| 		    CLKGEN_FIELD(0x2C, 0xf, 0),
 | |
| 		    CLKGEN_FIELD(0x3C, 0xf, 0) },
 | |
| 	.lockstatus_present = true,
 | |
| 	.lock_status = CLKGEN_FIELD(0xEC, 0x1, 0),
 | |
| 	.pll_ops	= &st_quadfs_pll_c32_ops,
 | |
| 	.rtbl		= fs660c32_rtbl,
 | |
| 	.rtbl_cnt	= ARRAY_SIZE(fs660c32_rtbl),
 | |
| 	.get_rate	= clk_fs660c32_dig_get_rate,
 | |
| };
 | |
| 
 | |
| static const struct clkgen_quadfs_data st_fs660c32_C_407 = {
 | |
| 	.nrst_present = true,
 | |
| 	.nrst	= { CLKGEN_FIELD(0x2f0, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x2f0, 0x1, 1),
 | |
| 		    CLKGEN_FIELD(0x2f0, 0x1, 2),
 | |
| 		    CLKGEN_FIELD(0x2f0, 0x1, 3) },
 | |
| 	.npda	= CLKGEN_FIELD(0x2f0, 0x1, 12),
 | |
| 	.nsb	= { CLKGEN_FIELD(0x2f0, 0x1, 8),
 | |
| 		    CLKGEN_FIELD(0x2f0, 0x1, 9),
 | |
| 		    CLKGEN_FIELD(0x2f0, 0x1, 10),
 | |
| 		    CLKGEN_FIELD(0x2f0, 0x1, 11) },
 | |
| 	.nsdiv_present = true,
 | |
| 	.nsdiv	= { CLKGEN_FIELD(0x304, 0x1, 24),
 | |
| 		    CLKGEN_FIELD(0x308, 0x1, 24),
 | |
| 		    CLKGEN_FIELD(0x30c, 0x1, 24),
 | |
| 		    CLKGEN_FIELD(0x310, 0x1, 24) },
 | |
| 	.mdiv	= { CLKGEN_FIELD(0x304, 0x1f, 15),
 | |
| 		    CLKGEN_FIELD(0x308, 0x1f, 15),
 | |
| 		    CLKGEN_FIELD(0x30c, 0x1f, 15),
 | |
| 		    CLKGEN_FIELD(0x310, 0x1f, 15) },
 | |
| 	.en	= { CLKGEN_FIELD(0x2fc, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x2fc, 0x1, 1),
 | |
| 		    CLKGEN_FIELD(0x2fc, 0x1, 2),
 | |
| 		    CLKGEN_FIELD(0x2fc, 0x1, 3) },
 | |
| 	.ndiv	= CLKGEN_FIELD(0x2f4, 0x7, 16),
 | |
| 	.pe	= { CLKGEN_FIELD(0x304, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x308, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x30c, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x310, 0x7fff, 0) },
 | |
| 	.sdiv	= { CLKGEN_FIELD(0x304, 0xf, 20),
 | |
| 		    CLKGEN_FIELD(0x308, 0xf, 20),
 | |
| 		    CLKGEN_FIELD(0x30c, 0xf, 20),
 | |
| 		    CLKGEN_FIELD(0x310, 0xf, 20) },
 | |
| 	.lockstatus_present = true,
 | |
| 	.lock_status = CLKGEN_FIELD(0x2A0, 0x1, 24),
 | |
| 	.powerup_polarity = 1,
 | |
| 	.standby_polarity = 1,
 | |
| 	.pll_ops	= &st_quadfs_pll_c32_ops,
 | |
| 	.rtbl		= fs660c32_rtbl,
 | |
| 	.rtbl_cnt	= ARRAY_SIZE(fs660c32_rtbl),
 | |
| 	.get_rate	= clk_fs660c32_dig_get_rate,
 | |
| };
 | |
| 
 | |
| static const struct clkgen_quadfs_data st_fs660c32_D_407 = {
 | |
| 	.nrst_present = true,
 | |
| 	.nrst	= { CLKGEN_FIELD(0x2a0, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x2a0, 0x1, 1),
 | |
| 		    CLKGEN_FIELD(0x2a0, 0x1, 2),
 | |
| 		    CLKGEN_FIELD(0x2a0, 0x1, 3) },
 | |
| 	.ndiv	= CLKGEN_FIELD(0x2a4, 0x7, 16),
 | |
| 	.pe	= { CLKGEN_FIELD(0x2b4, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x2b8, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x2bc, 0x7fff, 0),
 | |
| 		    CLKGEN_FIELD(0x2c0, 0x7fff, 0) },
 | |
| 	.sdiv	= { CLKGEN_FIELD(0x2b4, 0xf, 20),
 | |
| 		    CLKGEN_FIELD(0x2b8, 0xf, 20),
 | |
| 		    CLKGEN_FIELD(0x2bc, 0xf, 20),
 | |
| 		    CLKGEN_FIELD(0x2c0, 0xf, 20) },
 | |
| 	.npda	= CLKGEN_FIELD(0x2a0, 0x1, 12),
 | |
| 	.nsb	= { CLKGEN_FIELD(0x2a0, 0x1, 8),
 | |
| 		    CLKGEN_FIELD(0x2a0, 0x1, 9),
 | |
| 		    CLKGEN_FIELD(0x2a0, 0x1, 10),
 | |
| 		    CLKGEN_FIELD(0x2a0, 0x1, 11) },
 | |
| 	.nsdiv_present = true,
 | |
| 	.nsdiv	= { CLKGEN_FIELD(0x2b4, 0x1, 24),
 | |
| 		    CLKGEN_FIELD(0x2b8, 0x1, 24),
 | |
| 		    CLKGEN_FIELD(0x2bc, 0x1, 24),
 | |
| 		    CLKGEN_FIELD(0x2c0, 0x1, 24) },
 | |
| 	.mdiv	= { CLKGEN_FIELD(0x2b4, 0x1f, 15),
 | |
| 		    CLKGEN_FIELD(0x2b8, 0x1f, 15),
 | |
| 		    CLKGEN_FIELD(0x2bc, 0x1f, 15),
 | |
| 		    CLKGEN_FIELD(0x2c0, 0x1f, 15) },
 | |
| 	.en	= { CLKGEN_FIELD(0x2ac, 0x1, 0),
 | |
| 		    CLKGEN_FIELD(0x2ac, 0x1, 1),
 | |
| 		    CLKGEN_FIELD(0x2ac, 0x1, 2),
 | |
| 		    CLKGEN_FIELD(0x2ac, 0x1, 3) },
 | |
| 	.lockstatus_present = true,
 | |
| 	.lock_status = CLKGEN_FIELD(0x2A0, 0x1, 24),
 | |
| 	.powerup_polarity = 1,
 | |
| 	.standby_polarity = 1,
 | |
| 	.pll_ops	= &st_quadfs_pll_c32_ops,
 | |
| 	.rtbl		= fs660c32_rtbl,
 | |
| 	.rtbl_cnt	= ARRAY_SIZE(fs660c32_rtbl),
 | |
| 	.get_rate	= clk_fs660c32_dig_get_rate,};
 | |
| 
 | |
| /**
 | |
|  * DOC: A Frequency Synthesizer that multiples its input clock by a fixed factor
 | |
|  *
 | |
|  * Traits of this clock:
 | |
|  * prepare - clk_(un)prepare only ensures parent is (un)prepared
 | |
|  * enable - clk_enable and clk_disable are functional & control the Fsyn
 | |
|  * rate - inherits rate from parent. set_rate/round_rate/recalc_rate
 | |
|  * parent - fixed parent.  No clk_set_parent support
 | |
|  */
 | |
| 
 | |
| /**
 | |
|  * struct st_clk_quadfs_pll - A pll which outputs a fixed multiplier of
 | |
|  *                                  its parent clock, found inside a type of
 | |
|  *                                  ST quad channel frequency synthesizer block
 | |
|  *
 | |
|  * @hw: handle between common and hardware-specific interfaces.
 | |
|  * @ndiv: regmap field for the ndiv control.
 | |
|  * @regs_base: base address of the configuration registers.
 | |
|  * @lock: spinlock.
 | |
|  *
 | |
|  */
 | |
| struct st_clk_quadfs_pll {
 | |
| 	struct clk_hw	hw;
 | |
| 	void __iomem	*regs_base;
 | |
| 	spinlock_t	*lock;
 | |
| 	struct clkgen_quadfs_data *data;
 | |
| 	u32 ndiv;
 | |
| };
 | |
| 
 | |
| #define to_quadfs_pll(_hw) container_of(_hw, struct st_clk_quadfs_pll, hw)
 | |
| 
 | |
| static int quadfs_pll_enable(struct clk_hw *hw)
 | |
| {
 | |
| 	struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 | |
| 	unsigned long flags = 0, timeout = jiffies + msecs_to_jiffies(10);
 | |
| 
 | |
| 	if (pll->lock)
 | |
| 		spin_lock_irqsave(pll->lock, flags);
 | |
| 
 | |
| 	/*
 | |
| 	 * Bring block out of reset if we have reset control.
 | |
| 	 */
 | |
| 	if (pll->data->reset_present)
 | |
| 		CLKGEN_WRITE(pll, nreset, 1);
 | |
| 
 | |
| 	/*
 | |
| 	 * Use a fixed input clock noise bandwidth filter for the moment
 | |
| 	 */
 | |
| 	if (pll->data->bwfilter_present)
 | |
| 		CLKGEN_WRITE(pll, ref_bw, PLL_BW_GOODREF);
 | |
| 
 | |
| 
 | |
| 	CLKGEN_WRITE(pll, ndiv, pll->ndiv);
 | |
| 
 | |
| 	/*
 | |
| 	 * Power up the PLL
 | |
| 	 */
 | |
| 	CLKGEN_WRITE(pll, npda, !pll->data->powerup_polarity);
 | |
| 
 | |
| 	if (pll->lock)
 | |
| 		spin_unlock_irqrestore(pll->lock, flags);
 | |
| 
 | |
| 	if (pll->data->lockstatus_present)
 | |
| 		while (!CLKGEN_READ(pll, lock_status)) {
 | |
| 			if (time_after(jiffies, timeout))
 | |
| 				return -ETIMEDOUT;
 | |
| 			cpu_relax();
 | |
| 		}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void quadfs_pll_disable(struct clk_hw *hw)
 | |
| {
 | |
| 	struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 | |
| 	unsigned long flags = 0;
 | |
| 
 | |
| 	if (pll->lock)
 | |
| 		spin_lock_irqsave(pll->lock, flags);
 | |
| 
 | |
| 	/*
 | |
| 	 * Powerdown the PLL and then put block into soft reset if we have
 | |
| 	 * reset control.
 | |
| 	 */
 | |
| 	CLKGEN_WRITE(pll, npda, pll->data->powerup_polarity);
 | |
| 
 | |
| 	if (pll->data->reset_present)
 | |
| 		CLKGEN_WRITE(pll, nreset, 0);
 | |
| 
 | |
| 	if (pll->lock)
 | |
| 		spin_unlock_irqrestore(pll->lock, flags);
 | |
| }
 | |
| 
 | |
| static int quadfs_pll_is_enabled(struct clk_hw *hw)
 | |
| {
 | |
| 	struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 | |
| 	u32 npda = CLKGEN_READ(pll, npda);
 | |
| 
 | |
| 	return !!npda;
 | |
| }
 | |
| 
 | |
| int clk_fs660c32_vco_get_rate(unsigned long input, struct stm_fs *fs,
 | |
| 			   unsigned long *rate)
 | |
| {
 | |
| 	unsigned long nd = fs->ndiv + 16; /* ndiv value */
 | |
| 
 | |
| 	*rate = input * nd;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static unsigned long quadfs_pll_fs660c32_recalc_rate(struct clk_hw *hw,
 | |
| 					unsigned long parent_rate)
 | |
| {
 | |
| 	struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 | |
| 	unsigned long rate = 0;
 | |
| 	struct stm_fs params;
 | |
| 
 | |
| 	params.ndiv = CLKGEN_READ(pll, ndiv);
 | |
| 	if (clk_fs660c32_vco_get_rate(parent_rate, ¶ms, &rate))
 | |
| 		pr_err("%s:%s error calculating rate\n",
 | |
| 		       __clk_get_name(hw->clk), __func__);
 | |
| 
 | |
| 	pll->ndiv = params.ndiv;
 | |
| 
 | |
| 	return rate;
 | |
| }
 | |
| 
 | |
| int clk_fs660c32_vco_get_params(unsigned long input,
 | |
| 				unsigned long output, struct stm_fs *fs)
 | |
| {
 | |
| /* Formula
 | |
|    VCO frequency = (fin x ndiv) / pdiv
 | |
|    ndiv = VCOfreq * pdiv / fin
 | |
|    */
 | |
| 	unsigned long pdiv = 1, n;
 | |
| 
 | |
| 	/* Output clock range: 384Mhz to 660Mhz */
 | |
| 	if (output < 384000000 || output > 660000000)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (input > 40000000)
 | |
| 		/* This means that PDIV would be 2 instead of 1.
 | |
| 		   Not supported today. */
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	input /= 1000;
 | |
| 	output /= 1000;
 | |
| 
 | |
| 	n = output * pdiv / input;
 | |
| 	if (n < 16)
 | |
| 		n = 16;
 | |
| 	fs->ndiv = n - 16; /* Converting formula value to reg value */
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static long quadfs_pll_fs660c32_round_rate(struct clk_hw *hw, unsigned long rate
 | |
| 		, unsigned long *prate)
 | |
| {
 | |
| 	struct stm_fs params;
 | |
| 
 | |
| 	if (!clk_fs660c32_vco_get_params(*prate, rate, ¶ms))
 | |
| 		clk_fs660c32_vco_get_rate(*prate, ¶ms, &rate);
 | |
| 
 | |
| 	pr_debug("%s: %s new rate %ld [sdiv=0x%x,md=0x%x,pe=0x%x,nsdiv3=%u]\n",
 | |
| 		 __func__, __clk_get_name(hw->clk),
 | |
| 		 rate, (unsigned int)params.sdiv,
 | |
| 		 (unsigned int)params.mdiv,
 | |
| 		 (unsigned int)params.pe, (unsigned int)params.nsdiv);
 | |
| 
 | |
| 	return rate;
 | |
| }
 | |
| 
 | |
| static int quadfs_pll_fs660c32_set_rate(struct clk_hw *hw, unsigned long rate,
 | |
| 				unsigned long parent_rate)
 | |
| {
 | |
| 	struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
 | |
| 	struct stm_fs params;
 | |
| 	long hwrate = 0;
 | |
| 	unsigned long flags = 0;
 | |
| 
 | |
| 	if (!rate || !parent_rate)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!clk_fs660c32_vco_get_params(parent_rate, rate, ¶ms))
 | |
| 		clk_fs660c32_vco_get_rate(parent_rate, ¶ms, &hwrate);
 | |
| 
 | |
| 	pr_debug("%s: %s new rate %ld [ndiv=0x%x]\n",
 | |
| 		 __func__, __clk_get_name(hw->clk),
 | |
| 		 hwrate, (unsigned int)params.ndiv);
 | |
| 
 | |
| 	if (!hwrate)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	pll->ndiv = params.ndiv;
 | |
| 
 | |
| 	if (pll->lock)
 | |
| 		spin_lock_irqsave(pll->lock, flags);
 | |
| 
 | |
| 	CLKGEN_WRITE(pll, ndiv, pll->ndiv);
 | |
| 
 | |
| 	if (pll->lock)
 | |
| 		spin_unlock_irqrestore(pll->lock, flags);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct clk_ops st_quadfs_pll_c65_ops = {
 | |
| 	.enable		= quadfs_pll_enable,
 | |
| 	.disable	= quadfs_pll_disable,
 | |
| 	.is_enabled	= quadfs_pll_is_enabled,
 | |
| };
 | |
| 
 | |
| static const struct clk_ops st_quadfs_pll_c32_ops = {
 | |
| 	.enable		= quadfs_pll_enable,
 | |
| 	.disable	= quadfs_pll_disable,
 | |
| 	.is_enabled	= quadfs_pll_is_enabled,
 | |
| 	.recalc_rate	= quadfs_pll_fs660c32_recalc_rate,
 | |
| 	.round_rate	= quadfs_pll_fs660c32_round_rate,
 | |
| 	.set_rate	= quadfs_pll_fs660c32_set_rate,
 | |
| };
 | |
| 
 | |
| static struct clk * __init st_clk_register_quadfs_pll(
 | |
| 		const char *name, const char *parent_name,
 | |
| 		struct clkgen_quadfs_data *quadfs, void __iomem *reg,
 | |
| 		spinlock_t *lock)
 | |
| {
 | |
| 	struct st_clk_quadfs_pll *pll;
 | |
| 	struct clk *clk;
 | |
| 	struct clk_init_data init;
 | |
| 
 | |
| 	/*
 | |
| 	 * Sanity check required pointers.
 | |
| 	 */
 | |
| 	if (WARN_ON(!name || !parent_name))
 | |
| 		return ERR_PTR(-EINVAL);
 | |
| 
 | |
| 	pll = kzalloc(sizeof(*pll), GFP_KERNEL);
 | |
| 	if (!pll)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	init.name = name;
 | |
| 	init.ops = quadfs->pll_ops;
 | |
| 	init.flags = CLK_IS_BASIC;
 | |
| 	init.parent_names = &parent_name;
 | |
| 	init.num_parents = 1;
 | |
| 
 | |
| 	pll->data = quadfs;
 | |
| 	pll->regs_base = reg;
 | |
| 	pll->lock = lock;
 | |
| 	pll->hw.init = &init;
 | |
| 
 | |
| 	clk = clk_register(NULL, &pll->hw);
 | |
| 
 | |
| 	if (IS_ERR(clk))
 | |
| 		kfree(pll);
 | |
| 
 | |
| 	return clk;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * DOC: A digital frequency synthesizer
 | |
|  *
 | |
|  * Traits of this clock:
 | |
|  * prepare - clk_(un)prepare only ensures parent is (un)prepared
 | |
|  * enable - clk_enable and clk_disable are functional
 | |
|  * rate - set rate is functional
 | |
|  * parent - fixed parent.  No clk_set_parent support
 | |
|  */
 | |
| 
 | |
| /**
 | |
|  * struct st_clk_quadfs_fsynth - One clock output from a four channel digital
 | |
|  *                                  frequency synthesizer (fsynth) block.
 | |
|  *
 | |
|  * @hw: handle between common and hardware-specific interfaces
 | |
|  *
 | |
|  * @nsb: regmap field in the output control register for the digital
 | |
|  *       standby of this fsynth channel. This control is active low so
 | |
|  *       the channel is in standby when the control bit is cleared.
 | |
|  *
 | |
|  * @nsdiv: regmap field in the output control register for
 | |
|  *          for the optional divide by 3 of this fsynth channel. This control
 | |
|  *          is active low so the divide by 3 is active when the control bit is
 | |
|  *          cleared and the divide is bypassed when the bit is set.
 | |
|  */
 | |
| struct st_clk_quadfs_fsynth {
 | |
| 	struct clk_hw	hw;
 | |
| 	void __iomem	*regs_base;
 | |
| 	spinlock_t	*lock;
 | |
| 	struct clkgen_quadfs_data *data;
 | |
| 
 | |
| 	u32 chan;
 | |
| 	/*
 | |
| 	 * Cached hardware values from set_rate so we can program the
 | |
| 	 * hardware in enable. There are two reasons for this:
 | |
| 	 *
 | |
| 	 *  1. The registers may not be writable until the parent has been
 | |
| 	 *     enabled.
 | |
| 	 *
 | |
| 	 *  2. It restores the clock rate when a driver does an enable
 | |
| 	 *     on PM restore, after a suspend to RAM has lost the hardware
 | |
| 	 *     setup.
 | |
| 	 */
 | |
| 	u32 md;
 | |
| 	u32 pe;
 | |
| 	u32 sdiv;
 | |
| 	u32 nsdiv;
 | |
| };
 | |
| 
 | |
| #define to_quadfs_fsynth(_hw) \
 | |
| 	container_of(_hw, struct st_clk_quadfs_fsynth, hw)
 | |
| 
 | |
| static void quadfs_fsynth_program_enable(struct st_clk_quadfs_fsynth *fs)
 | |
| {
 | |
| 	/*
 | |
| 	 * Pulse the program enable register lsb to make the hardware take
 | |
| 	 * notice of the new md/pe values with a glitchless transition.
 | |
| 	 */
 | |
| 	CLKGEN_WRITE(fs, en[fs->chan], 1);
 | |
| 	CLKGEN_WRITE(fs, en[fs->chan], 0);
 | |
| }
 | |
| 
 | |
| static void quadfs_fsynth_program_rate(struct st_clk_quadfs_fsynth *fs)
 | |
| {
 | |
| 	unsigned long flags = 0;
 | |
| 
 | |
| 	/*
 | |
| 	 * Ensure the md/pe parameters are ignored while we are
 | |
| 	 * reprogramming them so we can get a glitchless change
 | |
| 	 * when fine tuning the speed of a running clock.
 | |
| 	 */
 | |
| 	CLKGEN_WRITE(fs, en[fs->chan], 0);
 | |
| 
 | |
| 	CLKGEN_WRITE(fs, mdiv[fs->chan], fs->md);
 | |
| 	CLKGEN_WRITE(fs, pe[fs->chan], fs->pe);
 | |
| 	CLKGEN_WRITE(fs, sdiv[fs->chan], fs->sdiv);
 | |
| 
 | |
| 	if (fs->lock)
 | |
| 		spin_lock_irqsave(fs->lock, flags);
 | |
| 
 | |
| 	if (fs->data->nsdiv_present)
 | |
| 		CLKGEN_WRITE(fs, nsdiv[fs->chan], fs->nsdiv);
 | |
| 
 | |
| 	if (fs->lock)
 | |
| 		spin_unlock_irqrestore(fs->lock, flags);
 | |
| }
 | |
| 
 | |
| static int quadfs_fsynth_enable(struct clk_hw *hw)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 | |
| 	unsigned long flags = 0;
 | |
| 
 | |
| 	pr_debug("%s: %s\n", __func__, __clk_get_name(hw->clk));
 | |
| 
 | |
| 	quadfs_fsynth_program_rate(fs);
 | |
| 
 | |
| 	if (fs->lock)
 | |
| 		spin_lock_irqsave(fs->lock, flags);
 | |
| 
 | |
| 	CLKGEN_WRITE(fs, nsb[fs->chan], !fs->data->standby_polarity);
 | |
| 
 | |
| 	if (fs->data->nrst_present)
 | |
| 		CLKGEN_WRITE(fs, nrst[fs->chan], 0);
 | |
| 
 | |
| 	if (fs->lock)
 | |
| 		spin_unlock_irqrestore(fs->lock, flags);
 | |
| 
 | |
| 	quadfs_fsynth_program_enable(fs);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void quadfs_fsynth_disable(struct clk_hw *hw)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 | |
| 	unsigned long flags = 0;
 | |
| 
 | |
| 	pr_debug("%s: %s\n", __func__, __clk_get_name(hw->clk));
 | |
| 
 | |
| 	if (fs->lock)
 | |
| 		spin_lock_irqsave(fs->lock, flags);
 | |
| 
 | |
| 	CLKGEN_WRITE(fs, nsb[fs->chan], !fs->data->standby_polarity);
 | |
| 
 | |
| 	if (fs->lock)
 | |
| 		spin_unlock_irqrestore(fs->lock, flags);
 | |
| }
 | |
| 
 | |
| static int quadfs_fsynth_is_enabled(struct clk_hw *hw)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 | |
| 	u32 nsb = CLKGEN_READ(fs, nsb[fs->chan]);
 | |
| 
 | |
| 	pr_debug("%s: %s enable bit = 0x%x\n",
 | |
| 		 __func__, __clk_get_name(hw->clk), nsb);
 | |
| 
 | |
| 	return fs->data->standby_polarity ? !nsb : !!nsb;
 | |
| }
 | |
| 
 | |
| #define P15			(uint64_t)(1 << 15)
 | |
| 
 | |
| static int clk_fs216c65_get_rate(unsigned long input, const struct stm_fs *fs,
 | |
| 		unsigned long *rate)
 | |
| {
 | |
| 	uint64_t res;
 | |
| 	unsigned long ns;
 | |
| 	unsigned long nd = 8; /* ndiv stuck at 0 => val = 8 */
 | |
| 	unsigned long s;
 | |
| 	long m;
 | |
| 
 | |
| 	m = fs->mdiv - 32;
 | |
| 	s = 1 << (fs->sdiv + 1);
 | |
| 	ns = (fs->nsdiv ? 1 : 3);
 | |
| 
 | |
| 	res = (uint64_t)(s * ns * P15 * (uint64_t)(m + 33));
 | |
| 	res = res - (s * ns * fs->pe);
 | |
| 	*rate = div64_u64(P15 * nd * input * 32, res);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int clk_fs432c65_get_rate(unsigned long input, const struct stm_fs *fs,
 | |
| 		unsigned long *rate)
 | |
| {
 | |
| 	uint64_t res;
 | |
| 	unsigned long nd = 16; /* ndiv value; stuck at 0 (30Mhz input) */
 | |
| 	long m;
 | |
| 	unsigned long sd;
 | |
| 	unsigned long ns;
 | |
| 
 | |
| 	m = fs->mdiv - 32;
 | |
| 	sd = 1 << (fs->sdiv + 1);
 | |
| 	ns = (fs->nsdiv ? 1 : 3);
 | |
| 
 | |
| 	res = (uint64_t)(sd * ns * P15 * (uint64_t)(m + 33));
 | |
| 	res = res - (sd * ns * fs->pe);
 | |
| 	*rate = div64_u64(P15 * nd * input * 32, res);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #define P20		(uint64_t)(1 << 20)
 | |
| 
 | |
| static int clk_fs660c32_dig_get_rate(unsigned long input,
 | |
| 				const struct stm_fs *fs, unsigned long *rate)
 | |
| {
 | |
| 	unsigned long s = (1 << fs->sdiv);
 | |
| 	unsigned long ns;
 | |
| 	uint64_t res;
 | |
| 
 | |
| 	/*
 | |
| 	 * 'nsdiv' is a register value ('BIN') which is translated
 | |
| 	 * to a decimal value according to following rules.
 | |
| 	 *
 | |
| 	 *     nsdiv      ns.dec
 | |
| 	 *       0        3
 | |
| 	 *       1        1
 | |
| 	 */
 | |
| 	ns = (fs->nsdiv == 1) ? 1 : 3;
 | |
| 
 | |
| 	res = (P20 * (32 + fs->mdiv) + 32 * fs->pe) * s * ns;
 | |
| 	*rate = (unsigned long)div64_u64(input * P20 * 32, res);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int quadfs_fsynt_get_hw_value_for_recalc(struct st_clk_quadfs_fsynth *fs,
 | |
| 		struct stm_fs *params)
 | |
| {
 | |
| 	/*
 | |
| 	 * Get the initial hardware values for recalc_rate
 | |
| 	 */
 | |
| 	params->mdiv	= CLKGEN_READ(fs, mdiv[fs->chan]);
 | |
| 	params->pe	= CLKGEN_READ(fs, pe[fs->chan]);
 | |
| 	params->sdiv	= CLKGEN_READ(fs, sdiv[fs->chan]);
 | |
| 
 | |
| 	if (fs->data->nsdiv_present)
 | |
| 		params->nsdiv = CLKGEN_READ(fs, nsdiv[fs->chan]);
 | |
| 	else
 | |
| 		params->nsdiv = 1;
 | |
| 
 | |
| 	/*
 | |
| 	 * If All are NULL then assume no clock rate is programmed.
 | |
| 	 */
 | |
| 	if (!params->mdiv && !params->pe && !params->sdiv)
 | |
| 		return 1;
 | |
| 
 | |
| 	fs->md = params->mdiv;
 | |
| 	fs->pe = params->pe;
 | |
| 	fs->sdiv = params->sdiv;
 | |
| 	fs->nsdiv = params->nsdiv;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static long quadfs_find_best_rate(struct clk_hw *hw, unsigned long drate,
 | |
| 				unsigned long prate, struct stm_fs *params)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 | |
| 	int (*clk_fs_get_rate)(unsigned long ,
 | |
| 				const struct stm_fs *, unsigned long *);
 | |
| 	struct stm_fs prev_params;
 | |
| 	unsigned long prev_rate, rate = 0;
 | |
| 	unsigned long diff_rate, prev_diff_rate = ~0;
 | |
| 	int index;
 | |
| 
 | |
| 	clk_fs_get_rate = fs->data->get_rate;
 | |
| 
 | |
| 	for (index = 0; index < fs->data->rtbl_cnt; index++) {
 | |
| 		prev_rate = rate;
 | |
| 
 | |
| 		*params = fs->data->rtbl[index];
 | |
| 		prev_params = *params;
 | |
| 
 | |
| 		clk_fs_get_rate(prate, &fs->data->rtbl[index], &rate);
 | |
| 
 | |
| 		diff_rate = abs(drate - rate);
 | |
| 
 | |
| 		if (diff_rate > prev_diff_rate) {
 | |
| 			rate = prev_rate;
 | |
| 			*params = prev_params;
 | |
| 			break;
 | |
| 		}
 | |
| 
 | |
| 		prev_diff_rate = diff_rate;
 | |
| 
 | |
| 		if (drate == rate)
 | |
| 			return rate;
 | |
| 	}
 | |
| 
 | |
| 
 | |
| 	if (index == fs->data->rtbl_cnt)
 | |
| 		*params = prev_params;
 | |
| 
 | |
| 	return rate;
 | |
| }
 | |
| 
 | |
| static unsigned long quadfs_recalc_rate(struct clk_hw *hw,
 | |
| 		unsigned long parent_rate)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 | |
| 	unsigned long rate = 0;
 | |
| 	struct stm_fs params;
 | |
| 	int (*clk_fs_get_rate)(unsigned long ,
 | |
| 				const struct stm_fs *, unsigned long *);
 | |
| 
 | |
| 	clk_fs_get_rate = fs->data->get_rate;
 | |
| 
 | |
| 	if (quadfs_fsynt_get_hw_value_for_recalc(fs, ¶ms))
 | |
| 		return 0;
 | |
| 
 | |
| 	if (clk_fs_get_rate(parent_rate, ¶ms, &rate)) {
 | |
| 		pr_err("%s:%s error calculating rate\n",
 | |
| 		       __clk_get_name(hw->clk), __func__);
 | |
| 	}
 | |
| 
 | |
| 	pr_debug("%s:%s rate %lu\n", __clk_get_name(hw->clk), __func__, rate);
 | |
| 
 | |
| 	return rate;
 | |
| }
 | |
| 
 | |
| static long quadfs_round_rate(struct clk_hw *hw, unsigned long rate,
 | |
| 				     unsigned long *prate)
 | |
| {
 | |
| 	struct stm_fs params;
 | |
| 
 | |
| 	rate = quadfs_find_best_rate(hw, rate, *prate, ¶ms);
 | |
| 
 | |
| 	pr_debug("%s: %s new rate %ld [sdiv=0x%x,md=0x%x,pe=0x%x,nsdiv3=%u]\n",
 | |
| 		 __func__, __clk_get_name(hw->clk),
 | |
| 		 rate, (unsigned int)params.sdiv, (unsigned int)params.mdiv,
 | |
| 			 (unsigned int)params.pe, (unsigned int)params.nsdiv);
 | |
| 
 | |
| 	return rate;
 | |
| }
 | |
| 
 | |
| 
 | |
| static void quadfs_program_and_enable(struct st_clk_quadfs_fsynth *fs,
 | |
| 		struct stm_fs *params)
 | |
| {
 | |
| 	fs->md = params->mdiv;
 | |
| 	fs->pe = params->pe;
 | |
| 	fs->sdiv = params->sdiv;
 | |
| 	fs->nsdiv = params->nsdiv;
 | |
| 
 | |
| 	/*
 | |
| 	 * In some integrations you can only change the fsynth programming when
 | |
| 	 * the parent entity containing it is enabled.
 | |
| 	 */
 | |
| 	quadfs_fsynth_program_rate(fs);
 | |
| 	quadfs_fsynth_program_enable(fs);
 | |
| }
 | |
| 
 | |
| static int quadfs_set_rate(struct clk_hw *hw, unsigned long rate,
 | |
| 				  unsigned long parent_rate)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
 | |
| 	struct stm_fs params;
 | |
| 	long hwrate;
 | |
| 	int uninitialized_var(i);
 | |
| 
 | |
| 	if (!rate || !parent_rate)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	memset(¶ms, 0, sizeof(struct stm_fs));
 | |
| 
 | |
| 	hwrate = quadfs_find_best_rate(hw, rate, parent_rate, ¶ms);
 | |
| 	if (!hwrate)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	quadfs_program_and_enable(fs, ¶ms);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| 
 | |
| static const struct clk_ops st_quadfs_ops = {
 | |
| 	.enable		= quadfs_fsynth_enable,
 | |
| 	.disable	= quadfs_fsynth_disable,
 | |
| 	.is_enabled	= quadfs_fsynth_is_enabled,
 | |
| 	.round_rate	= quadfs_round_rate,
 | |
| 	.set_rate	= quadfs_set_rate,
 | |
| 	.recalc_rate	= quadfs_recalc_rate,
 | |
| };
 | |
| 
 | |
| static struct clk * __init st_clk_register_quadfs_fsynth(
 | |
| 		const char *name, const char *parent_name,
 | |
| 		struct clkgen_quadfs_data *quadfs, void __iomem *reg, u32 chan,
 | |
| 		spinlock_t *lock)
 | |
| {
 | |
| 	struct st_clk_quadfs_fsynth *fs;
 | |
| 	struct clk *clk;
 | |
| 	struct clk_init_data init;
 | |
| 
 | |
| 	/*
 | |
| 	 * Sanity check required pointers, note that nsdiv3 is optional.
 | |
| 	 */
 | |
| 	if (WARN_ON(!name || !parent_name))
 | |
| 		return ERR_PTR(-EINVAL);
 | |
| 
 | |
| 	fs = kzalloc(sizeof(*fs), GFP_KERNEL);
 | |
| 	if (!fs)
 | |
| 		return ERR_PTR(-ENOMEM);
 | |
| 
 | |
| 	init.name = name;
 | |
| 	init.ops = &st_quadfs_ops;
 | |
| 	init.flags = CLK_GET_RATE_NOCACHE | CLK_IS_BASIC;
 | |
| 	init.parent_names = &parent_name;
 | |
| 	init.num_parents = 1;
 | |
| 
 | |
| 	fs->data = quadfs;
 | |
| 	fs->regs_base = reg;
 | |
| 	fs->chan = chan;
 | |
| 	fs->lock = lock;
 | |
| 	fs->hw.init = &init;
 | |
| 
 | |
| 	clk = clk_register(NULL, &fs->hw);
 | |
| 
 | |
| 	if (IS_ERR(clk))
 | |
| 		kfree(fs);
 | |
| 
 | |
| 	return clk;
 | |
| }
 | |
| 
 | |
| static struct of_device_id quadfs_of_match[] = {
 | |
| 	{
 | |
| 		.compatible = "st,stih416-quadfs216",
 | |
| 		.data = &st_fs216c65_416
 | |
| 	},
 | |
| 	{
 | |
| 		.compatible = "st,stih416-quadfs432",
 | |
| 		.data = &st_fs432c65_416
 | |
| 	},
 | |
| 	{
 | |
| 		.compatible = "st,stih416-quadfs660-E",
 | |
| 		.data = &st_fs660c32_E_416
 | |
| 	},
 | |
| 	{
 | |
| 		.compatible = "st,stih416-quadfs660-F",
 | |
| 		.data = &st_fs660c32_F_416
 | |
| 	},
 | |
| 	{
 | |
| 		.compatible = "st,stih407-quadfs660-C",
 | |
| 		.data = &st_fs660c32_C_407
 | |
| 	},
 | |
| 	{
 | |
| 		.compatible = "st,stih407-quadfs660-D",
 | |
| 		.data = &st_fs660c32_D_407
 | |
| 	},
 | |
| 	{
 | |
| 		.compatible = "st,stih407-quadfs660-D",
 | |
| 		.data = (void *)&st_fs660c32_D_407
 | |
| 	},
 | |
| 	{}
 | |
| };
 | |
| 
 | |
| static void __init st_of_create_quadfs_fsynths(
 | |
| 		struct device_node *np, const char *pll_name,
 | |
| 		struct clkgen_quadfs_data *quadfs, void __iomem *reg,
 | |
| 		spinlock_t *lock)
 | |
| {
 | |
| 	struct clk_onecell_data *clk_data;
 | |
| 	int fschan;
 | |
| 
 | |
| 	clk_data = kzalloc(sizeof(*clk_data), GFP_KERNEL);
 | |
| 	if (!clk_data)
 | |
| 		return;
 | |
| 
 | |
| 	clk_data->clk_num = QUADFS_MAX_CHAN;
 | |
| 	clk_data->clks = kzalloc(QUADFS_MAX_CHAN * sizeof(struct clk *),
 | |
| 				 GFP_KERNEL);
 | |
| 
 | |
| 	if (!clk_data->clks) {
 | |
| 		kfree(clk_data);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	for (fschan = 0; fschan < QUADFS_MAX_CHAN; fschan++) {
 | |
| 		struct clk *clk;
 | |
| 		const char *clk_name;
 | |
| 
 | |
| 		if (of_property_read_string_index(np, "clock-output-names",
 | |
| 						  fschan, &clk_name)) {
 | |
| 			break;
 | |
| 		}
 | |
| 
 | |
| 		/*
 | |
| 		 * If we read an empty clock name then the channel is unused
 | |
| 		 */
 | |
| 		if (*clk_name == '\0')
 | |
| 			continue;
 | |
| 
 | |
| 		clk = st_clk_register_quadfs_fsynth(clk_name, pll_name,
 | |
| 				quadfs, reg, fschan, lock);
 | |
| 
 | |
| 		/*
 | |
| 		 * If there was an error registering this clock output, clean
 | |
| 		 * up and move on to the next one.
 | |
| 		 */
 | |
| 		if (!IS_ERR(clk)) {
 | |
| 			clk_data->clks[fschan] = clk;
 | |
| 			pr_debug("%s: parent %s rate %u\n",
 | |
| 				__clk_get_name(clk),
 | |
| 				__clk_get_name(clk_get_parent(clk)),
 | |
| 				(unsigned int)clk_get_rate(clk));
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	of_clk_add_provider(np, of_clk_src_onecell_get, clk_data);
 | |
| }
 | |
| 
 | |
| static void __init st_of_quadfs_setup(struct device_node *np)
 | |
| {
 | |
| 	const struct of_device_id *match;
 | |
| 	struct clk *clk;
 | |
| 	const char *pll_name, *clk_parent_name;
 | |
| 	void __iomem *reg;
 | |
| 	spinlock_t *lock;
 | |
| 
 | |
| 	match = of_match_node(quadfs_of_match, np);
 | |
| 	if (WARN_ON(!match))
 | |
| 		return;
 | |
| 
 | |
| 	reg = of_iomap(np, 0);
 | |
| 	if (!reg)
 | |
| 		return;
 | |
| 
 | |
| 	clk_parent_name = of_clk_get_parent_name(np, 0);
 | |
| 	if (!clk_parent_name)
 | |
| 		return;
 | |
| 
 | |
| 	pll_name = kasprintf(GFP_KERNEL, "%s.pll", np->name);
 | |
| 	if (!pll_name)
 | |
| 		return;
 | |
| 
 | |
| 	lock = kzalloc(sizeof(*lock), GFP_KERNEL);
 | |
| 	if (!lock)
 | |
| 		goto err_exit;
 | |
| 
 | |
| 	spin_lock_init(lock);
 | |
| 
 | |
| 	clk = st_clk_register_quadfs_pll(pll_name, clk_parent_name,
 | |
| 			(struct clkgen_quadfs_data *) match->data, reg, lock);
 | |
| 	if (IS_ERR(clk))
 | |
| 		goto err_exit;
 | |
| 	else
 | |
| 		pr_debug("%s: parent %s rate %u\n",
 | |
| 			__clk_get_name(clk),
 | |
| 			__clk_get_name(clk_get_parent(clk)),
 | |
| 			(unsigned int)clk_get_rate(clk));
 | |
| 
 | |
| 	st_of_create_quadfs_fsynths(np, pll_name,
 | |
| 				    (struct clkgen_quadfs_data *)match->data,
 | |
| 				    reg, lock);
 | |
| 
 | |
| err_exit:
 | |
| 	kfree(pll_name); /* No longer need local copy of the PLL name */
 | |
| }
 | |
| CLK_OF_DECLARE(quadfs, "st,quadfs", st_of_quadfs_setup);
 |