【12/21】

myled.h

#ifndef __MYLED_H__

#define __MYLED_H__

#define PHY_LED1_LED3_MODER 0X50006000

#define PHY_LED1_LED3_ODR  0X50006014

#define PHY_LED2_MODER 0X50007000

#define PHY_LED2_ODR  0X50007014

#define PHY_RCC 0X50000A28

#define LED_ON _IOW('l',1,int)

#define LED_OFF _IOW('l',0,int)

#endif

test.c

 

#include <stdio.h>

#include <sys/types.h>

#include <sys/stat.h>

#include <fcntl.h>

#include <unistd.h>

#include <stdlib.h>

#include<string.h>

#include <sys/ioctl.h>

#include"myled.h"

char buf[128] = {0};

int main(int argc, const char *argv[])

{

    int fd;

    int choose = 0;

    if((fd = open("/dev/myled1",O_RDWR))<0){

        perror("open error");

        return -1;

    }

    while(1)

    {

        choose = choose%3;

        ioctl(fd,LED_ON,&choose);

        sleep(1);

        ioctl(fd,LED_OFF,&choose);

        sleep(1);

        choose++;

    }

   

    return 0;

}

myled.c

#include <linux/init.h>

#include <linux/module.h>

#include <linux/fs.h>

#include<linux/uaccess.h>

#include<linux/io.h>

#include<linux/device.h>

#include"myled.h"

#define CNAME "led"

int major=0;

char kbuf[128]={0};

unsigned int*vir_LED1_LED3_moder;

unsigned int*vir_LED1_LED3_odr;

unsigned int*vir_LED2_moder;

unsigned int*vir_LED2_odr;

unsigned int*vir_rcc;

struct class *cls;

struct device *dev;

int myled_open(struct inode *inode, struct file *file)

{

    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);

    return 0;

}

ssize_t myled_read(struct file *file,

    char __user * ubuf, size_t size, loff_t *offs)

{

    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);

    return 0;

}

ssize_t myled_write(struct file *file,

    const char __user *ubuf, size_t size, loff_t *offs)

{

    int ret;

     if(size>sizeof(kbuf))

        size=sizeof(kbuf);

    ret=copy_from_user(kbuf,ubuf,size);

    if(ret)

    {

        printk("copy_from_user filed\n");

        return -EIO;

    }

 

    return 0;

}

long mycdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)

{

    int choose,ret;

    switch(cmd)

    {

        case LED_ON:

             //判断哪个灯开

             //通过copy_from_user来接收第三个参数

             ret=copy_from_user(&choose,(void *)arg,sizeof(int));

             if(ret)

             {

                printk("copy_from_user filed\n");

                return -EIO;

             }

            switch(choose)

            {

                case 0:

                    (*vir_LED1_LED3_odr) |= (1<<10);//输出低电平

                    break;

                 case 1:

                    (*vir_LED2_odr) |= (1<<10);//输出低电平

                    break;

                 case 2:

                   (*vir_LED1_LED3_odr) |= (1<<8);//输出低电平

                   break;

               

            }

            break;

        case LED_OFF:

             ret=copy_from_user(&choose,(void *)arg,sizeof(int));

             if(ret)

             {

                printk("copy_from_user filed\n");

                return -EIO;

             }

            switch(choose)

            {

                case 0:

                   (*vir_LED1_LED3_odr) &= (~(1<<10));//输出低电平

                    break;

                 case 1:

                    (*vir_LED2_odr) &= (~(1<<10));//输出低电平

                    break;

                 case 2:

                  (*vir_LED1_LED3_odr) &= (~(1<<8));//输出低电平

                  break;

               

            }

            break;

    }

    return 0;

}

int myled_close(struct inode *inode, struct file *file)

{

    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);

    return 0;

}

const struct file_operations fops = {

    .open = myled_open,

    .read = myled_read,

    .write = myled_write,

    .unlocked_ioctl=mycdev_ioctl,

    .release = myled_close,

};

static int __init myled_init(void)

{

    //1.创建字符设备驱动

    major = register_chrdev(0,CNAME,&fops);

    if(major < 0){

        printk("register char device driver error\n");

        return major;

    }

    printk("success major = %d\n",major);

   

    vir_LED1_LED3_moder=ioremap(PHY_LED1_LED3_MODER,4);

   if(vir_LED1_LED3_moder==NULL)

   {

    printk("vir_LED1_LED3_moder ioremap failed\n");

    return -ENOMEM;

   }

   vir_LED1_LED3_odr=ioremap(PHY_LED1_LED3_ODR,4);

   if(vir_LED1_LED3_odr == NULL)

   {

    printk("vir_LED1_LED3_odr ioremap failed\n");

    return -ENOMEM;

   }

    vir_LED2_moder=ioremap(PHY_LED2_MODER,4);

   if(vir_LED2_moder==NULL)

   {

    printk("vir_LED2_moder ioremap failed\n");

    return -ENOMEM;

   }

   vir_LED2_odr=ioremap(PHY_LED2_ODR,4);

   if(vir_LED2_odr == NULL)

   {

    printk("vir_LED2_odr ioremap failed\n");

    return -ENOMEM;

   }

   vir_rcc=ioremap(PHY_RCC,4);

   if(vir_rcc==NULL)

   {

    printk("vir_rcc ioremap failed\n");

    return -ENOMEM;

   }

   printk("相关寄存器物理地址映射成功\n");

    (*vir_rcc) |= (1<<4);//rcc使能

    (*vir_rcc) |= (1<<5);//rcc使能

   (*vir_LED1_LED3_moder) &=(~(3<<20));

   (*vir_LED1_LED3_moder) |= (1<<20);//设置为输出模式

   (*vir_LED1_LED3_moder) &=(~(3<<16));

   (*vir_LED1_LED3_moder) |= (1<<16);//设置为输出模式

   (*vir_LED1_LED3_odr) &= (~(1<<10));//输出低电平

   (*vir_LED1_LED3_odr) &= (~(1<<8));//输出低电平

   (*vir_LED2_moder) &=(~(3<<20));

   (*vir_LED2_moder) |= (1<<20);//设置为输出模式

   (*vir_LED2_odr) &= (~(1<<10));//输出低电平

   printk("相关寄存器初始化成功\n");

   cls=class_create(THIS_MODULE,"led");

   if(IS_ERR(cls))

   {

        printk("向上提交目录信息失败\n");

        return PTR_ERR(cls);

   }

   printk("向上提交目录信息成功\n");

   dev=device_create(cls,NULL,MKDEV(major,0),NULL,"myled1");

   if(IS_ERR(dev))

   {

        printk("向上提交节点信息失败\n");

        return PTR_ERR(dev);

   }

   printk("向上提交节点信息成功\n");

    return 0;

}

static void __exit myled_exit(void)

{

    device_destroy(cls,MKDEV(major,0));

    class_destroy(cls);

   

    iounmap(vir_LED1_LED3_moder);

    iounmap(vir_LED1_LED3_odr);

    iounmap(vir_LED2_moder);

    iounmap(vir_LED2_odr);

    iounmap(vir_rcc);

    unregister_chrdev(major,CNAME);

}

module_init(myled_init);

module_exit(myled_exit);

MODULE_LICENSE("GPL");