驱动---点灯

最新推荐文章于 2024-07-20 09:08:34 发布

崔小柒

最新推荐文章于 2024-07-20 09:08:34 发布

阅读量59

点赞数

文章标签： linux 运维服务器

本文链接：https://blog.csdn.net/weixin_44240433/article/details/128925520

版权

driver.h

#ifndef __DRIVER_H__
#define __DRIVER_H__

#define MODER 0x50006000
#define ODR 0x50006014
#define RCC 0x50000A28
#define F_MODER 0x50007000
#define F_ODR 0x50007014

#endif

demo.c

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


int major;
char kbuf[128]={0};

unsigned int *vir_moder;
unsigned int *vir_odr;
unsigned int *vir_rcc;
unsigned int *vir_f_moder;
unsigned int *vir_f_odr;

int mycdev_open(struct inode *inode, struct file *file)
{
    return 0;
}
//read
ssize_t  mycdev_read(struct file *file,char *ubuf, size_t size, loff_t *off){
	int ret;
	ret=copy_to_user(ubuf,kbuf,sizeof(kbuf));
	if(ret<0){
		return -EIO;
	}

    return 0;
}
//write
ssize_t  mycdev_write(struct file *file, const char  *ubuf, size_t size, loff_t *off)
{
	int ret;
	ret=copy_from_user(kbuf,ubuf,sizeof(kbuf));
	if(ret<0){
		return -EIO;
	}
	if(kbuf[0]=='1'){
		(*vir_odr) |= (1<<10);
	}else if(kbuf[0]=='0'){
		(*vir_odr) &= (~(1<<10));
	}else if(kbuf[0]=='2'){
		(*vir_odr) &= (~(1<<8));
	}else if(kbuf[0]=='3'){
		(*vir_odr) |= (1<<8);
	}else if(kbuf[0]=='4'){
		(*vir_f_odr) &= (~(1<<10));
	}else if(kbuf[0]=='5'){
		(*vir_f_odr) |= (1<<10);
	}
    return 0;
}
//close
int  mycdev_close(struct inode *inode, struct file *file)
{
    return 0;
}


struct file_operations fops=
{
	.open=mycdev_open,
	.read=mycdev_read,
	.write=mycdev_write,
	.release=mycdev_close,
};





//入口函数，加载内核模块时执行
static int __init mycdev_init(void)
{
    //static:让当前函数只能在当前文件使用
    //int：函数返回值类型为int类型
    // mycdev_init：函数名
    //void:函数参数列表为空
	
	
	major=register_chrdev(0,"mycdev",&fops);

	if(major<0){
		printk("注册设备失败\n");
		return major;
	}
	
	printk("注册设备成功---%d\n",major);
	
	vir_moder=ioremap(MODER,4);
	vir_odr=ioremap(ODR,4);
	vir_rcc=ioremap(RCC,4);
	vir_f_moder=ioremap(F_MODER,4);
	vir_f_odr=ioremap(F_ODR,4);
	
	(*vir_moder) &= (~(3<<20));
	(*vir_moder) |= (1<<20);
	(*vir_moder) &= (~(3<<16));
	(*vir_moder) |= (1<<16);
	(*vir_f_moder) &= (~(3<<20));
	(*vir_f_moder) |= (1<<20);

	(*vir_rcc) |= (1<<4);
	(*vir_rcc) |= (1<<5);
	(*vir_odr) &= (~(1<<10));
	(*vir_odr) &= (~(1<<8));
	(*vir_f_odr) &= (~(1<<10));
    return 0;
}
//出口函数，卸载内核模块时执行
static void __exit mycdev_exit(void)
{
	//printk(KERN_INFO "%s",__FILE__);
	iounmap(vir_moder);
	iounmap(vir_odr);
	iounmap(vir_rcc);
	iounmap(vir_f_moder);
	iounmap(vir_f_odr);
	
	unregister_chrdev(major,"mycdev");


}
//宏函数，告诉内核，当前内核模块的入口地址时mycdev_init这个函数
module_init(mycdev_init);
//宏函数，告诉内核，当前内核模块的出口地址时mycdev_exit这个函数
module_exit(mycdev_exit);
//指定当前内核模块遵循GPL协议
MODULE_LICENSE("GPL");

test.c

#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <string.h>
int main(){
	
	char buf[128]={0};
	int fd=open("/dev/mycdev",O_RDWR);
	if(fd<0){
		printf("打开设备失败\n");
		return -1;
	}
	while(1){
	printf("请输入(0(LED1灭)/1(LED1亮)/2(LED3灭)/3(LED3亮)/4(LED2灭)/5(LED2亮))");
	fgets(buf,sizeof(buf),stdin);
	buf[sizeof(buf)-1]='\0';
	write(fd,buf,sizeof(buf));
	memset(buf,0,sizeof(buf));
	read(fd,buf,sizeof(buf));
	puts(buf);
	}
	close(fd);

	return 0;
}