上海华清071班

#include <linux/init.h>
#include <linux/module.h>
#include <linux/cdev.h>
#include <linux/fs.h>
#include <linux/device.h>
#include <linux/slab.h>
#include <linux/io.h>
#include <linux/uaccess.h>
#define CNAME "myled"
#include "text.h"
struct cdev *cdev;
struct class * cls;
volatile unsigned int* vir_rcc;
volatile led_t* vir_gpioe;
volatile led_t* vir_gpiof;
struct device * dev;
char duan;
#if 1
unsigned int major = 0;//动态申请设备号
#else
unsigned int major = 500; //静态指定设备号
#endif
int minor = 0;
const int count = 3;
int mycdev_open(struct inode *inode, struct file *file)
{
    file->private_data=(void*)MINOR(inode->i_rdev);
    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
    return 0;
}
ssize_t mycdev_read(struct file *file, char __user *ubuf, size_t size, loff_t *loff)
{
    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
    return 0;
}
ssize_t mycdev_write (struct file *file, const char __user *ubuf, size_t size, loff_t *loff)
{

    int ret;
    int number;
    ret=copy_from_user(&duan,ubuf,sizeof(char));
    if(ret)
    {
        printk("copy form user led on\n");
        return -EIO;
    }
    number=(int)file->private_data;
    if(duan=='1')
    {
        if(number==0)
        {
            vir_gpioe->ODR |= (0x1<<10);
        }
        if(number==1)
        {
            vir_gpiof->ODR |= (0x1<<10);
        }
        if(number==2)
        {
            vir_gpioe->ODR |= (0x1<<8);
        }
    }
    else if(duan=='0')
    {
        if(number==0)
        {
            vir_gpioe->ODR &= (~(0x1<<10));
        }
        if(number==1)
        {
            vir_gpiof->ODR &= (~(0x1<<10));
        }
        if(number==2)
        {
            vir_gpioe->ODR &= (~(0x1<<8));
        }
    }
    return 0;
}
int mycdev_close (struct inode *inode, struct file *file)
{
    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
    return 0;
}
const struct file_operations fops = {
    .open = mycdev_open,
    .read = mycdev_read,
    .write = mycdev_write,
    .release = mycdev_close,
};
//入口
static int __init mycdev_init(void)
{
    int ret;
    dev_t devno;
    int i;
    //1.分配cdev结构体
    cdev = cdev_alloc();
    if(NULL == cdev)
    {
        printk("cdev alloc is error\n");
        ret = -EIO;
        goto ERR1;
    }
        //2.初始化结构体
        cdev_init(cdev,&fops);
    //3.申请设备号
    if(major > 0)
    {
        //静态指定设备号
        ret = register_chrdev_region(MKDEV(major,minor),count,CNAME);
    if(ret)
    {
        printk("register chrdev region is error\n");
        ret = -ENOMEM;
    goto ERR2;
     }
    }
    else{
        //动态申请设备号
        ret = alloc_chrdev_region(&devno,0,count,CNAME);
    if(ret)
     {
     printk("alloc chrdev region is error\n");
     ret = -ENOMEM;
         goto ERR2;
    }
        //获取主设备号
        major = MAJOR(devno);
        //获取次设备号
        minor = MINOR(devno);
    }
        //4.驱动的注册
        ret = cdev_add(cdev,MKDEV(major,minor),count);
    if(ret)
    {
        printk("cdev add is error\n");
        ret = -EIO;
        goto ERR3;
    }
        //5.自动创建设备节点
        //1)向上层提交目录信息
        cls = class_create(THIS_MODULE,CNAME);
        if(IS_ERR(cls))
    {
        printk("class create is error\n");
        ret = PTR_ERR(cls);
        goto ERR4;
    }
    //2）向上层提交设备节点信息
        for(i=0;i<count;i++)
    {
        dev = device_create(cls,NULL,MKDEV(major,i),NULL,"myled%d",i);
        if(IS_ERR(dev))
    {
        printk("device create is error\n");
        ret = PTR_ERR(dev);
        goto ERR5;
    }
    }
    vir_rcc = ioremap(PHY_RCC,4);
    if(NULL==vir_rcc)
    {
        printk("rcc ioremap is error\n");
        return -ENOMEM;
    }
    vir_gpioe = ioremap(PHY_GPIOE_MODER,24);
    if(NULL==vir_gpioe)
    {
        printk("gpioe ioremap is error\n");
        return -ENOMEM;
    }
    vir_gpiof = ioremap(PHY_GPIOF_MODER,24);
    if(NULL==vir_gpiof)
    {
        printk("gpiof ioremap is error\n");
        return -ENOMEM;
    }
    *vir_rcc |= (0x3<<4);
    vir_gpioe->MODER &= (~(0x3<<20));
    vir_gpioe->MODER |= (0x1<<20);
    vir_gpiof->MODER &= (~(0x3<<20));
    vir_gpiof->MODER |= (0x1<<20);
    vir_gpioe->MODER &= (~(0x3<<16));
    vir_gpioe->MODER |= (0x1<<16);
    return 0;

ERR5:
    for(--i;i>=0;i--)
    {
    device_destroy(cls,MKDEV(major,i));
    }
    class_destroy(cls);
ERR4:
    cdev_del(cdev);
ERR3:
    unregister_chrdev_region(MKDEV(major,minor),count);
ERR2:
    kfree(cdev);
ERR1:
    return -EIO;
}
//出口
static void __exit mycdev_exit(void)
{
    int i;
    //1。销毁设备节点信息
    for(i=0;i<count;i++)
    {
        device_destroy(cls,MKDEV(major,i));
     }
    //2.销毁目录信息
    class_destroy(cls);
    //3.驱动的注销
    cdev_del(cdev);
     //4.销毁设备号
    unregister_chrdev_region(MKDEV(major,minor),count);
     //5.释放cdev结构体
    kfree(cdev);
    iounmap(vir_rcc);
    iounmap(vir_gpioe);
    iounmap(vir_gpiof);

}
//指定入口地址
module_init(mycdev_init);
module_exit(mycdev_exit);
//指定出口地址
//许可证
MODULE_LICENSE("GPL");

text.c

#ifndef __LED_H__
#define __LED_H__
typedef struct{
    volatile unsigned int MODER;
    volatile unsigned int OTYPER;
    volatile unsigned int OSPEEDR;
    volatile unsigned int PUPDR;
    volatile unsigned int IDR;
    volatile unsigned int ODR;
}led_t;
#define PHY_GPIOE_MODER  0x50006000
#define PHY_GPIOF_MODER  0x50007000
#define PHY_RCC  0x50000A28
#endif