Home | History | Annotate | Line # | Download | only in pollpal
pollpal.c revision 1.4
      1  1.4  riastrad /*	$NetBSD: pollpal.c,v 1.4 2022/03/28 12:33:22 riastradh Exp $	*/
      2  1.1  christos 
      3  1.1  christos /*-
      4  1.1  christos * Copyright (c) 2020 The NetBSD Foundation, Inc.
      5  1.1  christos * All rights reserved.
      6  1.1  christos *
      7  1.1  christos * Redistribution and use in source and binary forms, with or without
      8  1.1  christos * modification, are permitted provided that the following conditions
      9  1.1  christos * are met:
     10  1.1  christos * 1. Redistributions of source code must retain the above copyright
     11  1.1  christos *    notice, this list of conditions and the following disclaimer.
     12  1.1  christos * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  christos *    notice, this list of conditions and the following disclaimer in the
     14  1.1  christos *    documentation and/or other materials provided with the distribution.
     15  1.1  christos *
     16  1.1  christos * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  christos * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  christos * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  christos * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  christos * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  christos * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  christos * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  christos * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  christos * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  christos * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  christos * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  christos */
     28  1.1  christos 
     29  1.1  christos #include <sys/cdefs.h>
     30  1.4  riastrad __KERNEL_RCSID(0, "$NetBSD: pollpal.c,v 1.4 2022/03/28 12:33:22 riastradh Exp $");
     31  1.1  christos 
     32  1.1  christos #include <sys/module.h>
     33  1.1  christos #include <sys/param.h>
     34  1.1  christos #include <sys/kernel.h>
     35  1.1  christos #include <sys/systm.h>
     36  1.2       mrg #include <sys/lwp.h>
     37  1.1  christos 
     38  1.1  christos #include <sys/condvar.h>
     39  1.1  christos #include <sys/conf.h>
     40  1.1  christos #include <sys/device.h>
     41  1.1  christos #include <sys/file.h>
     42  1.1  christos #include <sys/filedesc.h>
     43  1.1  christos #include <sys/mutex.h>
     44  1.1  christos #include <sys/kmem.h>
     45  1.1  christos #include <sys/poll.h>
     46  1.1  christos #include <sys/select.h>
     47  1.1  christos 
     48  1.1  christos /*
     49  1.1  christos  * Create a device /dev/pollpal
     50  1.1  christos  *
     51  1.1  christos  * To use this device you need to do:
     52  1.1  christos  * 	mknod /dev/pollpal c 351 0
     53  1.1  christos  *
     54  1.1  christos  */
     55  1.1  christos 
     56  1.1  christos dev_type_open(pollpal_open);
     57  1.1  christos 
     58  1.1  christos static struct cdevsw pollpal_cdevsw = {
     59  1.1  christos 	.d_open = pollpal_open,
     60  1.1  christos 	.d_close = noclose,
     61  1.1  christos 	.d_read = noread,
     62  1.1  christos 	.d_write = nowrite,
     63  1.1  christos 	.d_ioctl = noioctl,
     64  1.1  christos 	.d_stop = nostop,
     65  1.1  christos 	.d_tty = notty,
     66  1.1  christos 	.d_poll = nopoll,
     67  1.1  christos 	.d_mmap = nommap,
     68  1.1  christos 	.d_kqfilter = nokqfilter,
     69  1.1  christos 	.d_discard = nodiscard,
     70  1.1  christos 	.d_flag = D_OTHER
     71  1.1  christos };
     72  1.1  christos 
     73  1.1  christos static int	pollpal_nopen = 0;
     74  1.1  christos 
     75  1.1  christos static int	pollpal_close(file_t *);
     76  1.1  christos static int	pollpal_write(file_t *, off_t *, struct uio *, kauth_cred_t,
     77  1.1  christos     int);
     78  1.1  christos static int	pollpal_read(file_t *, off_t *, struct uio *, kauth_cred_t,
     79  1.1  christos     int);
     80  1.1  christos static int	pollpal_poll(file_t *, int);
     81  1.1  christos 
     82  1.1  christos const struct fileops pollpal_fileops = {
     83  1.1  christos 	.fo_read = pollpal_read,
     84  1.1  christos 	.fo_write = pollpal_write,
     85  1.1  christos 	.fo_ioctl = fbadop_ioctl,
     86  1.1  christos 	.fo_fcntl = fnullop_fcntl,
     87  1.1  christos 	.fo_poll = pollpal_poll,
     88  1.1  christos 	.fo_stat = fbadop_stat,
     89  1.1  christos 	.fo_close = pollpal_close,
     90  1.1  christos 	.fo_kqfilter = fnullop_kqfilter,
     91  1.1  christos 	.fo_restart = fnullop_restart,
     92  1.1  christos };
     93  1.1  christos 
     94  1.1  christos typedef struct pollpal_softc {
     95  1.1  christos 	kmutex_t lock;
     96  1.1  christos 	kcondvar_t sc_cv;
     97  1.1  christos 	struct selinfo psel;
     98  1.1  christos 	char *buf;
     99  1.1  christos 	size_t buf_len;
    100  1.1  christos 	/* Device can have two states 1.READ_WAITING, 2.WRITE_WAITING. */
    101  1.1  christos 	enum states {
    102  1.1  christos 		READ_WAITING = 0,
    103  1.1  christos 		WRITE_WAITING = 1
    104  1.1  christos 	} sc_state;
    105  1.1  christos } pal_t;
    106  1.1  christos 
    107  1.1  christos static int
    108  1.1  christos check_pal(const char *str, size_t len)
    109  1.1  christos {
    110  1.1  christos 	size_t n;
    111  1.1  christos 
    112  1.1  christos 	n = 0;
    113  1.1  christos 
    114  1.1  christos 	while (n <= len / 2) {
    115  1.1  christos 		if (str[n] != str[len - n - 1])
    116  1.1  christos 			return 0;
    117  1.1  christos 
    118  1.1  christos 		n++;
    119  1.1  christos 	}
    120  1.1  christos 
    121  1.1  christos 	return 1;
    122  1.1  christos }
    123  1.1  christos 
    124  1.1  christos int
    125  1.1  christos pollpal_open(dev_t dev, int flag, int mode, struct lwp *l __unused)
    126  1.1  christos {
    127  1.1  christos 	struct file *fp;
    128  1.1  christos 	int error, fd;
    129  1.1  christos 	pal_t *pl;
    130  1.1  christos 
    131  1.1  christos 	error = fd_allocfile(&fp, &fd);
    132  1.1  christos 	if (error)
    133  1.1  christos 		return error;
    134  1.1  christos 
    135  1.1  christos 	++pollpal_nopen;
    136  1.1  christos 
    137  1.1  christos 	pl = kmem_zalloc(sizeof(*pl), KM_SLEEP);
    138  1.1  christos 
    139  1.1  christos 	pl->sc_state = READ_WAITING;
    140  1.1  christos 	mutex_init(&pl->lock, MUTEX_DEFAULT, IPL_NONE);
    141  1.1  christos 	cv_init(&pl->sc_cv, "sc_cv");
    142  1.1  christos 	selinit(&pl->psel);
    143  1.1  christos 
    144  1.1  christos 	return fd_clone(fp, fd, flag, &pollpal_fileops, pl);
    145  1.1  christos }
    146  1.1  christos 
    147  1.1  christos int
    148  1.1  christos pollpal_close(file_t * fp)
    149  1.1  christos {
    150  1.1  christos 	pal_t * pl = fp->f_data;
    151  1.1  christos 	KASSERT(pl != NULL);
    152  1.1  christos 
    153  1.1  christos 	if (pl->buf != NULL)
    154  1.1  christos 		kmem_free(pl->buf, pl->buf_len);
    155  1.1  christos 
    156  1.1  christos 	seldestroy(&pl->psel);
    157  1.1  christos 	cv_destroy(&pl->sc_cv);
    158  1.1  christos 	mutex_destroy(&pl->lock);
    159  1.1  christos 	kmem_free(pl, sizeof(*pl));
    160  1.1  christos 
    161  1.1  christos 	--pollpal_nopen;
    162  1.1  christos 
    163  1.1  christos 	return 0;
    164  1.1  christos }
    165  1.1  christos 
    166  1.1  christos /*
    167  1.1  christos  * Device would write only in READ_WAITING state and then update the state to
    168  1.1  christos  * WRITE_WAITING.
    169  1.1  christos  */
    170  1.1  christos int
    171  1.1  christos pollpal_write(file_t *fp, off_t *offset, struct uio *uio, kauth_cred_t cred,
    172  1.1  christos     int flag)
    173  1.1  christos {
    174  1.1  christos 	pal_t *pl = fp->f_data;
    175  1.1  christos 	int error;
    176  1.1  christos 
    177  1.1  christos 	error = 0;
    178  1.1  christos 
    179  1.1  christos 	/* To ensure that only single process can write in device at a time. */
    180  1.1  christos 	mutex_enter(&pl->lock);
    181  1.1  christos 	cv_broadcast(&pl->sc_cv);
    182  1.1  christos 	switch (pl->sc_state) {
    183  1.1  christos 	case READ_WAITING:
    184  1.1  christos 		pl->sc_state = WRITE_WAITING;
    185  1.1  christos 		selnotify(&pl->psel, POLLOUT | POLLWRNORM, 0);
    186  1.1  christos 		while (pl->sc_state == WRITE_WAITING) {
    187  1.1  christos 			if (pl->buf) {
    188  1.1  christos 				error = cv_wait_sig(&pl->sc_cv, &pl->lock);
    189  1.1  christos 				if (error)
    190  1.1  christos 					goto ret;
    191  1.1  christos 
    192  1.1  christos 			}
    193  1.1  christos 
    194  1.1  christos 			pl->buf_len = uio->uio_iov->iov_len;
    195  1.1  christos 			pl->buf = kmem_alloc(pl->buf_len, KM_SLEEP);
    196  1.1  christos 			uiomove(pl->buf, pl->buf_len, uio);
    197  1.1  christos 			printf("Use cat to know the result.\n");
    198  1.1  christos 			break;
    199  1.1  christos 		}
    200  1.1  christos 		break;
    201  1.1  christos 	case WRITE_WAITING:
    202  1.1  christos 		printf("State: WRITE_WAITING\n");
    203  1.1  christos 		break;
    204  1.1  christos 	}
    205  1.1  christos 
    206  1.1  christos ret:
    207  1.1  christos 	mutex_exit(&pl->lock);
    208  1.1  christos 	return error;
    209  1.1  christos }
    210  1.1  christos 
    211  1.1  christos /*
    212  1.1  christos  * Device would read only in WRITE_WAITING state and then update the state to
    213  1.1  christos  * READ_WAITING.
    214  1.1  christos  */
    215  1.1  christos int
    216  1.1  christos pollpal_read(file_t *fp, off_t *offset, struct uio *uio, kauth_cred_t cred,
    217  1.1  christos     int flags)
    218  1.1  christos {
    219  1.1  christos 	pal_t *pl = fp->f_data;
    220  1.1  christos 	int error;
    221  1.1  christos 
    222  1.1  christos 	error = 0;
    223  1.1  christos 
    224  1.1  christos 	/* To ensure that only single process can read device at a time. */
    225  1.1  christos 	mutex_enter(&pl->lock);
    226  1.1  christos 	cv_broadcast(&pl->sc_cv);
    227  1.1  christos 	switch (pl->sc_state) {
    228  1.1  christos 	case READ_WAITING:
    229  1.1  christos 		printf("State: READ_WAITING\n");
    230  1.1  christos 		printf("You need to write something to the module first!\n");
    231  1.1  christos 		goto ret;
    232  1.1  christos 	case WRITE_WAITING:
    233  1.1  christos 		pl->sc_state = READ_WAITING;
    234  1.1  christos 		selnotify(&pl->psel, POLLIN | POLLRDNORM, 0);
    235  1.1  christos 		while (pl->sc_state == READ_WAITING) {
    236  1.1  christos 			if (!pl->buf) {
    237  1.1  christos 				error = cv_wait_sig(&pl->sc_cv, &pl->lock);
    238  1.1  christos 				if (error)
    239  1.1  christos 					goto ret;
    240  1.1  christos 
    241  1.1  christos 			}
    242  1.1  christos 			printf("The string you entered was: ");
    243  1.1  christos 			uiomove(pl->buf, pl->buf_len, uio);
    244  1.1  christos 			printf("\n");
    245  1.1  christos 			if (check_pal(pl->buf, pl->buf_len))
    246  1.1  christos 				printf("String '%s' was a palindrome.\n",
    247  1.1  christos 				    pl->buf);
    248  1.1  christos 			else
    249  1.1  christos 				printf("String '%s' was not a palindrome.\n",
    250  1.1  christos 				    pl->buf);
    251  1.1  christos 
    252  1.1  christos 			break;
    253  1.1  christos 		}
    254  1.1  christos 		break;
    255  1.1  christos 	}
    256  1.1  christos 	kmem_free(pl->buf, pl->buf_len);
    257  1.1  christos 	pl->buf = NULL;
    258  1.1  christos 
    259  1.1  christos ret:
    260  1.1  christos 	mutex_exit(&pl->lock);
    261  1.1  christos 	return error;
    262  1.1  christos }
    263  1.1  christos 
    264  1.1  christos int
    265  1.1  christos pollpal_poll(struct file *fp, int events)
    266  1.1  christos {
    267  1.1  christos 	pal_t *pl = fp->f_data;
    268  1.1  christos 	int revents;
    269  1.1  christos 
    270  1.1  christos 	revents = 0;
    271  1.1  christos 
    272  1.1  christos 	mutex_enter(&pl->lock);
    273  1.1  christos 	switch (pl->sc_state) {
    274  1.1  christos 	case READ_WAITING:
    275  1.1  christos 		if (events & (POLLOUT | POLLWRNORM)) {
    276  1.1  christos 			/* When device is in READ_WAITING state it can write */
    277  1.1  christos 			revents |= POLLOUT | POLLWRNORM;
    278  1.1  christos 		} else {
    279  1.1  christos 			/* Record the request if it wasn't satisfied. */
    280  1.1  christos 			selrecord(curlwp, &pl->psel);
    281  1.1  christos 		}
    282  1.1  christos 		break;
    283  1.1  christos 	case WRITE_WAITING:
    284  1.3  christos 		if (events & (POLLIN | POLLRDNORM)) {
    285  1.1  christos 			/* When device is in WRITE_WAITING state it can read. */
    286  1.3  christos 			revents |= POLLIN | POLLRDNORM;
    287  1.1  christos 		} else {
    288  1.1  christos 			/* Record the request if it wasn't satisfied. */
    289  1.1  christos 			selrecord(curlwp, &pl->psel);
    290  1.1  christos 		}
    291  1.1  christos 		break;
    292  1.1  christos 	}
    293  1.1  christos 
    294  1.1  christos 	mutex_exit(&pl->lock);
    295  1.1  christos 	return revents;
    296  1.1  christos }
    297  1.1  christos 
    298  1.1  christos MODULE(MODULE_CLASS_MISC, pollpal, NULL);
    299  1.1  christos 
    300  1.1  christos static int
    301  1.1  christos pollpal_modcmd(modcmd_t cmd, void *arg __unused)
    302  1.1  christos {
    303  1.1  christos 	int cmajor = 351, bmajor = -1;
    304  1.1  christos 
    305  1.1  christos 	switch (cmd) {
    306  1.1  christos 	case MODULE_CMD_INIT:
    307  1.1  christos 		if (devsw_attach("pollpal", NULL, &bmajor, &pollpal_cdevsw,
    308  1.1  christos 		    &cmajor))
    309  1.1  christos 			return ENXIO;
    310  1.1  christos 		return 0;
    311  1.1  christos 	case MODULE_CMD_FINI:
    312  1.1  christos 		if (pollpal_nopen != 0)
    313  1.1  christos 			return EBUSY;
    314  1.4  riastrad 		devsw_detach(NULL, &pollpal_cdevsw);
    315  1.4  riastrad 		return 0;
    316  1.1  christos 	default:
    317  1.1  christos 		return ENOTTY;
    318  1.1  christos 	}
    319  1.1  christos }
    320