linux设备驱动程序 第三版学习
头文件scull.h
/**********************************************
* Author: lewiyon@hotmail.com
* File name: scull.h
* Description: define scull
* Date: 2012-07-4
*********************************************/
#ifndef __SCULL_H
#define __SCULL_H
#include <linux/semaphore.h>
#include <linux/cdev.h>
#include <linux/fs.h> /* register */
#ifndef SCULL_MAJOR
#define SCULL_MAJOR 0
#endif
#ifndef SCULL_NR_DEVS
#define SCULL_NR_DEVS 1
#endif
#ifndef SCULL_QUANTUM
#define SCULL_QUANTUM 5000
#endif
#ifndef SCULL_QSET
#define SCULL_QSET 1000
#endif
/*
* parameters of module
*/
int scull_major;
int scull_quantum;
int scull_qset;
struct scull_qset {
void **data;
struct scull_qset *next;
};
/*
* define scull_dev struct
*/
struct scull_dev {
struct scull_qset *data; /* point first child set */
int quantum; /* size of current set */
int qset; /* size of array */
unsigned long size; /* save total quantity */
unsigned int access_key; /* used by scullid and scullpriv */
struct semaphore sem; /* mutex */
struct cdev cdev; /* character device */
};
struct file_operations scull_fops;
int scull_trim(struct scull_dev *dev);
#endif
scull.h文件
/**********************************************
* Author: lewiyon@hotmail.com
* File name: initialize and release function for scull
* Description: scull
* Date: 2012-07-4
*********************************************/
#include <linux/init.h> /* module */
#include <linux/module.h> /* module */
#include <linux/moduleparam.h> /* module */
#include <linux/errno.h> /* error codes */
#include <linux/kernel.h> /* printk */
#include <linux/slab.h> /* kmalloc kfree */
#include <linux/types.h> /* dev_t */
/* local head files */
#include "scull.h"
/* default parameters of module */
int scull_major = SCULL_MAJOR;
int scull_minor = 0;
int scull_nr_devs = SCULL_NR_DEVS;
int scull_quantum = SCULL_QUANTUM;
int scull_qset = SCULL_QSET;
/* input parameters of module */
module_param(scull_major, int, S_IRUGO);
module_param(scull_minor, int, S_IRUGO);
module_param(scull_nr_devs, int, S_IRUGO);
module_param(scull_quantum, int, S_IRUGO);
module_param(scull_qset, int, S_IRUGO);
struct scull_dev *scull_devices;
/*
* scull_trim - 遍历链表,并释放所有找到的量子和量子集
*/
int scull_trim(struct scull_dev *dev)
{
int i, qset;
struct scull_qset *next, *dptr;
qset = dev->qset;
for (dptr = dev->data; dptr; dptr = next) {
if (dptr->data) {
for (i = 0; i < qset; i++)
kfree(dptr->data[i]);
kfree(dptr->data);
dptr->data = NULL;
}
next = dptr->next;
kfree(dptr);
}
dev->size = 0;
dev->quantum = scull_quantum;
dev->qset = scull_qset;
dev->data = NULL;
return 0;
}
static void scull_setup_cdev(struct scull_dev *dev, int index)
{
int err;
int devno;
devno = MKDEV(scull_major, scull_minor + index);
cdev_init(&dev->cdev, &scull_fops);
dev->cdev.owner = THIS_MODULE;
//dev->cdev.ops = &scull_fops;
err = cdev_add(&dev->cdev, devno, 1);
if (err)
printk(KERN_NOTICE "Error %d adding scull%d", err, index);
}
/*
* initialze scull module
*/
void scull_cleanup_module(void)
{
int i;
dev_t devno;
devno = MKDEV(scull_major, scull_minor);
/* delete each entry */
if (scull_devices) {
for (i = 0; i < scull_nr_devs; i++) {
scull_trim(scull_devices + i);
cdev_del(&scull_devices[i].cdev);
}
kfree(scull_devices);
}
/* unregister */
unregister_chrdev_region(devno, scull_nr_devs);
printk(KERN_WARNING "scull: Bye!\n");
}
/*
* initialze scull module
*/
int scull_init_module(void)
{
int i, res;
dev_t dev = 0;
if (scull_major) {
dev = MKDEV(scull_major, scull_minor);
res = register_chrdev_region(dev, scull_nr_devs, "scull");
} else {
res = alloc_chrdev_region(&dev, scull_minor,
scull_nr_devs, "scull");
scull_major = MAJOR(dev);
}
if (res < 0) {
printk(KERN_WARNING "scull: can't get major %d\n", scull_major);
return res;
}
/*
* allocate the device struct cache
*/
scull_devices = kmalloc(scull_nr_devs * sizeof(struct scull_dev),
GFP_KERNEL);
if (NULL == scull_devices) {
res = -ENOMEM;
printk(KERN_WARNING "scull: NOMEM for scull!\n");
goto fail;
}
memset(scull_devices, 0, scull_nr_devs * sizeof(struct scull_dev));
/* initialize each device */
for (i = 0; i < scull_nr_devs; i++) {
scull_devices[i].quantum = scull_quantum;
scull_devices[i].qset = scull_qset;
sema_init(&scull_devices[i].sem, 1);
scull_setup_cdev(&scull_devices[i], i);
}
printk(KERN_INFO "scull: OK!\n");
return 0;
fail:
scull_cleanup_module();
return res;
}
module_init(scull_init_module);
module_exit(scull_cleanup_module);
MODULE_AUTHOR("lewiyon@hotmail.com");
MODULE_LICENSE("GPL");
makefile文件
obj-m := scull.o
KERNELBUILD := /lib/modules/$(shell uname -r)/build
default:
$(MAKE) -C $(KERNELBUILD) M=$(shell pwd) modules
clean:
-rm -rf *.o .*.cmd *.ko* *.mod.c .tmp_versions
-rm -rf modules.order Module.symvers
make;然后安装模块
ok~~~