1 1.2 pgoyette /* $NetBSD: ping.c,v 1.2 2020/02/05 14:10:47 pgoyette Exp $ */ 2 1.1 kamil 3 1.1 kamil /*- 4 1.1 kamil * Copyright (c) 2020 The NetBSD Foundation, Inc. 5 1.1 kamil * All rights reserved. 6 1.1 kamil * 7 1.1 kamil * Redistribution and use in source and binary forms, with or without 8 1.1 kamil * modification, are permitted provided that the following conditions 9 1.1 kamil * are met: 10 1.1 kamil * 1. Redistributions of source code must retain the above copyright 11 1.1 kamil * notice, this list of conditions and the following disclaimer. 12 1.1 kamil * 2. Redistributions in binary form must reproduce the above copyright 13 1.1 kamil * notice, this list of conditions and the following disclaimer in the 14 1.1 kamil * documentation and/or other materials provided with the distribution. 15 1.1 kamil * 16 1.1 kamil * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.1 kamil * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.1 kamil * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.1 kamil * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.1 kamil * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.1 kamil * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.1 kamil * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.1 kamil * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.1 kamil * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.1 kamil * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.1 kamil * POSSIBILITY OF SUCH DAMAGE. 27 1.1 kamil */ 28 1.1 kamil 29 1.1 kamil #include <sys/cdefs.h> 30 1.2 pgoyette __KERNEL_RCSID(0, "$NetBSD: ping.c,v 1.2 2020/02/05 14:10:47 pgoyette Exp $"); 31 1.1 kamil 32 1.1 kamil #include <sys/param.h> 33 1.1 kamil #include <sys/conf.h> 34 1.1 kamil #include <sys/device.h> 35 1.1 kamil #include <sys/kernel.h> 36 1.1 kamil #include <sys/module.h> 37 1.1 kamil 38 1.1 kamil #include "ping.h" 39 1.1 kamil 40 1.1 kamil /* 41 1.1 kamil * Create a device /dev/ping in order to test this module. 42 1.1 kamil * 43 1.1 kamil * To use this device you need to do: 44 1.1 kamil * mknod /dev/ping b 351 0 45 1.1 kamil * 46 1.1 kamil */ 47 1.1 kamil 48 1.1 kamil dev_type_open(ping_open); 49 1.1 kamil dev_type_close(ping_close); 50 1.1 kamil dev_type_ioctl(ping_ioctl); 51 1.1 kamil 52 1.1 kamil static struct cdevsw ping_cdevsw = { 53 1.1 kamil .d_open = noopen, 54 1.1 kamil .d_close = noclose, 55 1.1 kamil .d_read = noread, 56 1.1 kamil .d_write = nowrite, 57 1.1 kamil .d_ioctl = noioctl, 58 1.1 kamil .d_stop = nostop, 59 1.1 kamil .d_tty = notty, 60 1.1 kamil .d_poll = nopoll, 61 1.1 kamil .d_mmap = nommap, 62 1.1 kamil .d_kqfilter = nokqfilter, 63 1.1 kamil .d_discard = nodiscard, 64 1.1 kamil .d_flag = D_OTHER 65 1.1 kamil }; 66 1.1 kamil 67 1.1 kamil static struct bdevsw ping_bdevsw = { 68 1.1 kamil .d_open = ping_open, 69 1.1 kamil .d_close = ping_close, 70 1.1 kamil .d_strategy = NULL, 71 1.1 kamil .d_ioctl = ping_ioctl, 72 1.1 kamil .d_dump = nodump, 73 1.1 kamil .d_psize = nosize, 74 1.1 kamil .d_discard = nodiscard, 75 1.1 kamil .d_flag = D_OTHER 76 1.1 kamil }; 77 1.1 kamil 78 1.1 kamil struct ping_softc { 79 1.1 kamil int refcnt; 80 1.1 kamil }; 81 1.1 kamil 82 1.1 kamil static struct ping_softc sc; 83 1.1 kamil 84 1.1 kamil int 85 1.1 kamil ping_open(dev_t self __unused, int flag __unused, int mode __unused, 86 1.1 kamil struct lwp *l __unused) 87 1.1 kamil { 88 1.1 kamil if (sc.refcnt > 0) 89 1.1 kamil return EBUSY; 90 1.1 kamil 91 1.1 kamil ++sc.refcnt; 92 1.1 kamil 93 1.1 kamil return 0; 94 1.1 kamil } 95 1.1 kamil 96 1.1 kamil int 97 1.1 kamil ping_close(dev_t self __unused, int flag __unused, int mode __unused, 98 1.1 kamil struct lwp *l __unused) 99 1.1 kamil { 100 1.1 kamil --sc.refcnt; 101 1.1 kamil 102 1.1 kamil return 0; 103 1.1 kamil } 104 1.1 kamil 105 1.1 kamil int 106 1.1 kamil ping_ioctl(dev_t self __unused, u_long cmd, void *data, int flag, 107 1.1 kamil struct lwp *l __unused) 108 1.1 kamil { 109 1.1 kamil switch(cmd) { 110 1.1 kamil case CMD_PING: 111 1.1 kamil printf("ping: pong!\n"); 112 1.1 kamil return 0; 113 1.1 kamil default: 114 1.2 pgoyette return ENOTTY; 115 1.1 kamil } 116 1.1 kamil } 117 1.1 kamil 118 1.1 kamil MODULE(MODULE_CLASS_MISC, ping, NULL); 119 1.1 kamil 120 1.1 kamil static int 121 1.1 kamil ping_modcmd(modcmd_t cmd, void *arg __unused) 122 1.1 kamil { 123 1.1 kamil int bmajor = 351, cmajor = -1; 124 1.1 kamil 125 1.1 kamil switch (cmd) { 126 1.1 kamil case MODULE_CMD_INIT: 127 1.1 kamil if (devsw_attach("ping", &ping_bdevsw, &bmajor, &ping_cdevsw, &cmajor)) 128 1.1 kamil return ENXIO; 129 1.1 kamil return 0; 130 1.1 kamil case MODULE_CMD_FINI: 131 1.1 kamil if (sc.refcnt > 0) 132 1.1 kamil return EBUSY; 133 1.1 kamil 134 1.1 kamil devsw_detach(&ping_bdevsw, &ping_cdevsw); 135 1.1 kamil return 0; 136 1.1 kamil default: 137 1.1 kamil return ENOTTY; 138 1.1 kamil } 139 1.1 kamil } 140