mirror of
https://e.coding.net/weidongshan/linux/doc_and_source_for_drivers.git
synced 2025-12-01 20:31:18 +08:00
add 08_Interrupt/17
This commit is contained in:
@@ -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
|
||||
|
||||
@@ -0,0 +1,125 @@
|
||||
#include <linux/module.h>
|
||||
|
||||
#include <linux/fs.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/major.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/seq_file.h>
|
||||
#include <linux/stat.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/tty.h>
|
||||
#include <linux/kmod.h>
|
||||
#include <linux/gfp.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#include <linux/of_irq.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/slab.h>
|
||||
|
||||
|
||||
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");
|
||||
|
||||
|
||||
@@ -0,0 +1,179 @@
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/random.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/irqdomain.h>
|
||||
#include <linux/irqchip/chained_irq.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/pm_runtime.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/gpio/driver.h>
|
||||
/* FIXME: for gpio_get_value() replace this with direct register read */
|
||||
#include <linux/gpio.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/bug.h>
|
||||
#include <linux/random.h>
|
||||
|
||||
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");
|
||||
|
||||
|
||||
@@ -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 = <GIC_SPI 210 IRQ_TYPE_LEVEL_HIGH>; // stm32mp157
|
||||
interrupts = <GIC_SPI 122 IRQ_TYPE_LEVEL_HIGH>; // 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>;
|
||||
};
|
||||
|
||||
};
|
||||
@@ -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方式
|
||||
```
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -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,但是套路是一样的。
|
||||
|
||||

|
||||
|
||||
调用过程:
|
||||
|
||||

|
||||
@@ -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
|
||||
|
||||
@@ -0,0 +1,125 @@
|
||||
#include <linux/module.h>
|
||||
|
||||
#include <linux/fs.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/major.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/seq_file.h>
|
||||
#include <linux/stat.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/tty.h>
|
||||
#include <linux/kmod.h>
|
||||
#include <linux/gfp.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#include <linux/of_irq.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/slab.h>
|
||||
|
||||
|
||||
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");
|
||||
|
||||
|
||||
@@ -0,0 +1,179 @@
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/random.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/irqdomain.h>
|
||||
#include <linux/irqchip/chained_irq.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/pm_runtime.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/gpio/driver.h>
|
||||
/* FIXME: for gpio_get_value() replace this with direct register read */
|
||||
#include <linux/gpio.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/bug.h>
|
||||
#include <linux/random.h>
|
||||
|
||||
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");
|
||||
|
||||
|
||||
@@ -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 = <GIC_SPI 210 IRQ_TYPE_LEVEL_HIGH>; // stm32mp157
|
||||
//interrupts = <GIC_SPI 122 IRQ_TYPE_LEVEL_HIGH>; // 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>;
|
||||
};
|
||||
|
||||
};
|
||||
Reference in New Issue
Block a user