Linuxデバイスドライバ開発 デバイス

デバイス

前回のLinuxデバイスドライバ開発 デバイスクラスからの続き。
デバイスを登録すると/sys/devices/virtual/ 配下で存在が確認できるようになる。
またシンボルが/sys/class/クラス名 配下に張られる。

#include <linux/init.h>
#include <linux/module.h>
#include <linux/types.h>		/* dev_t */
#include <linux/kdev_t.h>		/* MKDEV(), MAJOR() */
#include <linux/fs.h>			/* register_chrdev_region(), alloc_chrdev_region(), unregister_chrdev() */
#include <linux/device.h>		/* class_create(), class_unregister(), class_destroy() */

MODULE_LICENSE("GPL v2");

int drv_major = 0;
int drv_minor = 0;
int drv_nr_devs = 1;
struct class *skel_drv_class = NULL;
struct device *skel_drv_device = NULL;

#define SKEL_DRV_NAME "skel_drv"

static int skel_init(void)
{
	dev_t dev = 0;
	int ret;

	pr_info("%s\n", __FUNCTION__);

	if (drv_major) {
		/* 指定デバイス番号を登録する */
		dev = MKDEV(drv_major, drv_minor);
		ret = register_chrdev_region(dev, drv_nr_devs, SKEL_DRV_NAME);
	}
	else {
		/* デバイス番号を動的に確保する */
		ret = alloc_chrdev_region(&dev, drv_minor, drv_nr_devs, SKEL_DRV_NAME);
		drv_major = MAJOR(dev);
	}

	if (ret < 0) {
		pr_err("SKEL_DRV: cant't get major %d\n", drv_major);
	}
	else {
		pr_info("SKEL_DRV: char driver major number is %d\n", drv_major);
	}

	/* デバイスクラスを作成する */
	skel_drv_class = class_create(THIS_MODULE, SKEL_DRV_NAME);
	if (IS_ERR(skel_drv_class)) {
		pr_err("SKEL_DRV: class_create failed\n");
		goto unregister_region;
	}

	/* デバイスを作成する */
	skel_drv_device = device_create(skel_drv_class, NULL, MKDEV(drv_major, drv_minor), NULL, "SKEL_DRV%d", drv_minor);
	if (IS_ERR(skel_drv_device)) {
		pr_err("SKEL_DRV: device_create failed\n");
		goto destroy_class;
	}
	else {
		goto exit;
	}

destroy_class:
	class_unregister(skel_drv_class);
	class_destroy(skel_drv_class);
unregister_region:
	unregister_chrdev_region(dev, drv_nr_devs);
exit:
	return 0;
}

static void skel_exit(void)
{
	dev_t dev = 0;

	pr_info("%s\n", __FUNCTION__);

	/* デバイスを破棄する */
	device_destroy(skel_drv_class, MKDEV(drv_major, drv_minor));

	/* デバイスクラスを破棄する */
	class_unregister(skel_drv_class);
	class_destroy(skel_drv_class);

	/* デバイス番号の登録を解除する */
	dev = MKDEV(drv_major, drv_minor);
	unregister_chrdev_region(dev, drv_nr_devs);
}

module_init(skel_init);
module_exit(skel_exit);

実行確認

$ sudo insmod skel_drv.ko
$ cat /proc/devices | grep skel
246 skel_drv
$ ls -lR /sys/class/ | grep skel
drwxr-xr-x 2 root root 0  2月 14 16:58 skel_drv
/sys/class/skel_drv:
lrwxrwxrwx 1 root root 0  2月 14 16:59 SKEL_DRV0 -> ../../devices/virtual/skel_drv/SKEL_DRV0
$ sudo rmmod skel_drv
$ dmesg | tail
　：
[278044.934071] skel_init
[278044.934074] SKEL_DRV: char driver major number is 246
[278114.560203] skel_exit

ソースコード ダウンロード

このページは言多の備忘録を元に再構成しています。