目錄

一、ID匹配之框架代碼

二、ID匹配之led驅(qū)動(dòng)???????

三、設(shè)備樹匹配

四、設(shè)備樹匹配之led驅(qū)動(dòng)

五、一個(gè)編寫驅(qū)動(dòng)用的宏

---

一、ID匹配之框架代碼

id匹配（可想象成八字匹配）：一個(gè)驅(qū)動(dòng)可以對(duì)應(yīng)多個(gè)設(shè)備 ------優(yōu)先級(jí)次低

注意事項(xiàng)：

1. ?device模塊中，id的name成員必須與struct platform_device中的name成員內(nèi)容一致，因此device模塊中，struct platform_device中的name成員必須指定

2. ?driver模塊中，struct platform_driver成員driver的name成員必須指定，但與device模塊中name可以不相同

```c/*platform device框架*/#include <linux/module.h>#include <linux/kernel.h>#include <linux/init.h>#include <linux/platform_device.h>//定義資源數(shù)組static void device_release(struct device *dev){printk("platform: device release\n");}struct platform_device_id test_id = {.name = "test_device",};struct platform_device test_device = {.name = "test_device",//必須初始化.dev.release = device_release,.id_entry = &test_id,};static int __init platform_device_init(void){platform_device_register(&test_device);return 0;}static void __exit platform_device_exit(void){platform_device_unregister(&test_device);}module_init(platform_device_init);module_exit(platform_device_exit);MODULE_LICENSE("Dual BSD/GPL");```

```c/*platform driver框架*/#include <linux/module.h>#include <linux/kernel.h>#include <linux/init.h>#include <linux/platform_device.h>static int driver_probe(struct platform_device *dev){printk("platform: match ok!\n");return 0;}static int driver_remove(struct platform_device *dev){printk("platform: driver remove\n");return 0;}struct platform_device_id testdrv_ids[] ={[0] = {.name = "test_device"},[1] = {.name = "abcxyz"},[2] = {}, //means ending};struct platform_driver test_driver = {.probe = driver_probe,.remove = driver_remove,.driver = {.name = "xxxxx", //必須初始化},.id_table = testdrv_ids,};static int __init platform_driver_init(void){platform_driver_register(&test_driver);return 0;}static void __exit platform_driver_exit(void){platform_driver_unregister(&test_driver);}module_init(platform_driver_init);module_exit(platform_driver_exit);MODULE_LICENSE("Dual BSD/GPL");```

用到結(jié)構(gòu)體數(shù)組，一般不指定大小，初始化時(shí)最后加{}表示數(shù)組結(jié)束

設(shè)備中增加資源，驅(qū)動(dòng)中訪問資源

?

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>static void hello_device_release(struct device *dev)
{printk("platform:device release\n");
}struct resource hello_dev_res [] =
{[0] = {.start = 0x1000, .end=0x1003, .name="reg1", .flags = IORESOURCE_MEM},[1] = {.start = 0x2000, .end=0x2003, .name="reg2", .flags = IORESOURCE_MEM},[2] = {.start = 10, .end=10, .name="irq1", .flags = IORESOURCE_IRQ},[3] = {.start = 0x3000, .end=0x3003, .name="reg3", .flags = IORESOURCE_MEM},[4] = {.start = 100, .end=100, .name="irq2", .flags = IORESOURCE_IRQ},[5] = {.start = 62, .end=62, .name="irq3", .flags = IORESOURCE_IRQ},
};struct platform_device_id hello_id = {.name = "hello",
};struct platform_device hello_device =
{.name = "hello",.dev.release = hello_device_release,.resource = hello_dev_res,.num_resources = ARRAY_SIZE(hello_dev_res),.id_entry = &hello_id,
};int __init hello_device_init(void)
{platform_device_register(&hello_device);return 0;
}
void __exit hello_device_exit(void)
{platform_device_unregister(&hello_device);
}
MODULE_LICENSE("GPL");
module_init(hello_device_init);
module_exit(hello_device_exit);

?

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>int hello_driver_probe(struct platform_device *p_pltdev)
{struct resource *pres = NULL;printk("hellio_driver_probe is called\n");pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,2);printk("res.start = 0x%x\n",(unsigned int)pres->start);pres = platform_get_resource(p_pltdev,IORESOURCE_IRQ,1);printk("res.start = %d\n",(int)pres->start);return 0;
}int hello_driver_remove(struct platform_device *p_pltdev)
{printk("hellio_driver_remove is called\n");return 0;
}struct platform_device_id hellodrv_ids[] = 
{[0] = {.name = "hello"},[1] = {.name = "xyz"},[2] = {}
};struct platform_driver hello_driver =
{.driver.name = "abc",.probe = hello_driver_probe,.remove = hello_driver_remove,.id_table = hellodrv_ids,
};int __init hello_driver_init(void)
{platform_driver_register(&hello_driver);return 0;
}
void __exit hello_driver_exit(void)
{platform_driver_unregister(&hello_driver);
}
MODULE_LICENSE("GPL");
module_init(hello_driver_init);
module_exit(hello_driver_exit);

二、ID匹配之led驅(qū)動(dòng)

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>#define GPX1CON 0x11000C20
#define GPX1DAT 0x11000C24#define GPX2CON 0x11000C40
#define GPX2DAT 0x11000C44#define GPF3CON 0x114001E0
#define GPF3DAT 0x114001E4
void fs4412leds_dev_release(struct device *pdev)
{printk("fs4412leds_dev_release is called\n");
}struct resource fs4412leds_dev_res [] =
{[0] = {.start = GPX1CON,.end=GPX1CON + 3,.name="GPX1CON",.flags = IORESOURCE_MEM},[1] = {.start = GPX1DAT,.end=GPX1DAT + 3,.name="GPX1DAT",.flags = IORESOURCE_MEM},[2] = {.start = GPX2CON,.end=GPX2CON + 3,.name="GPX2CON",.flags = IORESOURCE_MEM},[3] = {.start = GPX2DAT,.end=GPX2DAT + 3,.name="GPX2DAT",.flags = IORESOURCE_MEM},[4] = {.start = GPF3CON,.end=GPF3CON + 3,.name="GPF3CON",.flags = IORESOURCE_MEM},[5] = {.start = GPF3DAT,.end=GPF3DAT + 3,.name="GPF3DAT",.flags = IORESOURCE_MEM},
};struct platform_device_id led_id = {.name = "fs4412leds",
};struct platform_device fs4412leds_device = 
{.name = "fs4412leds",.dev.release = fs4412leds_dev_release,.resource = fs4412leds_dev_res,.num_resources = ARRAY_SIZE(fs4412leds_dev_res),.id_entry = &led_id,
};int __init fs4412leds_device_init(void)
{platform_device_register(&fs4412leds_device);return 0;
}void __exit fs4412leds_device_exit(void)
{platform_device_unregister(&fs4412leds_device);
}MODULE_LICENSE("GPL");
module_init(fs4412leds_device_init);
module_exit(fs4412leds_device_exit);

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>
#include <linux/fs.h>
#include <linux/cdev.h>
#include <linux/wait.h>
#include <linux/sched.h>
#include <linux/poll.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/io.h>
#include <asm/uaccess.h>
#include <asm/atomic.h>#include "leddrv.h"int major = 11;
int minor = 0;
int myled_num  = 1;struct myled_dev
{struct cdev mydev;volatile unsigned long *pled2_con;volatile unsigned long *pled2_dat;volatile unsigned long *pled3_con;volatile unsigned long *pled3_dat;volatile unsigned long *pled4_con;volatile unsigned long *pled4_dat;volatile unsigned long *pled5_con;volatile unsigned long *pled5_dat;
};struct myled_dev *pgmydev = NULL;int myled_open(struct inode *pnode,struct file *pfile)
{pfile->private_data =(void *) (container_of(pnode->i_cdev,struct myled_dev,mydev));return 0;
}int myled_close(struct inode *pnode,struct file *pfile)
{return 0;
}void led_on(struct myled_dev *pmydev,int ledno)
{switch(ledno){case 2:writel(readl(pmydev->pled2_dat) | (0x1 << 7),pmydev->pled2_dat);break;case 3:writel(readl(pmydev->pled3_dat) | (0x1),pmydev->pled3_dat);break;case 4:writel(readl(pmydev->pled4_dat) | (0x1 << 4),pmydev->pled4_dat);break;case 5:writel(readl(pmydev->pled5_dat) | (0x1 << 5),pmydev->pled5_dat);break;}
}void led_off(struct myled_dev *pmydev,int ledno)
{switch(ledno){case 2:writel(readl(pmydev->pled2_dat) & (~(0x1 << 7)),pmydev->pled2_dat);break;case 3:writel(readl(pmydev->pled3_dat) & (~(0x1)),pmydev->pled3_dat);break;case 4:writel(readl(pmydev->pled4_dat) & (~(0x1 << 4)),pmydev->pled4_dat);break;case 5:writel(readl(pmydev->pled5_dat) & (~(0x1 << 5)),pmydev->pled5_dat);break;}
}long myled_ioctl(struct file *pfile,unsigned int cmd,unsigned long arg)
{struct myled_dev *pmydev = (struct myled_dev *)pfile->private_data;if(arg < 2 || arg > 5){return -1;}switch(cmd){case MY_LED_ON:led_on(pmydev,arg);break;case MY_LED_OFF:led_off(pmydev,arg);break;default:return -1;}return 0;
}struct file_operations myops = {.owner = THIS_MODULE,.open = myled_open,.release = myled_close,.unlocked_ioctl = myled_ioctl,
};void ioremap_ledreg(struct myled_dev *pmydev,struct platform_device *p_pltdev)
{struct resource *pres = NULL;pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,2);pmydev->pled2_con = ioremap(pres->start,4);pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,3);pmydev->pled2_dat = ioremap(pres->start,4);pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,0);pmydev->pled3_con = ioremap(pres->start,4);pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,1);pmydev->pled3_dat = ioremap(pres->start,4);pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,4);pmydev->pled4_con = ioremap(pres->start,4);pres = platform_get_resource(p_pltdev,IORESOURCE_MEM,5);pmydev->pled4_dat = ioremap(pres->start,4);pmydev->pled5_con = pmydev->pled4_con;pmydev->pled5_dat = pmydev->pled4_dat;
}void set_output_ledconreg(struct myled_dev *pmydev)
{writel((readl(pmydev->pled2_con) & (~(0xF << 28))) | (0x1 << 28),pmydev->pled2_con);writel((readl(pmydev->pled3_con) & (~(0xF))) | (0x1),pmydev->pled3_con);writel((readl(pmydev->pled4_con) & (~(0xF << 16))) | (0x1 << 16),pmydev->pled4_con);writel((readl(pmydev->pled5_con) & (~(0xF << 20))) | (0x1 << 20),pmydev->pled5_con);writel(readl(pmydev->pled2_dat) & (~(0x1 << 7)),pmydev->pled2_dat);writel(readl(pmydev->pled3_dat) & (~(0x1)),pmydev->pled3_dat);writel(readl(pmydev->pled4_dat) & (~(0x1 << 4)),pmydev->pled4_dat);writel(readl(pmydev->pled5_dat) & (~(0x1 << 5)),pmydev->pled5_dat);
}void iounmap_ledreg(struct myled_dev *pmydev)
{iounmap(pmydev->pled2_con);pmydev->pled2_con = NULL;iounmap(pmydev->pled2_dat);pmydev->pled2_dat = NULL;iounmap(pmydev->pled3_con);pmydev->pled3_con = NULL;iounmap(pmydev->pled3_dat);pmydev->pled3_dat = NULL;iounmap(pmydev->pled4_con);pmydev->pled4_con = NULL;iounmap(pmydev->pled4_dat);pmydev->pled4_dat = NULL;pmydev->pled5_con = NULL;pmydev->pled5_dat = NULL;
}int fs4412leds_driver_probe(struct platform_device *p_pltdev)
{int ret = 0;dev_t devno = MKDEV(major,minor);/*申請(qǐng)?jiān)O(shè)備號(hào)*/ret = register_chrdev_region(devno,myled_num,"myled");if(ret){ret = alloc_chrdev_region(&devno,minor,myled_num,"myled");if(ret){printk("get devno failed\n");return -1;}major = MAJOR(devno);//容易遺漏，注意}pgmydev = (struct myled_dev *)kmalloc(sizeof(struct myled_dev),GFP_KERNEL);if(NULL == pgmydev){unregister_chrdev_region(devno,myled_num);printk("kmalloc failed\n");return -1;}memset(pgmydev,0,sizeof(struct myled_dev));/*給struct cdev對(duì)象指定操作函數(shù)集*/	cdev_init(&pgmydev->mydev,&myops);/*將struct cdev對(duì)象添加到內(nèi)核對(duì)應(yīng)的數(shù)據(jù)結(jié)構(gòu)里*/pgmydev->mydev.owner = THIS_MODULE;cdev_add(&pgmydev->mydev,devno,myled_num);/*ioremap*/ioremap_ledreg(pgmydev,p_pltdev);/*con-register set output*/set_output_ledconreg(pgmydev);return 0;
}int fs4412leds_driver_remove(struct platform_device *p_pltdev)
{dev_t devno = MKDEV(major,minor);/*iounmap*/iounmap_ledreg(pgmydev);cdev_del(&pgmydev->mydev);unregister_chrdev_region(devno,myled_num);kfree(pgmydev);pgmydev = NULL;return 0;
}struct platform_device_id leddrv_ids[] =
{[0] = {.name = "fs4412leds"},[1] = {.name = "xyz"},[2] = {}
};struct platform_driver fs4412leds_driver = 
{.driver.name = "leds",.probe = fs4412leds_driver_probe,.remove = fs4412leds_driver_remove,.id_table = leddrv_ids,
};int __init fs4412leds_driver_init(void)
{platform_driver_register(&fs4412leds_driver);return 0;
}void __exit fs4412leds_driver_exit(void)
{platform_driver_unregister(&fs4412leds_driver);
}MODULE_LICENSE("GPL");module_init(fs4412leds_driver_init);
module_exit(fs4412leds_driver_exit);

#ifndef LED_DRIVER_H
#define LED_DRIVER_H#define LED_DEV_MAGIC 'g'#define MY_LED_OFF _IO(LED_DEV_MAGIC,0)
#define MY_LED_ON _IO(LED_DEV_MAGIC,1)#endif

#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <unistd.h>#include <stdio.h>#include "leddrv.h"int main(int argc,char *argv[])
{int fd = -1;int onoff = 0;int no = 0;if(argc < 4){printf("The argument is too few\n");return 1;}sscanf(argv[2],"%d",&onoff);sscanf(argv[3],"%d",&no);if(no < 2 || no > 5){printf("len-no is invalid\n");return 2;}fd = open(argv[1],O_RDONLY);if(fd < 0){printf("open %s failed\n",argv[1]);return 3;}if(onoff){ioctl(fd,MY_LED_ON,no);}else{ioctl(fd,MY_LED_OFF,no);}close(fd);fd = -1;return 0;
}

三、設(shè)備樹匹配

設(shè)備樹匹配：內(nèi)核啟動(dòng)時(shí)根據(jù)設(shè)備樹自動(dòng)產(chǎn)生的設(shè)備 ------ 優(yōu)先級(jí)最高

注意事項(xiàng)：

1. 無需編寫device模塊，只需編寫driver模塊

2. 使用compatible屬性進(jìn)行匹配，注意設(shè)備樹中compatible屬性值不要包含空白字符

3. id_table可不設(shè)置，但struct platform_driver成員driver的name成員必須設(shè)置

```c
/*platform driver框架*/
#include <linux/module.h> 
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>static int driver_probe(struct platform_device *dev)
{printk("platform: match ok!\n");return 0;
}static int driver_remove(struct platform_device *dev)
{printk("platform: driver remove\n");return 0;
}struct platform_device_id testdrv_ids[] = 
{[0] = {.name = "test_device"},[1] = {.name = "abcxyz"},[2] = {}, //means ending
};struct of_device_id test_of_ids[] = 
{[0] = {.compatible = "xyz,abc"},[1] = {.compatible = "qwe,opq"},[2] = {},
};struct platform_driver test_driver = {.probe = driver_probe,.remove = driver_remove,.driver = {.name = "xxxxx", //必須初始化.of_match_table = test_of_ids,},
};static int __init platform_driver_init(void)
{platform_driver_register(&test_driver);return 0;
}static void __exit platform_driver_exit(void)
{platform_driver_unregister(&test_driver);
}module_init(platform_driver_init);
module_exit(platform_driver_exit);
MODULE_LICENSE("Dual BSD/GPL");
```

四、設(shè)備樹匹配之led驅(qū)動(dòng)

?

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>
#include <linux/fs.h>
#include <linux/gpio.h>
#include <linux/of_gpio.h>
#include <linux/cdev.h>
#include <linux/wait.h>
#include <linux/sched.h>
#include <linux/poll.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/io.h>
#include <asm/uaccess.h>
#include <asm/atomic.h>#include "leddrv.h"int major = 11;
int minor = 0;
int myled_num  = 1;struct myled_dev
{struct cdev mydev;unsigned int led2gpio;unsigned int led3gpio;unsigned int led4gpio;unsigned int led5gpio;
};struct myled_dev *pgmydev = NULL;int myled_open(struct inode *pnode,struct file *pfile)
{pfile->private_data =(void *) (container_of(pnode->i_cdev,struct myled_dev,mydev));return 0;
}int myled_close(struct inode *pnode,struct file *pfile)
{return 0;
}void led_on(struct myled_dev *pmydev,int ledno)
{switch(ledno){case 2:gpio_set_value(pmydev->led2gpio,1);break;case 3:gpio_set_value(pmydev->led3gpio,1);break;case 4:gpio_set_value(pmydev->led4gpio,1);break;case 5:gpio_set_value(pmydev->led5gpio,1);break;}
}void led_off(struct myled_dev *pmydev,int ledno)
{switch(ledno){case 2:gpio_set_value(pmydev->led2gpio,0);break;case 3:gpio_set_value(pmydev->led3gpio,0);break;case 4:gpio_set_value(pmydev->led4gpio,0);break;case 5:gpio_set_value(pmydev->led5gpio,0);break;}
}long myled_ioctl(struct file *pfile,unsigned int cmd,unsigned long arg)
{struct myled_dev *pmydev = (struct myled_dev *)pfile->private_data;if(arg < 2 || arg > 5){return -1;}switch(cmd){case MY_LED_ON:led_on(pmydev,arg);break;case MY_LED_OFF:led_off(pmydev,arg);break;default:return -1;}return 0;
}struct file_operations myops = {.owner = THIS_MODULE,.open = myled_open,.release = myled_close,.unlocked_ioctl = myled_ioctl,
};void request_leds_gpio(struct myled_dev *pmydev,struct device_node *pnode)
{pmydev->led2gpio = of_get_named_gpio(pnode,"led2-gpio",0);gpio_request(pmydev->led2gpio,"led2");pmydev->led3gpio = of_get_named_gpio(pnode,"led3-gpio",0);gpio_request(pmydev->led3gpio,"led3");pmydev->led4gpio = of_get_named_gpio(pnode,"led4-gpio",0);gpio_request(pmydev->led4gpio,"led4");pmydev->led5gpio = of_get_named_gpio(pnode,"led5-gpio",0);gpio_request(pmydev->led5gpio,"led5");
}void set_leds_gpio_output(struct myled_dev *pmydev)
{gpio_direction_output(pmydev->led2gpio,0);gpio_direction_output(pmydev->led3gpio,0);gpio_direction_output(pmydev->led4gpio,0);gpio_direction_output(pmydev->led5gpio,0);
}void free_leds_gpio(struct myled_dev *pmydev)
{gpio_free(pmydev->led2gpio);gpio_free(pmydev->led3gpio);gpio_free(pmydev->led4gpio);gpio_free(pmydev->led5gpio);
}int myled_probe(struct platform_device *p_pltdev)
{int ret = 0;dev_t devno = MKDEV(major,minor);struct device_node *pnode = NULL;/*申請(qǐng)?jiān)O(shè)備號(hào)*/ret = register_chrdev_region(devno,myled_num,"myled");if(ret){ret = alloc_chrdev_region(&devno,minor,myled_num,"myled");if(ret){printk("get devno failed\n");return -1;}major = MAJOR(devno);//容易遺漏，注意}pgmydev = (struct myled_dev *)kmalloc(sizeof(struct myled_dev),GFP_KERNEL);if(NULL == pgmydev){unregister_chrdev_region(devno,myled_num);printk("kmalloc failed\n");return -1;}memset(pgmydev,0,sizeof(struct myled_dev));/*給struct cdev對(duì)象指定操作函數(shù)集*/	cdev_init(&pgmydev->mydev,&myops);/*將struct cdev對(duì)象添加到內(nèi)核對(duì)應(yīng)的數(shù)據(jù)結(jié)構(gòu)里*/pgmydev->mydev.owner = THIS_MODULE;cdev_add(&pgmydev->mydev,devno,myled_num);pnode = p_pltdev->dev.of_node;/*ioremap*/request_leds_gpio(pgmydev,pnode);/*con-register set output*/set_leds_gpio_output(pgmydev);return 0;
}int myled_remove(struct platform_device *p_pltdev)
{dev_t devno = MKDEV(major,minor);/*iounmap*/free_leds_gpio(pgmydev);cdev_del(&pgmydev->mydev);unregister_chrdev_region(devno,myled_num);kfree(pgmydev);pgmydev = NULL;return 0;
}struct of_device_id myleddrv_of_ids[] = 
{[0] = {.compatible = "fs4412,led2-5"},[1] = {.compatible = "origen4412,led6-9"},[2] = {},
};struct platform_driver myled_driver = 
{.driver = {.name = "fs4412leds",.of_match_table = myleddrv_of_ids,},.probe = myled_probe,.remove = myled_remove,
};int __init myled_init(void)
{platform_driver_register(&myled_driver);return 0;
}void __exit myled_exit(void)
{platform_driver_unregister(&myled_driver);
}MODULE_LICENSE("GPL");module_init(myled_init);
module_exit(myled_exit);

五、一個(gè)編寫驅(qū)動(dòng)用的宏

?

```cstruct platform_driver xxx = { ?...};module_platform_driver(xxx);//最終展開后就是如下形式：static int __init xxx_init(void){return platform_driver_register(&xxx);}module_init(xxx_init);static void __exit xxx_init(void){return platform_driver_unregister(&xxx);}module_exit(xxx_exit)```