본문 바로가기
임베디드/KERNEL

디바이스드라이버 LED ON/OFF

by sj0020 2020. 12. 18.

1. 호스트 (우분투)

#linux kernel source
KDIR = /home/sss/linux  //커널소스 있는곳
obj-m := test_dev2.o

default:
	$(MAKE) ARCH=arm CROSS_COMPILE=arm-linux-gnueabihf- -C $(KDIR) M=$$PWD modules
	
clean:
	$(MAKE) -C $(KDIR) M=$$PWD clean

 

 

//test_dev2.c
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/uaccess.h>
#include <linux/slab.h>

#define BUFF_SIZE      1024
#define MAJOR_NUMBER   257
#define DEVICE_NAME      "my_device"

static char *buffer = NULL;   //커널에서 사용 버퍼
static int sz_data = 0;      // data size

//장치파일 열기
static int my_open(struct inode *inode, struct file *filp){
   printk("device driver open! \n");
   return 0;
}

//장치 파일 닫기
static int my_release(struct inode *inode, struct file *filp)
{
   printk("<Ko> device driver release! \n");
   return 0;
}

//장치파일에 데이터 쓰기
static ssize_t my_write(struct file *filp, const char *buf, size_t count, loff_t *f_pos)
{
   printk("<Ko> write to buffer! %s\n", buf);
   if(BUFF_SIZE < count){
      sz_data = BUFF_SIZE;
   }
   sz_data = count;
   strncpy(buffer, buf, sz_data);
   printk("<Ko> buffer : %s, %d\n",buffer, sz_data);
   return count;
}

//장치 파일에서 데이터 읽어 옴.
static ssize_t my_read(struct file *filp, char *buf, size_t count, loff_t *f_pos)
{
   printk(KERN_DEBUG "<Ko> from, buffer %s\n", buffer);
   // App의 read()로 보내는 buffer (사용자 값)
   if(!strcmp(buffer, "1")){ //(string compare): buffer의 값과 1을 비교
      copy_to_user(buf, "LED ON", 7); // LEDON (6글자) + null 문자 = 7글자
   }
   else if(!strcmp(buffer,"2")){
      copy_to_user(buf,"LED OFF",8);
   }
   return sz_data;
}

// 파일 동작 함수 연결
static struct file_operations vd_fops = {
   .read = my_read,
   .write = my_write,
   .open = my_open,
   .release = my_release
};

// cat//proc//devices -> 디바이스 드라이버 MAJOR_NUMBER 확인
// $sudo mknod /dev/my_device c 257 0
// $sudo chmod 666 /dev/my_device
int __init my_init(void) { //insmod시
   register_chrdev(MAJOR_NUMBER, DEVICE_NAME,&vd_fops);
   buffer = (char*)kmalloc(BUFF_SIZE, GFP_KERNEL); // 빈배열 잡기(버퍼 잡기)
   memset(buffer, 0, BUFF_SIZE); // 빈배열 잡기(버퍼 잡기)
   printk(KERN_DEBUG "<Ko> device driver init \n");
   return 0;
}

void __exit my_exit(void){ //rmmod시
   unregister_chrdev(MAJOR_NUMBER, DEVICE_NAME);
   kfree(buffer);
   printk(KERN_DEBUG "<Ko> device driver 해제 - 커널 해제 \n");
}

module_init(my_init);
module_exit(my_exit);
MODULE_AUTHOR("Ko");
MODULE_LICENSE("Rack");

 

2. 타겟 (라즈베리파이)

 

# app Makefile
CC = gcc
OBJECT = test_app2.o
TARGET = test_app2
CFLAGS = -g -Wall

$(TARGET) : $(OBJECT)
	$(CC) -o $(TARGET) $(OBJECT)

clean:
	rm -f $(OBJECT) $(TARGET)

 

#include <unistd.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>

int main(int argc, char **argv) {
   int dev = 0;
   char buff[1024] = { 0,};
   char cmd[40] = { 0,};
   printf("Command: ");
   scanf("%s", cmd);
   dev = open("/dev/my_device", O_RDWR);
   write(dev, cmd, strlen(cmd));
   read(dev, buff, strlen(cmd));
   printf("read from device : %s\n",buff);
   close(dev);
   return 0;
}