random

commit ff908bbb2c58e1d3b94142f1ba3857cd24619574
parent 76b1065dd8f2e285c98c18282f1637abf2fd929c
Author: Christos Margiolis <christos@margiolis.net>
Date:   Sun, 10 Jul 2022 02:51:53 +0300

add mydev_freebsd

Diffstat:
A
mydev_freebsd/Makefile
 | 
4
++++
A
mydev_freebsd/mydev.c
 | 
120
+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
A
mydev_freebsd/mydev.h
 | 
15
+++++++++++++++
A
mydev_freebsd/mydev_test.c
 | 
44
++++++++++++++++++++++++++++++++++++++++++++

4 files changed, 183 insertions(+), 0 deletions(-)
diff --git a/mydev_freebsd/Makefile b/mydev_freebsd/Makefile
@@ -0,0 +1,4 @@
+KMOD=	mydev
+SRCS=	mydev.c
+
+.include <bsd.kmod.mk>
diff --git a/mydev_freebsd/mydev.c b/mydev_freebsd/mydev.c
@@ -0,0 +1,120 @@
+#include <sys/param.h>
+#include <sys/conf.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/uio.h>
+
+#include "mydev.h"
+
+static d_open_t		mydev_open;
+static d_close_t	mydev_close;
+static d_read_t		mydev_read;
+static d_write_t	mydev_write;
+static d_ioctl_t	mydev_ioctl;
+static int		mydev_modevent(module_t, int, void *);
+
+static struct cdevsw mydev_cdevsw = {
+	.d_name		= "mydev",
+	.d_version	= D_VERSION,
+	.d_flags	= D_TRACKCLOSE,
+	.d_open		= mydev_open,
+	.d_close	= mydev_close,
+	.d_read		= mydev_read,
+	.d_write	= mydev_write,
+	.d_ioctl	= mydev_ioctl,
+};
+
+static struct cdev *mydev_cdev;
+
+static int
+mydev_open(struct cdev *dev, int flags, int devtype, struct thread *td)
+{
+	uprintf("mydev: device opened\n");
+
+	return (0);
+}
+
+static int
+mydev_close(struct cdev *dev, int flags, int devtype, struct thread *td)
+{
+	uprintf("mydev: device closed\n");
+
+	return (0);
+}
+
+static int
+mydev_read(struct cdev *dev, struct uio *uio, int ioflag)
+{
+	char buf[32];
+	int error = 0;
+
+	strlcpy(buf, "reading from mydev", sizeof(buf));
+	error = uiomove(buf, sizeof(buf), uio);
+
+	return (error);
+}
+
+static int
+mydev_write(struct cdev *dev, struct uio *uio, int ioflag)
+{
+	int error = 0;
+
+	uprintf("mydev: %s\n", (char *)uio->uio_iov->iov_base);
+
+	return (error);
+}
+
+static int
+mydev_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags,
+    struct thread *td)
+{
+	foo_t *fp;
+	int error = 0;
+
+	switch (cmd) {
+	case MYDEVIOC_READ:
+		fp = (foo_t *)addr;
+		fp->x = 10;
+		fp->y = 20;
+		break;
+	case MYDEVIOC_WRITE:
+		fp = (foo_t *)addr;
+		uprintf("mydev: x=%d, y=%d\n", fp->x, fp->y);
+		break;
+	case MYDEVIOC_RDWR:
+		fp = (foo_t *)addr;
+		fp->x += 5;
+		fp->y += 5;
+		break;
+	default:
+		error = ENOTTY;
+		break;
+	}
+
+	return (error);
+}
+
+static int
+mydev_modevent(module_t mod, int type, void *arg)
+{
+	int error = 0;
+
+	switch (type) {
+	case MOD_LOAD:
+		mydev_cdev = make_dev(&mydev_cdevsw, 0, UID_ROOT, GID_WHEEL,
+		    0666, "mydev");
+		break;
+	case MOD_UNLOAD: /* FALLTHROUGH */
+	case MOD_SHUTDOWN:
+		destroy_dev(mydev_cdev);
+		break;
+	default:
+		error = EOPNOTSUPP;
+		break;
+	}
+
+	return (error);
+}
+
+DEV_MODULE(mydev, mydev_modevent, NULL);
diff --git a/mydev_freebsd/mydev.h b/mydev_freebsd/mydev.h
@@ -0,0 +1,15 @@
+#ifndef _MYDEV_H_
+#define _MYDEV_H_
+
+#include <sys/ioccom.h>
+
+typedef struct {
+	int x;
+	int y;
+} foo_t;
+
+#define MYDEVIOC_READ	_IOR('a', 1, foo_t)
+#define MYDEVIOC_WRITE	_IOW('a', 2, foo_t)
+#define MYDEVIOC_RDWR	_IOWR('a', 3, foo_t)
+
+#endif /* _MYDEV_H_ */
diff --git a/mydev_freebsd/mydev_test.c b/mydev_freebsd/mydev_test.c
@@ -0,0 +1,44 @@
+#include <err.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+
+#include "mydev.h"
+
+int
+main(int argc, char *argv[])
+{
+	foo_t foo;
+	char buf[32];
+	int dev;
+
+	if ((dev = open("/dev/mydev", O_RDWR)) < 0)
+		err(1, "open(/dev/mydev)");
+
+	if (ioctl(dev, MYDEVIOC_READ, &foo) != 0)
+		err(1, "ioctl(MYDEVIOC_READ)");
+	printf("%s: x=%d, y=%d\n", getprogname(), foo.x, foo.y);
+
+	foo.x = 1;
+	foo.y = 2;
+	if (ioctl(dev, MYDEVIOC_WRITE, &foo) != 0)
+		err(1, "ioctl(MYDEVIOC_WRITE)");
+
+	if (ioctl(dev, MYDEVIOC_RDWR, &foo) != 0)
+		err(1, "ioctl(MYDEVIOC_RDWR)");
+	printf("%s: x=%d, y=%d\n", getprogname(), foo.x, foo.y);
+
+	if (read(dev, buf, sizeof(buf)) < 0)
+		err(1, "read");
+	printf("%s: %s\n", getprogname(), buf);
+
+	strlcpy(buf, "writing to mydev", sizeof(buf));
+	if (write(dev, buf, sizeof(buf)) < 0)
+		err(1, "write");
+
+	close(dev);
+
+	return (0);
+}