// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright 2024 NXP
*/
#include <linux/clk.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/irqchip/chained_irq.h>
#include <linux/irqdomain.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <linux/regmap.h>
#define USERINTERRUPTMASK(n) (0 x8 + 4 * (n))
#define INTERRUPTENABLE(n) (0 x10 + 4 * (n))
#define INTERRUPTPRESET(n) (0 x18 + 4 * (n))
#define INTERRUPTCLEAR(n) (0 x20 + 4 * (n))
#define INTERRUPTSTATUS(n) (0 x28 + 4 * (n))
#define USERINTERRUPTENABLE(n) (0 x40 + 4 * (n))
#define USERINTERRUPTPRESET(n) (0 x48 + 4 * (n))
#define USERINTERRUPTCLEAR(n) (0 x50 + 4 * (n))
#define USERINTERRUPTSTATUS(n) (0 x58 + 4 * (n))
#define IRQ_COUNT 49
#define IRQ_RESERVED 35
#define REG_NUM 2
struct dc_ic_data {
struct regmap *regs;
struct clk *clk_axi;
int irq / SPDX/*
irq_domain * ;
} ;
struct dc_ic_entry {
struct dc_ic_data * * java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
int irq ;
} ;
static const struct regmap_range dc_ic_regmap_write_ranges [ ] = {
regmap_reg_range ( USERINTERRUPTMASK ( 0 ) , INTERRUPTCLEAR ( 1 ) ) ,
regmap_reg_range ( USERINTERRUPTENABLE ( 0 ) , USERINTERRUPTCLEAR ( 1 ) ) ,
} ;
static const struct regmap_access_table dc_ic_regmap_write_table = {
. yes_ranges = dc_ic_regmap_write_ranges ,
. n_yes_ranges = ARRAY_SIZE ( dc_ic_regmap_write_ranges ) ,
} ;
static const struct regmap_range dc_ic_regmap_read_ranges [ ] = {
regmap_reg_range ( USERINTERRUPTMASK ( 0 ) , INTERRUPTENABLE ( 1 ) ) ,
regmap_reg_range ( INTERRUPTSTATUS ( 0 ) , INTERRUPTSTATUS ( 1 ) ) ,
regmap_reg_range ( USERINTERRUPTENABLE ( 0 ) , USERINTERRUPTENABLE ( 1 ) ) ,
regmap_reg_range ( USERINTERRUPTSTATUS ( 0 ) , USERINTERRUPTSTATUS ( 1 ) ) ,
} ;
static const struct regmap_access_table dc_ic_regmap_read_table = {
. yes_ranges = dc_ic_regmap_read_ranges ,
. n_yes_ranges = ARRAY_SIZE ( dc_ic_regmap_read_ranges ) ,
} ;
static const struct regmap_range dc_ic_regmap_volatile_ranges [ ] = {
regmap_reg_range ( INTERRUPTPRESET ( 0 ) , INTERRUPTCLEAR ( 1 ) ) ,
regmap_reg_range ( USERINTERRUPTPRESET ( 0 ) , USERINTERRUPTCLEAR ( 1 ) ) ,
} ;
static const struct regmap_access_table dc_ic_regmap_volatile_table = {
. yes_ranges = dc_ic_regmap_volatile_ranges ,
. n_yes_ranges = ARRAY_SIZE ( dc_ic_regmap_volatile_ranges ) ,
} ;
static const struct regmap_config dc_ic_regmap_config = {
. reg_bits = 32 ,
. reg_stride = 4 ,
. val_bits = 32 ,
. fast_io = true ,
. wr_table = & dc_ic_regmap_write_table ,
. rd_table = & dc_ic_regmap_read_table ,
. volatile_table = & dc_ic_regmap_volatile_table ,
. max_register = USERINTERRUPTSTATUS ( 1 ) ,
} ;
static void dc_ic_irq_handler ( struct irq_desc * desc )
{
struct dc_ic_entry * entry = irq_desc_get_handler_data ( desc ) ;
struct dc_ic_data * data = entry - > data ;
unsigned int status , enable ;
unsigned int virq ;
chained_irq_enter ( irq_desc_get_chip ( desc ) , desc ) ;
regmap_read ( data - > regs , USERINTERRUPTSTATUS ( entry - > irq / 32 ) , & status ) ;
regmap_read ( data - > regs , USERINTERRUPTENABLE ( entry - > irq / 32 ) , & enable ) ;
status & = enable ;
if ( status & BIT ( entry - > irq % 32 ) ) {
virq = irq_find_mapping ( data - > domain , entry - > irq ) ;
if ( virq )
generic_handle_irq ( virq ) ;
}
chained_irq_exit ( irq_desc_get_chip ( desc ) , desc ) ;
}
static const unsigned long unused_irq [ REG_NUM ] = { 0 x00000000 , 0 xfffe0008 } ;
static int dc_ic_probe ( struct platform_device * pdev )
{
struct device * dev = & pdev - > dev ;
struct irq_chip_generic * gc ;
struct dc_ic_entry * entry ;
struct irq_chip_type * ct ;
struct dc_ic_data * data ;
void _ _ iomem * base ;
int i , ret ;
data = devm_kzalloc ( dev , sizeof ( * data ) , GFP_KERNEL ) ;
if ( ! data )
return - ENOMEM ;
entry = devm_kcalloc ( dev , IRQ_COUNT , sizeof ( * entry ) , GFP_KERNEL ) ;
if ( ! entry )
return - ENOMEM ;
base = devm_platform_ioremap_resource ( pdev , 0 ) ;
if ( IS_ERR ( base ) ) {
dev_err ( dev , " failed to initialize reg \ n " ) ;
return PTR_ERR ( base ) ;
}
data - > regs = devm_regmap_init_mmio ( dev , base , & dc_ic_regmap_config ) ;
if ( IS_ERR ( data - > regs ) )
return PTR_ERR ( data - > regs ) ;
data - > clk_axi = devm_clk_get ( dev , NULL ) ;
if ( IS_ERR ( data - > clk_axi ) )
return dev_err_probe ( dev , PTR_ERR ( data - > clk_axi ) ,
" failed to get AXI clock \ n " ) ;
for ( i = 0 ; i < IRQ_COUNT ; i + + ) {
/* skip the reserved IRQ */
if (i == IRQ_RESERVED)
continue ;
ret = platform_get_irq(pdev, i);
if (ret < 0 )
return ret;
}
dev_set_drvdata(dev, data);
ret = devm_pm_runtime_enable(dev);
if (ret)
return ret;
ret = pm_runtime_resume_and_get(dev);
if (ret < 0 ) {
dev_err(dev, "failed to get runtime PM sync: %d\n" , ret);
return ret;
}
for (i = 0 ; i < REG_NUM; i++) {
/* mask and clear all interrupts */
regmap_write(data->regs, USERINTERRUPTENABLE(i), 0 x0);
regmap_write(data->regs, INTERRUPTENABLE(i), 0 x0);
regmap_write(data->regs, USERINTERRUPTCLEAR(i), 0 xffffffff);
regmap_write(data->regs, INTERRUPTCLEAR(i), 0 xffffffff);
/* set all interrupts to user mode */
regmap_write(data->regs, USERINTERRUPTMASK(i), 0 xffffffff);
}
data->domain = irq_domain_add_linear(dev->of_node, IRQ_COUNT,
&irq_generic_chip_ops, data);
if (!data->domain) {
dev_err(dev, "failed to create IRQ domain\n" );
pm_runtime_put(dev);
return -ENOMEM;
}
irq_domain_set_pm_device(data->domain, dev);
ret = irq_alloc_domain_generic_chips(data->domain, 32 , 1 , "DC" ,
handle_level_irq, 0 , 0 , 0 );
if (ret) {
dev_err(dev, "failed to alloc generic IRQ chips: %d\n" , ret);
irq_domain_remove(data->domain);
pm_runtime_put(dev);
return ret;
}
for (i = 0 ; i < IRQ_COUNT; i += 32 ) {
gc = irq_get_domain_generic_chip(data->domain, i);
gc->reg_base = base;
gc->unused = unused_irq[i / 32 ];
ct = gc->chip_types;
ct->chip.irq_ack = irq_gc_ack_set_bit;
ct->chip.irq_mask = irq_gc_mask_clr_bit;
ct->chip.irq_unmask = irq_gc_mask_set_bit;
ct->regs.ack = USERINTERRUPTCLEAR(i / 32 );
ct->regs.mask = USERINTERRUPTENABLE(i / 32 );
}
for (i = 0 ; i < IRQ_COUNT; i++) {
/* skip the reserved IRQ */
if (i == IRQ_RESERVED)
continue ;
data->irq[i] = irq_of_parse_and_map(dev->of_node, i);
entry[i].data = data;
entry[i].irq = i;
irq_set_chained_handler_and_data(data->irq[i],
dc_ic_irq_handler, &entry[i]);
}
return 0 ;
}
static void dc_ic_remove(struct platform_device *pdev)
{
struct dc_ic_data *data = dev_get_drvdata(&pdev->dev);
int i;
for (i = 0 ; i < IRQ_COUNT; i++) {
if (i == IRQ_RESERVED)
continue ;
irq_set_chained_handler_and_data(data->irq[i], NULL, NULL);
}
irq_domain_remove(data->domain);
pm_runtime_put_sync(&pdev->dev);
}
static int dc_ic_runtime_suspend(struct device *dev)
{
struct dc_ic_data *data = dev_get_drvdata(dev);
clk_disable_unprepare(data->clk_axi);
return 0 ;
}
static int dc_ic_runtime_resume(struct device *dev)
{
struct dc_ic_data *data = dev_get_drvdata(dev);
int ret;
ret = clk_prepare_enable(data->clk_axi);
if (ret)
dev_err(dev, "failed to enable AXI clock: %d\n" , ret);
return ret;
}
static const struct dev_pm_ops dc_ic_pm_ops = {
SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
pm_runtime_force_resume)
RUNTIME_PM_OPS(dc_ic_runtime_suspend, dc_ic_runtime_resume, NULL)
};
static const struct of_device_id dc_ic_dt_ids[] = {
{ .compatible = "fsl,imx8qxp-dc-intc" , },
{ /* sentinel */ }
};
struct platform_driver dc_ic_driver = {
.probe = dc_ic_probe,
.remove = dc_ic_remove,
.driver = {
.name = "imx8-dc-intc" ,
.suppress_bind_attrs = true ,
.of_match_table = dc_ic_dt_ids,
.pm = pm_sleep_ptr(&dc_ic_pm_ops),
},
};
Messung V0.5 in Prozent C=97 H=95 G=95
¤ Die Informationen auf dieser Webseite wurden
nach bestem Wissen sorgfältig zusammengestellt. Es wird jedoch weder Vollständigkeit, noch Richtigkeit,
noch Qualität der bereit gestellten Informationen zugesichert.0.10Bemerkung:
¤
*Bot Zugriff