2019-05-27 08:55:01 +02:00
// SPDX-License-Identifier: GPL-2.0-or-later
2013-10-11 10:48:26 +02:00
/*
* Copyright ( C ) 2013 Boris BREZILLON < b . brezillon @ overkiz . com >
*/
# include <linux/clk-provider.h>
# include <linux/clkdev.h>
# include <linux/clk/at91_pmc.h>
# include <linux/of.h>
2014-09-07 08:14:29 +02:00
# include <linux/mfd/syscon.h>
# include <linux/regmap.h>
2013-10-11 10:48:26 +02:00
# include "pmc.h"
# define to_clk_plldiv(hw) container_of(hw, struct clk_plldiv, hw)
struct clk_plldiv {
struct clk_hw hw ;
2014-09-07 08:14:29 +02:00
struct regmap * regmap ;
2013-10-11 10:48:26 +02:00
} ;
static unsigned long clk_plldiv_recalc_rate ( struct clk_hw * hw ,
unsigned long parent_rate )
{
struct clk_plldiv * plldiv = to_clk_plldiv ( hw ) ;
2014-09-07 08:14:29 +02:00
unsigned int mckr ;
2013-10-11 10:48:26 +02:00
2014-09-07 08:14:29 +02:00
regmap_read ( plldiv - > regmap , AT91_PMC_MCKR , & mckr ) ;
if ( mckr & AT91_PMC_PLLADIV2 )
2013-10-11 10:48:26 +02:00
return parent_rate / 2 ;
return parent_rate ;
}
static long clk_plldiv_round_rate ( struct clk_hw * hw , unsigned long rate ,
unsigned long * parent_rate )
{
unsigned long div ;
if ( rate > * parent_rate )
return * parent_rate ;
div = * parent_rate / 2 ;
if ( rate < div )
return div ;
if ( rate - div < * parent_rate - rate )
return div ;
return * parent_rate ;
}
static int clk_plldiv_set_rate ( struct clk_hw * hw , unsigned long rate ,
unsigned long parent_rate )
{
struct clk_plldiv * plldiv = to_clk_plldiv ( hw ) ;
2014-09-07 08:14:29 +02:00
if ( ( parent_rate ! = rate ) & & ( parent_rate / 2 ! = rate ) )
2013-10-11 10:48:26 +02:00
return - EINVAL ;
2014-09-07 08:14:29 +02:00
regmap_update_bits ( plldiv - > regmap , AT91_PMC_MCKR , AT91_PMC_PLLADIV2 ,
parent_rate ! = rate ? AT91_PMC_PLLADIV2 : 0 ) ;
2013-10-11 10:48:26 +02:00
return 0 ;
}
static const struct clk_ops plldiv_ops = {
. recalc_rate = clk_plldiv_recalc_rate ,
. round_rate = clk_plldiv_round_rate ,
. set_rate = clk_plldiv_set_rate ,
} ;
2018-10-16 16:21:44 +02:00
struct clk_hw * __init
2014-09-07 08:14:29 +02:00
at91_clk_register_plldiv ( struct regmap * regmap , const char * name ,
2013-10-11 10:48:26 +02:00
const char * parent_name )
{
struct clk_plldiv * plldiv ;
2016-06-01 14:31:22 -07:00
struct clk_hw * hw ;
2013-10-11 10:48:26 +02:00
struct clk_init_data init ;
2016-06-01 14:31:22 -07:00
int ret ;
2013-10-11 10:48:26 +02:00
plldiv = kzalloc ( sizeof ( * plldiv ) , GFP_KERNEL ) ;
if ( ! plldiv )
return ERR_PTR ( - ENOMEM ) ;
init . name = name ;
init . ops = & plldiv_ops ;
init . parent_names = parent_name ? & parent_name : NULL ;
init . num_parents = parent_name ? 1 : 0 ;
init . flags = CLK_SET_RATE_GATE ;
plldiv - > hw . init = & init ;
2014-09-07 08:14:29 +02:00
plldiv - > regmap = regmap ;
2013-10-11 10:48:26 +02:00
2016-06-01 14:31:22 -07:00
hw = & plldiv - > hw ;
ret = clk_hw_register ( NULL , & plldiv - > hw ) ;
if ( ret ) {
2013-10-11 10:48:26 +02:00
kfree ( plldiv ) ;
2016-06-01 14:31:22 -07:00
hw = ERR_PTR ( ret ) ;
}
2013-10-11 10:48:26 +02:00
2016-06-01 14:31:22 -07:00
return hw ;
2013-10-11 10:48:26 +02:00
}