2013-12-02 15:07:02 +01:00
/*
* Copyright ( C ) 2013 Boris BREZILLON < b . brezillon @ overkiz . com >
*
* This program is free software ; you can redistribute it and / or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation ; either version 2 of the License , or
* ( at your option ) any later version .
*
*/
# include <linux/clk-provider.h>
# include <linux/clkdev.h>
# include <linux/clk/at91_pmc.h>
# include <linux/of.h>
# include <linux/of_address.h>
# include <linux/io.h>
# include <linux/interrupt.h>
# include <linux/irq.h>
# include <linux/irqchip/chained_irq.h>
# include <linux/irqdomain.h>
# include <linux/of_irq.h>
# include <asm/proc-fns.h>
# include "pmc.h"
void __iomem * at91_pmc_base ;
EXPORT_SYMBOL_GPL ( at91_pmc_base ) ;
2015-01-15 15:59:31 +01:00
void at91rm9200_idle ( void )
{
/*
* Disable the processor clock . The processor will be automatically
* re - enabled by an interrupt or by a reset .
*/
at91_pmc_write ( AT91_PMC_SCDR , AT91_PMC_PCK ) ;
}
2013-12-02 15:07:02 +01:00
void at91sam9_idle ( void )
{
at91_pmc_write ( AT91_PMC_SCDR , AT91_PMC_PCK ) ;
cpu_do_idle ( ) ;
}
int of_at91_get_clk_range ( struct device_node * np , const char * propname ,
struct clk_range * range )
{
u32 min , max ;
int ret ;
ret = of_property_read_u32_index ( np , propname , 0 , & min ) ;
if ( ret )
return ret ;
ret = of_property_read_u32_index ( np , propname , 1 , & max ) ;
if ( ret )
return ret ;
if ( range ) {
range - > min = min ;
range - > max = max ;
}
return 0 ;
}
EXPORT_SYMBOL_GPL ( of_at91_get_clk_range ) ;
static void pmc_irq_mask ( struct irq_data * d )
{
struct at91_pmc * pmc = irq_data_get_irq_chip_data ( d ) ;
pmc_write ( pmc , AT91_PMC_IDR , 1 < < d - > hwirq ) ;
}
static void pmc_irq_unmask ( struct irq_data * d )
{
struct at91_pmc * pmc = irq_data_get_irq_chip_data ( d ) ;
pmc_write ( pmc , AT91_PMC_IER , 1 < < d - > hwirq ) ;
}
static int pmc_irq_set_type ( struct irq_data * d , unsigned type )
{
if ( type ! = IRQ_TYPE_LEVEL_HIGH ) {
pr_warn ( " PMC: type not supported (support only IRQ_TYPE_LEVEL_HIGH type) \n " ) ;
return - EINVAL ;
}
return 0 ;
}
2015-03-02 10:18:16 +01:00
static void pmc_irq_suspend ( struct irq_data * d )
{
struct at91_pmc * pmc = irq_data_get_irq_chip_data ( d ) ;
pmc - > imr = pmc_read ( pmc , AT91_PMC_IMR ) ;
pmc_write ( pmc , AT91_PMC_IDR , pmc - > imr ) ;
}
static void pmc_irq_resume ( struct irq_data * d )
{
struct at91_pmc * pmc = irq_data_get_irq_chip_data ( d ) ;
pmc_write ( pmc , AT91_PMC_IER , pmc - > imr ) ;
}
2013-12-02 15:07:02 +01:00
static struct irq_chip pmc_irq = {
. name = " PMC " ,
. irq_disable = pmc_irq_mask ,
. irq_mask = pmc_irq_mask ,
. irq_unmask = pmc_irq_unmask ,
. irq_set_type = pmc_irq_set_type ,
2015-03-02 10:18:16 +01:00
. irq_suspend = pmc_irq_suspend ,
. irq_resume = pmc_irq_resume ,
2013-12-02 15:07:02 +01:00
} ;
static struct lock_class_key pmc_lock_class ;
static int pmc_irq_map ( struct irq_domain * h , unsigned int virq ,
irq_hw_number_t hw )
{
struct at91_pmc * pmc = h - > host_data ;
irq_set_lockdep_class ( virq , & pmc_lock_class ) ;
irq_set_chip_and_handler ( virq , & pmc_irq ,
handle_level_irq ) ;
irq_set_chip_data ( virq , pmc ) ;
return 0 ;
}
static int pmc_irq_domain_xlate ( struct irq_domain * d ,
struct device_node * ctrlr ,
const u32 * intspec , unsigned int intsize ,
irq_hw_number_t * out_hwirq ,
unsigned int * out_type )
{
struct at91_pmc * pmc = d - > host_data ;
const struct at91_pmc_caps * caps = pmc - > caps ;
if ( WARN_ON ( intsize < 1 ) )
return - EINVAL ;
* out_hwirq = intspec [ 0 ] ;
if ( ! ( caps - > available_irqs & ( 1 < < * out_hwirq ) ) )
return - EINVAL ;
* out_type = IRQ_TYPE_LEVEL_HIGH ;
return 0 ;
}
2015-04-27 21:52:38 +09:00
static const struct irq_domain_ops pmc_irq_ops = {
2013-12-02 15:07:02 +01:00
. map = pmc_irq_map ,
. xlate = pmc_irq_domain_xlate ,
} ;
static irqreturn_t pmc_irq_handler ( int irq , void * data )
{
struct at91_pmc * pmc = ( struct at91_pmc * ) data ;
unsigned long sr ;
int n ;
sr = pmc_read ( pmc , AT91_PMC_SR ) & pmc_read ( pmc , AT91_PMC_IMR ) ;
if ( ! sr )
return IRQ_NONE ;
for_each_set_bit ( n , & sr , BITS_PER_LONG )
generic_handle_irq ( irq_find_mapping ( pmc - > irqdomain , n ) ) ;
return IRQ_HANDLED ;
}
static const struct at91_pmc_caps at91rm9200_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_LOCKB |
AT91_PMC_MCKRDY | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY | AT91_PMC_PCK2RDY |
AT91_PMC_PCK3RDY ,
} ;
static const struct at91_pmc_caps at91sam9260_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_LOCKB |
AT91_PMC_MCKRDY | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY ,
} ;
static const struct at91_pmc_caps at91sam9g45_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY ,
} ;
static const struct at91_pmc_caps at91sam9n12_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_LOCKB |
AT91_PMC_MCKRDY | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY | AT91_PMC_MOSCSELS |
AT91_PMC_MOSCRCS | AT91_PMC_CFDEV ,
} ;
static const struct at91_pmc_caps at91sam9x5_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY | AT91_PMC_MOSCSELS |
AT91_PMC_MOSCRCS | AT91_PMC_CFDEV ,
} ;
2015-06-18 14:43:29 +02:00
static const struct at91_pmc_caps sama5d2_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY | AT91_PMC_PCK2RDY |
AT91_PMC_MOSCSELS | AT91_PMC_MOSCRCS |
AT91_PMC_CFDEV | AT91_PMC_GCKRDY ,
} ;
2013-12-02 15:07:02 +01:00
static const struct at91_pmc_caps sama5d3_caps = {
. available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
AT91_PMC_PCK1RDY | AT91_PMC_PCK2RDY |
AT91_PMC_MOSCSELS | AT91_PMC_MOSCRCS |
AT91_PMC_CFDEV ,
} ;
static struct at91_pmc * __init at91_pmc_init ( struct device_node * np ,
void __iomem * regbase , int virq ,
const struct at91_pmc_caps * caps )
{
struct at91_pmc * pmc ;
if ( ! regbase | | ! virq | | ! caps )
return NULL ;
at91_pmc_base = regbase ;
pmc = kzalloc ( sizeof ( * pmc ) , GFP_KERNEL ) ;
if ( ! pmc )
return NULL ;
spin_lock_init ( & pmc - > lock ) ;
pmc - > regbase = regbase ;
pmc - > virq = virq ;
pmc - > caps = caps ;
pmc - > irqdomain = irq_domain_add_linear ( np , 32 , & pmc_irq_ops , pmc ) ;
if ( ! pmc - > irqdomain )
goto out_free_pmc ;
pmc_write ( pmc , AT91_PMC_IDR , 0xffffffff ) ;
2015-03-02 10:18:16 +01:00
if ( request_irq ( pmc - > virq , pmc_irq_handler ,
IRQF_SHARED | IRQF_COND_SUSPEND , " pmc " , pmc ) )
2013-12-02 15:07:02 +01:00
goto out_remove_irqdomain ;
return pmc ;
out_remove_irqdomain :
irq_domain_remove ( pmc - > irqdomain ) ;
out_free_pmc :
kfree ( pmc ) ;
return NULL ;
}
2013-12-16 22:25:27 +01:00
static const struct of_device_id pmc_clk_ids [ ] __initconst = {
2014-05-07 18:02:15 +02:00
/* Slow oscillator */
{
. compatible = " atmel,at91sam9260-clk-slow " ,
. data = of_at91sam9260_clk_slow_setup ,
} ,
2013-10-11 10:44:49 +02:00
/* Main clock */
2014-05-07 18:00:08 +02:00
{
. compatible = " atmel,at91rm9200-clk-main-osc " ,
. data = of_at91rm9200_clk_main_osc_setup ,
} ,
{
. compatible = " atmel,at91sam9x5-clk-main-rc-osc " ,
. data = of_at91sam9x5_clk_main_rc_osc_setup ,
} ,
2013-10-11 10:44:49 +02:00
{
. compatible = " atmel,at91rm9200-clk-main " ,
. data = of_at91rm9200_clk_main_setup ,
} ,
2014-05-07 18:00:08 +02:00
{
. compatible = " atmel,at91sam9x5-clk-main " ,
. data = of_at91sam9x5_clk_main_setup ,
} ,
2013-10-11 10:48:26 +02:00
/* PLL clocks */
{
. compatible = " atmel,at91rm9200-clk-pll " ,
. data = of_at91rm9200_clk_pll_setup ,
} ,
{
. compatible = " atmel,at91sam9g45-clk-pll " ,
. data = of_at91sam9g45_clk_pll_setup ,
} ,
{
. compatible = " atmel,at91sam9g20-clk-pllb " ,
. data = of_at91sam9g20_clk_pllb_setup ,
} ,
{
. compatible = " atmel,sama5d3-clk-pll " ,
. data = of_sama5d3_clk_pll_setup ,
} ,
{
. compatible = " atmel,at91sam9x5-clk-plldiv " ,
. data = of_at91sam9x5_clk_plldiv_setup ,
} ,
2013-10-11 10:51:23 +02:00
/* Master clock */
{
. compatible = " atmel,at91rm9200-clk-master " ,
. data = of_at91rm9200_clk_master_setup ,
} ,
{
. compatible = " atmel,at91sam9x5-clk-master " ,
. data = of_at91sam9x5_clk_master_setup ,
} ,
2013-10-11 11:41:41 +02:00
/* System clocks */
{
. compatible = " atmel,at91rm9200-clk-system " ,
. data = of_at91rm9200_clk_sys_setup ,
} ,
2013-10-11 11:44:36 +02:00
/* Peripheral clocks */
{
. compatible = " atmel,at91rm9200-clk-peripheral " ,
. data = of_at91rm9200_clk_periph_setup ,
} ,
{
. compatible = " atmel,at91sam9x5-clk-peripheral " ,
. data = of_at91sam9x5_clk_periph_setup ,
} ,
2013-10-11 11:57:04 +02:00
/* Programmable clocks */
{
. compatible = " atmel,at91rm9200-clk-programmable " ,
. data = of_at91rm9200_clk_prog_setup ,
} ,
{
. compatible = " atmel,at91sam9g45-clk-programmable " ,
. data = of_at91sam9g45_clk_prog_setup ,
} ,
{
. compatible = " atmel,at91sam9x5-clk-programmable " ,
. data = of_at91sam9x5_clk_prog_setup ,
} ,
2013-10-11 12:22:06 +02:00
/* UTMI clock */
# if defined(CONFIG_HAVE_AT91_UTMI)
{
. compatible = " atmel,at91sam9x5-clk-utmi " ,
. data = of_at91sam9x5_clk_utmi_setup ,
} ,
2013-10-17 18:55:41 +02:00
# endif
/* USB clock */
# if defined(CONFIG_HAVE_AT91_USB_CLK)
{
. compatible = " atmel,at91rm9200-clk-usb " ,
. data = of_at91rm9200_clk_usb_setup ,
} ,
{
. compatible = " atmel,at91sam9x5-clk-usb " ,
. data = of_at91sam9x5_clk_usb_setup ,
} ,
{
. compatible = " atmel,at91sam9n12-clk-usb " ,
. data = of_at91sam9n12_clk_usb_setup ,
} ,
2013-10-11 13:27:06 +02:00
# endif
/* SMD clock */
# if defined(CONFIG_HAVE_AT91_SMD)
{
. compatible = " atmel,at91sam9x5-clk-smd " ,
. data = of_at91sam9x5_clk_smd_setup ,
} ,
2014-09-15 18:15:53 +02:00
# endif
# if defined(CONFIG_HAVE_AT91_H32MX)
{
. compatible = " atmel,sama5d4-clk-h32mx " ,
. data = of_sama5d4_clk_h32mx_setup ,
} ,
2015-07-31 11:43:12 +02:00
# endif
# if defined(CONFIG_HAVE_AT91_GENERATED_CLK)
{
. compatible = " atmel,sama5d2-clk-generated " ,
. data = of_sama5d2_clk_generated_setup ,
} ,
2013-10-11 11:57:04 +02:00
# endif
2013-12-02 15:07:02 +01:00
{ /*sentinel*/ }
} ;
static void __init of_at91_pmc_setup ( struct device_node * np ,
const struct at91_pmc_caps * caps )
{
struct at91_pmc * pmc ;
struct device_node * childnp ;
void ( * clk_setup ) ( struct device_node * , struct at91_pmc * ) ;
const struct of_device_id * clk_id ;
void __iomem * regbase = of_iomap ( np , 0 ) ;
int virq ;
if ( ! regbase )
return ;
virq = irq_of_parse_and_map ( np , 0 ) ;
if ( ! virq )
return ;
pmc = at91_pmc_init ( np , regbase , virq , caps ) ;
if ( ! pmc )
return ;
for_each_child_of_node ( np , childnp ) {
clk_id = of_match_node ( pmc_clk_ids , childnp ) ;
if ( ! clk_id )
continue ;
clk_setup = clk_id - > data ;
clk_setup ( childnp , pmc ) ;
}
}
static void __init of_at91rm9200_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & at91rm9200_caps ) ;
}
CLK_OF_DECLARE ( at91rm9200_clk_pmc , " atmel,at91rm9200-pmc " ,
of_at91rm9200_pmc_setup ) ;
static void __init of_at91sam9260_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & at91sam9260_caps ) ;
}
CLK_OF_DECLARE ( at91sam9260_clk_pmc , " atmel,at91sam9260-pmc " ,
of_at91sam9260_pmc_setup ) ;
static void __init of_at91sam9g45_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & at91sam9g45_caps ) ;
}
CLK_OF_DECLARE ( at91sam9g45_clk_pmc , " atmel,at91sam9g45-pmc " ,
of_at91sam9g45_pmc_setup ) ;
static void __init of_at91sam9n12_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & at91sam9n12_caps ) ;
}
CLK_OF_DECLARE ( at91sam9n12_clk_pmc , " atmel,at91sam9n12-pmc " ,
of_at91sam9n12_pmc_setup ) ;
static void __init of_at91sam9x5_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & at91sam9x5_caps ) ;
}
CLK_OF_DECLARE ( at91sam9x5_clk_pmc , " atmel,at91sam9x5-pmc " ,
of_at91sam9x5_pmc_setup ) ;
2015-06-18 14:43:29 +02:00
static void __init of_sama5d2_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & sama5d2_caps ) ;
}
CLK_OF_DECLARE ( sama5d2_clk_pmc , " atmel,sama5d2-pmc " ,
of_sama5d2_pmc_setup ) ;
2013-12-02 15:07:02 +01:00
static void __init of_sama5d3_pmc_setup ( struct device_node * np )
{
of_at91_pmc_setup ( np , & sama5d3_caps ) ;
}
CLK_OF_DECLARE ( sama5d3_clk_pmc , " atmel,sama5d3-pmc " ,
of_sama5d3_pmc_setup ) ;