tiny6410 linux混杂设备 led驱动

#include <linux/miscdevice.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/fs.h>
#include <linux/types.h>
#include <linux/errno.h>
#include <linux/ioctl.h>
#include <linux/cdev.h>
#include <linux/device.h>
#include <linux/ioport.h>
#include <asm/io.h>
#include <asm/uaccess.h>

#define DEVICE_NAME "led1"
unsigned long GPIOK_VA_BASE ;

#define GPIOK_CON0  GPIOK_VA_BASE 
#define GPIOK_CON1  GPIOK_VA_BASE+0X4
#define GPIOK_DAT   GPIOK_VA_BASE+ 0X8
#define GPIOK_PUD   GPIOK_VA_BASE +0XC

#define GPIOK_PA_BASE 0X7F008800

struct resource led_resource = {
	.name  = "led io-mem ",
	.start  = GPIOK_PA_BASE,
	.end = GPIOK_PA_BASE +0X10,
	.flags = IORESOURCE_MEM,
};

static void led_pin_setup(void)
{
	unsigned long start = led_resource.start;
	unsigned long size = led_resource.end - led_resource.start;
	unsigned long tmp;
	
	request_mem_region(start,size,led_resource.name);
	
	GPIOK_VA_BASE = (unsigned long)ioremap(start,size);
	printk ("<1> [GPIOK_VA_BASE = 0x%lx]\n", GPIOK_VA_BASE);

	tmp = readl(GPIOK_CON0);
	tmp = (tmp & ~(0xffffu<<16))|(0x1111u<<16);
	writel(tmp,GPIOK_CON0);
	
	tmp = readl(GPIOK_DAT);
	tmp |= (0xf <<4);
	writel(tmp,GPIOK_DAT);
	
}

static void led_pin_release(void)
{
	iounmap((void*)GPIOK_VA_BASE);
	release_mem_region(led_resource.start,led_resource.end - led_resource.start);
}

static unsigned long led_getdata(void)
{
		return ((readl(GPIOK_DAT)>>4)& 0XF);
	
}

static void led_setdata(int data)
{
		unsigned long temp;
		temp = readl(GPIOK_DAT);
		temp = ~(0xF<<4) | ((data&0xF)<<4);
		writel(temp,GPIOK_DAT);
}

static ssize_t led_read(struct file *filp, char __user *buf, size_t size, loff_t *ppos)
{
	int ret = 0;
	char buffer[1];
	
	memset(buffer,0,sizeof(buffer));
	buffer[0] = (char)led_getdata() ;
	
	if(copy_to_user(buf,buffer,size))
	{
		ret = -EFAULT;
	}
	return size;
}

static ssize_t led_write(struct file *flip,const char __user *buf,size_t size,loff_t *ppos)
{
		int ret = 0;
	unsigned long buffer[1];
	
	memset(buffer,0,sizeof(buffer));
		if(copy_from_user(buffer,buf,size))
		{
			printk("error\n");
			ret = -EFAULT;
		}
		else{
			led_setdata(0x00);
			led_setdata((int )buffer[0]);
		}
		return ret;
}

static struct file_operations dev_fops ={
		.owner  = THIS_MODULE,
		.read = led_read,
		.write = led_write,
};

static struct miscdevice misc ={
		.minor = MISC_DYNAMIC_MINOR,
		.name = DEVICE_NAME,
		.fops = &dev_fops,
};

static int __init dev_init(void)
{
	int ret;
	led_pin_setup();
	ret  = misc_register(&misc);
	printk(DEVICE_NAME"initialize minor =%d\n",misc.minor);
	
	return ret;
}

static void __exit dev_exit(void)
{
		led_pin_release();
		misc_deregister(&misc);
}

module_init(dev_init);
module_exit(dev_exit);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("GOAT.ZHOU");

以上的是led的驱动文件，以write 向led里写数据，read读取led的状态。

以下的是测试程序 led_app.c

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

char binstr_to_int(char *binstr)
{
    char ret = 0, i = 0;
    char bnum[5];
    memset(bnum, '0', 4);
    int len = strlen(binstr);
    if (len > 4) 
        strcpy(bnum, binstr+len-4); 
    else 
        strcpy(bnum+4-len, binstr);
    
    for (i=0; i<4; i++) {
        ret <<= 1;
        ret += (bnum[i]=='0'? 1: 0);
    }
    return ret;
}

int main(int argc, char *argv[])
{
	 int fd;
	 unsigned char buff[1];
	 fd = open("/dev/led1",O_RDWR);
	 if(fd == -1){
		 printf("open dev error");
		 _exit(EXIT_FAILURE);
	 }
	 buff[0] = binstr_to_int(argv[1]);
	write(fd,buff,sizeof(buff));
	memset(buff,0,sizeof(buff));
	printf("%d\n", read(fd,buff,sizeof(buff)));
	printf("%d",(int)buff[0]);
	close(fd);
	return 0;
	

	 
}