From 517d0eacb08e0a308dfe9edcc61e018827af11d0 Mon Sep 17 00:00:00 2001 From: weidongshan Date: Mon, 5 Jul 2021 10:33:19 +0800 Subject: [PATCH] add 08_Interrupt/17 --- .../Makefile | 21 ++ .../gpio_key_drv.c | 125 ++++++++++++ .../virtual_int_controller.c | 179 ++++++++++++++++++ .../virtual_intc.dts | 26 +++ README.md | 5 + .../08_Interrupt/12_GIC驱动程序分析.md | 81 -------- .../Makefile | 21 ++ .../gpio_key_drv.c | 125 ++++++++++++ .../virtual_int_controller.c | 179 ++++++++++++++++++ .../virtual_intc.dts | 26 +++ 10 files changed, 707 insertions(+), 81 deletions(-) create mode 100644 IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile create mode 100644 IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c create mode 100644 IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c create mode 100644 IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts delete mode 100644 STM32MP157/doc_pic/08_Interrupt/12_GIC驱动程序分析.md create mode 100644 STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile create mode 100644 STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c create mode 100644 STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c create mode 100644 STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts diff --git a/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile new file mode 100644 index 0000000..588910a --- /dev/null +++ b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile @@ -0,0 +1,21 @@ + +# 1. 使用不同的开发板内核时, 一定要修改KERN_DIR +# 2. KERN_DIR中的内核要事先配置、编译, 为了能编译内核, 要先设置下列环境变量: +# 2.1 ARCH, 比如: export ARCH=arm64 +# 2.2 CROSS_COMPILE, 比如: export CROSS_COMPILE=aarch64-linux-gnu- +# 2.3 PATH, 比如: export PATH=$PATH:/home/book/100ask_roc-rk3399-pc/ToolChain-6.3.1/gcc-linaro-6.3.1-2017.05-x86_64_aarch64-linux-gnu/bin +# 注意: 不同的开发板不同的编译器上述3个环境变量不一定相同, +# 请参考各开发板的高级用户使用手册 + +KERN_DIR = /home/book/100ask_imx6ull-sdk/Linux-4.9.88 + +all: + make -C $(KERN_DIR) M=`pwd` modules + +clean: + make -C $(KERN_DIR) M=`pwd` modules clean + rm -rf modules.order + +obj-m += virtual_int_controller.o +obj-m += gpio_key_drv.o + diff --git a/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c new file mode 100644 index 0000000..dfd7d26 --- /dev/null +++ b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c @@ -0,0 +1,125 @@ +#include + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + + +struct gpio_key{ + char name[100]; + int irq; + int cnt; +} ; + +static struct gpio_key gpio_keys_100ask[100]; + +static irqreturn_t gpio_key_isr(int irq, void *dev_id) +{ + struct gpio_key *gpio_key = dev_id; + + + printk("gpio_key_isr %s cnt %d\n", gpio_key->name, gpio_key->cnt++); + + return IRQ_HANDLED; +} + +/* 1. 从platform_device获得GPIO + * 2. gpio=>irq + * 3. request_irq + */ +static int gpio_key_probe(struct platform_device *pdev) +{ + int err; + int i = 0; + int irq; + + printk("%s %s line %d\n", __FILE__, __FUNCTION__, __LINE__); + + + while (1) + { + irq = platform_get_irq(pdev, i); + if (irq <= 0) + break; + gpio_keys_100ask[i].irq = irq; + sprintf(gpio_keys_100ask[i].name, "100as_virtual_key%d", i); + + err = devm_request_irq(&pdev->dev, gpio_keys_100ask[i].irq, gpio_key_isr, IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, gpio_keys_100ask[i].name, &gpio_keys_100ask[i]); + printk("devm_request_irq %d for %s, err = %d\n", irq, gpio_keys_100ask[i].name, err); + i++; + } + + return 0; + +} + +static int gpio_key_remove(struct platform_device *pdev) +{ + return 0; +} + + +static const struct of_device_id ask100_keys[] = { + { .compatible = "100ask,gpio_key" }, + { }, +}; + +/* 1. 定义platform_driver */ +static struct platform_driver gpio_keys_driver = { + .probe = gpio_key_probe, + .remove = gpio_key_remove, + .driver = { + .name = "100ask_gpio_key", + .of_match_table = ask100_keys, + }, +}; + +/* 2. 在入口函数注册platform_driver */ +static int __init gpio_key_init(void) +{ + int err; + + printk("%s %s line %d\n", __FILE__, __FUNCTION__, __LINE__); + + err = platform_driver_register(&gpio_keys_driver); + + return err; +} + +/* 3. 有入口函数就应该有出口函数：卸载驱动程序时，就会去调用这个出口函数 + * 卸载platform_driver + */ +static void __exit gpio_key_exit(void) +{ + printk("%s %s line %d\n", __FILE__, __FUNCTION__, __LINE__); + + platform_driver_unregister(&gpio_keys_driver); +} + + +/* 7. 其他完善：提供设备信息，自动创建设备节点 */ + +module_init(gpio_key_init); +module_exit(gpio_key_exit); + +MODULE_LICENSE("GPL"); + + diff --git a/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c new file mode 100644 index 0000000..5ce0433 --- /dev/null +++ b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c @@ -0,0 +1,179 @@ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +/* FIXME: for gpio_get_value() replace this with direct register read */ +#include +#include +#include +#include +#include + +static struct irq_domain *virtual_intc_domain; + +static int virtual_intc_get_hwirq(void) +{ + return get_random_int() & 0x3; +} + +static void virtual_intc_irq_handler(struct irq_desc *desc) +{ + /* 它的功能时分辨是哪一个hwirq, 调用对应的irq_desc[].handle_irq */ + int hwirq; + + struct irq_chip *chip = irq_desc_get_chip(desc); + + chained_irq_enter(chip, desc); + + /* a. 分辨中断 */ + hwirq = virtual_intc_get_hwirq(); + + /* b. 调用irq_desc[].handle_irq(handleC) */ + generic_handle_irq(irq_find_mapping(virtual_intc_domain, hwirq)); + + chained_irq_exit(chip, desc); +} + +static void virtual_intc_irq_ack(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_mask(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_mask_ack(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_unmask(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_eoi(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static struct irq_chip virtual_intc_irq_chip = { + .name = "100ask_virtual_intc", + .irq_ack = virtual_intc_irq_ack , + .irq_mask = virtual_intc_irq_mask , + .irq_mask_ack = virtual_intc_irq_mask_ack , + .irq_unmask = virtual_intc_irq_unmask , + .irq_eoi = virtual_intc_irq_eoi , +}; + +static int virtual_intc_irq_map(struct irq_domain *h, unsigned int virq, + irq_hw_number_t hw) +{ + /* 1. 给virq提供处理函数 + * 2. 提供irq_chip用来mask/unmask中断 + */ + + irq_set_chip_data(virq, h->host_data); + //irq_set_chip_and_handler(virq, &virtual_intc_irq_chip, handle_edge_irq); /* handle_edge_irq就是handleC */ + irq_set_chip_and_handler(virq, &virtual_intc_irq_chip, handle_level_irq); /* handle_level_irq就是handleC */ + //irq_set_nested_thread(virq, 1); + //irq_set_noprobe(virq); + + return 0; +} + + +static const struct irq_domain_ops virtual_intc_domain_ops = { + .xlate = irq_domain_xlate_onetwocell, + .map = virtual_intc_irq_map, +}; + +static int virtual_intc_probe(struct platform_device *pdev) +{ + struct device_node *np = pdev->dev.of_node; + int irq_to_parent; + //int irq_base; + + /* 1. virutal intc 会向GIC发出n号中断 */ + /* 1.1 从设备树里获得virq_n */ + irq_to_parent = platform_get_irq(pdev, 0); + printk("virtual_intc_probe irq_to_parent = %d\n", irq_to_parent); + + /* 1.2 设置它的irq_desc[].handle_irq, 它的功能时分辨是哪一个hwirq, 调用对应的irq_desc[].handle_irq */ + irq_set_chained_handler_and_data(irq_to_parent, virtual_intc_irq_handler, NULL); + + + /* 2. 分配/设置/注册一个irq_domain */ + //irq_base = irq_alloc_descs(-1, 0, 4, numa_node_id()); + //printk("virtual_intc_probe irq_base = %d\n", irq_base); + + /* Usage: + * a. dts: 定义使用哪个hwirq + * b. 内核解析设备树时分配irq_desc，得到virq + * c. (hwirq, virq) ==>存入domain + */ + + virtual_intc_domain = irq_domain_add_linear(np, 4, + &virtual_intc_domain_ops, NULL); + + return 0; +} +static int virtual_intc_remove(struct platform_device *pdev) +{ + return 0; +} + + + +static const struct of_device_id virtual_intc_of_match[] = { + { .compatible = "100ask,virtual_intc", }, + { }, +}; + + +static struct platform_driver virtual_intc_driver = { + .probe = virtual_intc_probe, + .remove = virtual_intc_remove, + .driver = { + .name = "100ask_virtual_intc", + .of_match_table = of_match_ptr(virtual_intc_of_match), + } +}; + + +/* 1. 入口函数 */ +static int __init virtual_intc_init(void) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); + /* 1.1 注册一个platform_driver */ + return platform_driver_register(&virtual_intc_driver); +} + + +/* 2. 出口函数 */ +static void __exit virtual_intc_exit(void) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); + /* 2.1 反注册platform_driver */ + platform_driver_unregister(&virtual_intc_driver); +} + +module_init(virtual_intc_init); +module_exit(virtual_intc_exit); + +MODULE_LICENSE("GPL"); + + diff --git a/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts new file mode 100644 index 0000000..47dfab5 --- /dev/null +++ b/IMX6ULL/source/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts @@ -0,0 +1,26 @@ + +#define n 100 + +/{ + virtual_intc: virtual_intc_100ask { + compatible = "100ask,virtual_intc"; + + interrupt-controller; + #interrupt-cells = <2>; + + interrupt-parent = <&intc>; + //interrupts = ; // stm32mp157 + interrupts = ; // imx6ull + + }; + + gpio_keys_100ask { + compatible = "100ask,gpio_key"; + interrupt-parent = <&virtual_intc>; + interrupts = <0 IRQ_TYPE_LEVEL_HIGH>, + <1 IRQ_TYPE_LEVEL_HIGH>, + <2 IRQ_TYPE_LEVEL_HIGH>, + <3 IRQ_TYPE_LEVEL_HIGH>; + }; + +}; diff --git a/README.md b/README.md index dfe0b65..36f9e99 100644 --- a/README.md +++ b/README.md @@ -299,6 +299,11 @@ git clone https://e.coding.net/weidongshan/linux/doc_and_source_for_drivers.git 16_legacy方式代码的上机实验 ``` +* 2021.07.05 发布"Interrupt子系统" + + ```shell + 17_链式中断控制器驱动程序编写_linear方式 + ``` diff --git a/STM32MP157/doc_pic/08_Interrupt/12_GIC驱动程序分析.md b/STM32MP157/doc_pic/08_Interrupt/12_GIC驱动程序分析.md deleted file mode 100644 index 90e42d4..0000000 --- a/STM32MP157/doc_pic/08_Interrupt/12_GIC驱动程序分析.md +++ /dev/null @@ -1,81 +0,0 @@ -## GIC驱动程序分析 - -参考资料： - -* [linux kernel的中断子系统之（七）：GIC代码分析](http://www.wowotech.net/irq_subsystem/gic_driver.html) - -### 1. 回顾 - - - -### 2. 函数调用过程 - -```c -start_kernel (init\main.c) - init_IRQ (arch\arm\kernel\irq.c) - irqchip_init (drivers\irqchip\irqchip.c) - of_irq_init (drivers\of\irq.c) - desc->irq_init_cb = match->data; - - ret = desc->irq_init_cb(desc->dev, - desc->interrupt_parent); - -``` - -#### 2.1 platform_driver支持多个device - -按照设备树的套路：驱动程序注册platform_driver，它的of_match_table里有多个of_device_id，表示能支持多个设备。 - -有多种版本的GIC，在内核为每一类GIC定义一个结构体of_device_id，并放在一个段里： - -```c -// drivers\irqchip\irq-gic.c -IRQCHIP_DECLARE(gic_400, "arm,gic-400", gic_of_init); -IRQCHIP_DECLARE(arm11mp_gic, "arm,arm11mp-gic", gic_of_init); -IRQCHIP_DECLARE(arm1176jzf_dc_gic, "arm,arm1176jzf-devchip-gic", gic_of_init); -IRQCHIP_DECLARE(cortex_a15_gic, "arm,cortex-a15-gic", gic_of_init); -IRQCHIP_DECLARE(cortex_a9_gic, "arm,cortex-a9-gic", gic_of_init); -IRQCHIP_DECLARE(cortex_a7_gic, "arm,cortex-a7-gic", gic_of_init); -IRQCHIP_DECLARE(msm_8660_qgic, "qcom,msm-8660-qgic", gic_of_init); -IRQCHIP_DECLARE(msm_qgic2, "qcom,msm-qgic2", gic_of_init); -IRQCHIP_DECLARE(pl390, "arm,pl390", gic_of_init); -``` - -把宏`IRQCHIP_DECLARE`展开： - -```c -// include\linux\irqchip.h -#define IRQCHIP_DECLARE(name, compat, fn) OF_DECLARE_2(irqchip, name, compat, fn) - -#define OF_DECLARE_2(table, name, compat, fn) \ - _OF_DECLARE(table, name, compat, fn, of_init_fn_2) - -#define _OF_DECLARE(table, name, compat, fn, fn_type) \ - static const struct of_device_id __of_table_##name \ - __used __section(__##table##_of_table) \ - = { .compatible = compat, \ - .data = (fn == (fn_type)NULL) ? fn : fn } -``` - -展开示例： - -```c -IRQCHIP_DECLARE(cortex_a7_gic, "arm,cortex-a7-gic", gic_of_init); -展开后得到： -static const struct of_device_id __of_table_cortex_a7_gic \ - __used __section(__irqchip_of_table) \ - = { .compatible = "arm,cortex-a7-gic", \ - .data = gic_of_init } -``` - - - -#### 2.2 没有定义platform_driver但是套路一样 - -`drivers\irqchip\irqchip.c`中并没有定义一个platform_driver，但是套路是一样的。 - -![image-20210626083319383](pic/08_Interrupt/058_irqchip_init.png) - -调用过程： - -![image-20210626084850583](pic/08_Interrupt/059_gic_init.png) \ No newline at end of file diff --git a/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile new file mode 100644 index 0000000..e957daf --- /dev/null +++ b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/Makefile @@ -0,0 +1,21 @@ + +# 1. 使用不同的开发板内核时, 一定要修改KERN_DIR +# 2. KERN_DIR中的内核要事先配置、编译, 为了能编译内核, 要先设置下列环境变量: +# 2.1 ARCH, 比如: export ARCH=arm64 +# 2.2 CROSS_COMPILE, 比如: export CROSS_COMPILE=aarch64-linux-gnu- +# 2.3 PATH, 比如: export PATH=$PATH:/home/book/100ask_roc-rk3399-pc/ToolChain-6.3.1/gcc-linaro-6.3.1-2017.05-x86_64_aarch64-linux-gnu/bin +# 注意: 不同的开发板不同的编译器上述3个环境变量不一定相同, +# 请参考各开发板的高级用户使用手册 + +KERN_DIR = /home/book/100ask_stm32mp157_pro-sdk/Linux-5.4 + +all: + make -C $(KERN_DIR) M=`pwd` modules + +clean: + make -C $(KERN_DIR) M=`pwd` modules clean + rm -rf modules.order + +obj-m += virtual_int_controller.o +obj-m += gpio_key_drv.o + diff --git a/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c new file mode 100644 index 0000000..dfd7d26 --- /dev/null +++ b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/gpio_key_drv.c @@ -0,0 +1,125 @@ +#include + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + + +struct gpio_key{ + char name[100]; + int irq; + int cnt; +} ; + +static struct gpio_key gpio_keys_100ask[100]; + +static irqreturn_t gpio_key_isr(int irq, void *dev_id) +{ + struct gpio_key *gpio_key = dev_id; + + + printk("gpio_key_isr %s cnt %d\n", gpio_key->name, gpio_key->cnt++); + + return IRQ_HANDLED; +} + +/* 1. 从platform_device获得GPIO + * 2. gpio=>irq + * 3. request_irq + */ +static int gpio_key_probe(struct platform_device *pdev) +{ + int err; + int i = 0; + int irq; + + printk("%s %s line %d\n", __FILE__, __FUNCTION__, __LINE__); + + + while (1) + { + irq = platform_get_irq(pdev, i); + if (irq <= 0) + break; + gpio_keys_100ask[i].irq = irq; + sprintf(gpio_keys_100ask[i].name, "100as_virtual_key%d", i); + + err = devm_request_irq(&pdev->dev, gpio_keys_100ask[i].irq, gpio_key_isr, IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, gpio_keys_100ask[i].name, &gpio_keys_100ask[i]); + printk("devm_request_irq %d for %s, err = %d\n", irq, gpio_keys_100ask[i].name, err); + i++; + } + + return 0; + +} + +static int gpio_key_remove(struct platform_device *pdev) +{ + return 0; +} + + +static const struct of_device_id ask100_keys[] = { + { .compatible = "100ask,gpio_key" }, + { }, +}; + +/* 1. 定义platform_driver */ +static struct platform_driver gpio_keys_driver = { + .probe = gpio_key_probe, + .remove = gpio_key_remove, + .driver = { + .name = "100ask_gpio_key", + .of_match_table = ask100_keys, + }, +}; + +/* 2. 在入口函数注册platform_driver */ +static int __init gpio_key_init(void) +{ + int err; + + printk("%s %s line %d\n", __FILE__, __FUNCTION__, __LINE__); + + err = platform_driver_register(&gpio_keys_driver); + + return err; +} + +/* 3. 有入口函数就应该有出口函数：卸载驱动程序时，就会去调用这个出口函数 + * 卸载platform_driver + */ +static void __exit gpio_key_exit(void) +{ + printk("%s %s line %d\n", __FILE__, __FUNCTION__, __LINE__); + + platform_driver_unregister(&gpio_keys_driver); +} + + +/* 7. 其他完善：提供设备信息，自动创建设备节点 */ + +module_init(gpio_key_init); +module_exit(gpio_key_exit); + +MODULE_LICENSE("GPL"); + + diff --git a/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c new file mode 100644 index 0000000..5ce0433 --- /dev/null +++ b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_int_controller.c @@ -0,0 +1,179 @@ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +/* FIXME: for gpio_get_value() replace this with direct register read */ +#include +#include +#include +#include +#include + +static struct irq_domain *virtual_intc_domain; + +static int virtual_intc_get_hwirq(void) +{ + return get_random_int() & 0x3; +} + +static void virtual_intc_irq_handler(struct irq_desc *desc) +{ + /* 它的功能时分辨是哪一个hwirq, 调用对应的irq_desc[].handle_irq */ + int hwirq; + + struct irq_chip *chip = irq_desc_get_chip(desc); + + chained_irq_enter(chip, desc); + + /* a. 分辨中断 */ + hwirq = virtual_intc_get_hwirq(); + + /* b. 调用irq_desc[].handle_irq(handleC) */ + generic_handle_irq(irq_find_mapping(virtual_intc_domain, hwirq)); + + chained_irq_exit(chip, desc); +} + +static void virtual_intc_irq_ack(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_mask(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_mask_ack(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_unmask(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static void virtual_intc_irq_eoi(struct irq_data *data) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); +} + +static struct irq_chip virtual_intc_irq_chip = { + .name = "100ask_virtual_intc", + .irq_ack = virtual_intc_irq_ack , + .irq_mask = virtual_intc_irq_mask , + .irq_mask_ack = virtual_intc_irq_mask_ack , + .irq_unmask = virtual_intc_irq_unmask , + .irq_eoi = virtual_intc_irq_eoi , +}; + +static int virtual_intc_irq_map(struct irq_domain *h, unsigned int virq, + irq_hw_number_t hw) +{ + /* 1. 给virq提供处理函数 + * 2. 提供irq_chip用来mask/unmask中断 + */ + + irq_set_chip_data(virq, h->host_data); + //irq_set_chip_and_handler(virq, &virtual_intc_irq_chip, handle_edge_irq); /* handle_edge_irq就是handleC */ + irq_set_chip_and_handler(virq, &virtual_intc_irq_chip, handle_level_irq); /* handle_level_irq就是handleC */ + //irq_set_nested_thread(virq, 1); + //irq_set_noprobe(virq); + + return 0; +} + + +static const struct irq_domain_ops virtual_intc_domain_ops = { + .xlate = irq_domain_xlate_onetwocell, + .map = virtual_intc_irq_map, +}; + +static int virtual_intc_probe(struct platform_device *pdev) +{ + struct device_node *np = pdev->dev.of_node; + int irq_to_parent; + //int irq_base; + + /* 1. virutal intc 会向GIC发出n号中断 */ + /* 1.1 从设备树里获得virq_n */ + irq_to_parent = platform_get_irq(pdev, 0); + printk("virtual_intc_probe irq_to_parent = %d\n", irq_to_parent); + + /* 1.2 设置它的irq_desc[].handle_irq, 它的功能时分辨是哪一个hwirq, 调用对应的irq_desc[].handle_irq */ + irq_set_chained_handler_and_data(irq_to_parent, virtual_intc_irq_handler, NULL); + + + /* 2. 分配/设置/注册一个irq_domain */ + //irq_base = irq_alloc_descs(-1, 0, 4, numa_node_id()); + //printk("virtual_intc_probe irq_base = %d\n", irq_base); + + /* Usage: + * a. dts: 定义使用哪个hwirq + * b. 内核解析设备树时分配irq_desc，得到virq + * c. (hwirq, virq) ==>存入domain + */ + + virtual_intc_domain = irq_domain_add_linear(np, 4, + &virtual_intc_domain_ops, NULL); + + return 0; +} +static int virtual_intc_remove(struct platform_device *pdev) +{ + return 0; +} + + + +static const struct of_device_id virtual_intc_of_match[] = { + { .compatible = "100ask,virtual_intc", }, + { }, +}; + + +static struct platform_driver virtual_intc_driver = { + .probe = virtual_intc_probe, + .remove = virtual_intc_remove, + .driver = { + .name = "100ask_virtual_intc", + .of_match_table = of_match_ptr(virtual_intc_of_match), + } +}; + + +/* 1. 入口函数 */ +static int __init virtual_intc_init(void) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); + /* 1.1 注册一个platform_driver */ + return platform_driver_register(&virtual_intc_driver); +} + + +/* 2. 出口函数 */ +static void __exit virtual_intc_exit(void) +{ + printk("%s %s %d\n", __FILE__, __FUNCTION__, __LINE__); + /* 2.1 反注册platform_driver */ + platform_driver_unregister(&virtual_intc_driver); +} + +module_init(virtual_intc_init); +module_exit(virtual_intc_exit); + +MODULE_LICENSE("GPL"); + + diff --git a/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts new file mode 100644 index 0000000..002089d --- /dev/null +++ b/STM32MP157/source/A7/08_Interrupt/05_virtual_int_controller_linear_ok/virtual_intc.dts @@ -0,0 +1,26 @@ + +#define n 100 + +/{ + virtual_intc: virtual_intc_100ask { + compatible = "100ask,virtual_intc"; + + interrupt-controller; + #interrupt-cells = <2>; + + interrupt-parent = <&intc>; + interrupts = ; // stm32mp157 + //interrupts = ; // imx6ull + + }; + + gpio_keys_100ask { + compatible = "100ask,gpio_key"; + interrupt-parent = <&virtual_intc>; + interrupts = <0 IRQ_TYPE_LEVEL_HIGH>, + <1 IRQ_TYPE_LEVEL_HIGH>, + <2 IRQ_TYPE_LEVEL_HIGH>, + <3 IRQ_TYPE_LEVEL_HIGH>; + }; + +};