3月15号作业

题目：实现三盏灯点亮

代码：

mycdev.c

#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/uaccess.h>
#include <linux/io.h>
#include "myled.h"

#define CNAME "myled"
int major;
int kbuf[128]={0};
unsigned int* virt_rcc1;
unsigned int* virt_moder1;
unsigned int* virt_odr1;

unsigned int* virt_rcc2;
unsigned int* virt_moder2;
unsigned int* virt_odr2;

unsigned int* virt_rcc3;
unsigned int* virt_moder3;
unsigned int* virt_odr3;

int myled_open(struct inode *inode, struc
t file *file)
{
    printk("%s:%s:%d\n",__FILE__,__func__
,__LINE__);
    return 0;
}
ssize_t myled_read (struct file *file, ch
ar __user *ubuf, size_t size, loff_t *lof
f)
{
    int ret;
    printk("%s:%s:%d\n",__FILE__,__func__
,__LINE__);
    if(size>sizeof(kbuf)) size=sizeof(kbu
f);
    ret=copy_to_user(ubuf,kbuf,size);
    if(ret)
    {
        printk("copy to user is error\n")
;
        return -EIO;
    }
    printk("copy to user kbuf:%s\n",kbuf)
;
    return size;
}
ssize_t myled_write(struct file *file, co
nst char __user *ubuf, size_t size, loff_
t *loff)
{
    int ret;
    printk("%s:%s:%d\n",__FILE__,__func__
,__LINE__);
    if(size>sizeof(kbuf)) size=sizeof(kbu
f);
    ret=copy_from_user(kbuf,ubuf,size);
    if(ret)
    {
        printk("copy from user is error\n
");
        return -EIO;
    }
    printk("copy from user kbuf:%s\n",kbu
f);
    if(kbuf[0]==1)
    {
        *virt_odr1|=(0x1<<10);
        *virt_odr2|=(0x1<<10);
        *virt_odr3|=(0x1<<8);
    }
    else
    {
        *virt_odr1&=(~(0x1<<10));
        *virt_odr2&=(~(0x1<<10));
        *virt_odr3&=(~(0x1<<8));
    }
    return size;
}
int myled_close (struct inode *inode, str
uct 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,
    .release = myled_close,
};

int init_led1(void)
{
    virt_rcc1=ioremap(PHY_RCC_LED1,4);
    if(virt_rcc1==NULL)
    {
        printk("rcc error\n");
        return -ENOMEM;
    }
    virt_moder1=ioremap(PHY_MODLE_LED
1,4);
    if(virt_moder1==NULL)
    {
        printk("module error\n");
        return -ENOMEM;
    }
    virt_odr1=ioremap(PHY_ODR_LED1,4)
;
    if(virt_odr1==NULL)
    {
        printk("odr error\n");
        return -ENOMEM;
    }
    
    *virt_rcc1|=(0x1<<4);
    *virt_moder1&=(~(0x3<<20));
    *virt_moder1|=(0x1<<20);
    *virt_odr1&=(~(0x1<<10));
    return 0;
}
int init_led2(void)
{
    virt_rcc2=ioremap(PHY_RCC_LED2,4);
    if(virt_rcc2==NULL)
    {
        printk("rcc error\n");
        return -ENOMEM;
    }
    virt_moder2=ioremap(PHY_MODLE_LED
2,4);
    if(virt_moder2==NULL)
    {
        printk("module error\n");
        return -ENOMEM;
    }
    virt_odr2=ioremap(PHY_ODR_LED2,4)
;
    if(virt_odr2==NULL)
    {
        printk("odr error\n");
        return -ENOMEM;
    }
    
    *virt_rcc2|=(0x1<<5);
    *virt_moder2&=(~(0x3<<20));
    *virt_moder2|=(0x1<<20);
    *virt_odr2&=(~(0x1<<10));
    return 0;
}
int init_led3(void)
{
    virt_rcc3=ioremap(PHY_RCC_LED3,4);
    if(virt_rcc3==NULL)
    {
        printk("rcc error\n");
        return -ENOMEM;
    }
    virt_moder3=ioremap(PHY_MODLE_LED
3,4);
    if(virt_moder3==NULL)
    {
        printk("module error\n");
        return -ENOMEM;
    }
    virt_odr3=ioremap(PHY_ODR_LED3,4)
;
    if(virt_odr3==NULL)
    {
        printk("odr error\n");
        return -ENOMEM;
    }
    
    *virt_rcc3|=(0x1<<4);
    *virt_moder3&=(~(0x3<<16));
    *virt_moder3|=(0x1<<16);
    *virt_odr3&=(~(0x1<<8));
    return 0;
}
static int __init mycdev_init(void)
{
    major = register_chrdev(0,CNAME,&fops
);//1.注册字符设备驱动
    if(major < 0) //2.判断返回值
    {
        printk("register chrdev is error\
n");
    }
    printk("register chrdev major=%d\n",m
ajor); //3.打印主设备号
    init_led1();
    init_led2();
    init_led3();
    return 0;
}

static void __exit mycdev_exit(void)
{
    iounmap(virt_rcc1);
    iounmap(virt_moder1);
    iounmap(virt_odr1);
    
    iounmap(virt_rcc2);
    iounmap(virt_moder2);
    iounmap(virt_odr2);

    iounmap(virt_rcc3);
    iounmap(virt_moder3);
    iounmap(virt_odr3);
    //4.注销字符设备驱动
    unregister_chrdev(major,CNAME);
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL"); 

mycdev.h

#ifndef __MYLED_H__
#define __MYLED_H__

#define PHY_RCC_LED1 0x50000a28
#define PHY_MODLE_LED1 0x50006000
#define PHY_ODR_LED1 0x50006014

#define PHY_RCC_LED2 0x50000a28
#define PHY_MODLE_LED2 0x50007000
#define PHY_ODR_LED2 0x50007014

#define PHY_RCC_LED3 0x50000a28
#define PHY_MODLE_LED3 0x50006000
#define PHY_ODR_LED3 0x50006014
#endif

text.c

#include<stdio.h>
#include<sys/types.h>
#include<sys/stat.h>
#include<fcntl.h>
#include<unistd.h>
#include<errno.h>
#include<string.h>

int main(int argc, const char *argv[])
{
    char buf[128]={0};
    int fd;
    fd=open("/dev/myled",O_RDWR);
    if(fd==-1)
    {
        perror("open is error\n");
        return -1;
    }
    while (1)
    {
        buf[0]=!buf[0];
        //buf[1]=!buf[1];
        //buf[2]=!buf[2];
        write(fd,buf,3);
        sleep(1);
    }


                                               

/*  printf("please input--------->");
    fgets(buf,sizeof(buf),stdin);
    buf[strlen(buf)-1]=0;
    write(fd,buf,sizeof(buf));
    bzero(buf,sizeof(buf));
    read(fd,buf,sizeof(buf));
    printf(":%s",buf);
    */

    close(fd);
    return 0;
}