sys/dev/streams/streams.c

   1 /*
   2  * Copyright (c) 1998 Mark Newton
   3  * Copyright (c) 1994 Christos Zoulas
   4  * Copyright (c) 1997 Todd Vierling
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  * 3. The names of the authors may not be used to endorse or promote products
  16  *    derived from this software without specific prior written permission
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28  *
  29  * Stolen from NetBSD /sys/compat/svr4/svr4_net.c.  Pseudo-device driver
  30  * skeleton produced from /usr/share/examples/drivers/make_pseudo_driver.sh
  31  * in 3.0-980524-SNAP then hacked a bit (but probably not enough :-).
  32  *
  33  * $FreeBSD$
  34  */
  35
  36 #include <sys/param.h>
  37 #include <sys/systm.h>
  38 #include <sys/kernel.h>         /* SYSINIT stuff */
  39 #include <sys/conf.h>           /* cdevsw stuff */
  40 #include <sys/malloc.h>         /* malloc region definitions */
  41 #include <sys/file.h>
  42 #include <sys/filedesc.h>
  43 #include <sys/unistd.h>
  44 #include <sys/fcntl.h>
  45 #include <sys/socket.h>
  46 #include <sys/protosw.h>
  47 #include <sys/socketvar.h>
  48 #include <sys/un.h>
  49 #include <sys/domain.h>
  50 #include <net/if.h>
  51 #include <netinet/in.h>
  52 #include <sys/proc.h>
  53 #include <sys/uio.h>
  54
  55 #include <sys/sysproto.h>
  56
  57 #include <svr4/svr4_types.h>
  58 #include <svr4/svr4_util.h>
  59 #include <svr4/svr4_signal.h>
  60 #include <svr4/svr4_ioctl.h>
  61 #include <svr4/svr4_stropts.h>
  62 #include <svr4/svr4_socket.h>
  63
  64 static int svr4_soo_close __P((struct file *, struct proc *));
  65 static int svr4_ptm_alloc __P((struct proc *));
  66 static  d_open_t        streamsopen;
  67
  68 struct svr4_sockcache_entry {
  69         struct proc *p;         /* Process for the socket               */
  70         void *cookie;           /* Internal cookie used for matching    */
  71         struct sockaddr_un sock;/* Pathname for the socket              */
  72         dev_t dev;              /* Device where the socket lives on     */
  73         ino_t ino;              /* Inode where the socket lives on      */
  74         TAILQ_ENTRY(svr4_sockcache_entry) entries;
  75 };
  76
  77 TAILQ_HEAD(svr4_sockcache_head, svr4_sockcache_entry) svr4_head;
  78
  79 /* Initialization flag (set/queried by svr4_mod LKM) */
  80 int svr4_str_initialized = 0;
  81
  82 /*
  83  * Device minor numbers
  84  */
  85 enum {
  86         dev_ptm                 = 10,
  87         dev_arp                 = 26,
  88         dev_icmp                = 27,
  89         dev_ip                  = 28,
  90         dev_tcp                 = 35,
  91         dev_udp                 = 36,
  92         dev_rawip               = 37,
  93         dev_unix_dgram          = 38,
  94         dev_unix_stream         = 39,
  95         dev_unix_ord_stream     = 40
  96 };
  97
  98 dev_t dt_ptm, dt_arp, dt_icmp, dt_ip, dt_tcp, dt_udp, dt_rawip,
  99         dt_unix_dgram, dt_unix_stream, dt_unix_ord_stream;
 100
 101 static struct fileops svr4_netops = {
 102         soo_read, soo_write, soo_ioctl, soo_poll, soo_stat, svr4_soo_close
 103 };
 104
 105 #define CDEV_MAJOR 103
 106 static struct cdevsw streams_cdevsw = {
 107         /* open */      streamsopen,
 108         /* close */     noclose,
 109         /* read */      noread,
 110         /* write */     nowrite,
 111         /* ioctl */     noioctl,
 112         /* poll */      nopoll,
 113         /* mmap */      nommap,
 114         /* strategy */  nostrategy,
 115         /* name */      "streams",
 116         /* maj */       CDEV_MAJOR,
 117         /* dump */      nodump,
 118         /* psize */     nopsize,
 119         /* flags */     0,
 120         /* bmaj */      -1
 121 };
 122
 123 struct streams_softc {
 124         struct isa_device *dev;
 125 } ;
 126
 127 #define UNIT(dev) minor(dev)    /* assume one minor number per unit */
 128
 129 typedef struct streams_softc *sc_p;
 130
 131 static  int
 132 streams_modevent(module_t mod, int type, void *unused)
 133 {
 134         switch (type) {
 135         case MOD_LOAD:
 136                 /* XXX should make sure it isn't already loaded first */
 137                 dt_ptm = make_dev(&streams_cdevsw, dev_ptm, 0, 0, 0666,
 138                         "ptm");
 139                 dt_arp = make_dev(&streams_cdevsw, dev_arp, 0, 0, 0666,
 140                         "arp");
 141                 dt_icmp = make_dev(&streams_cdevsw, dev_icmp, 0, 0, 0666,
 142                         "icmp");
 143                 dt_ip = make_dev(&streams_cdevsw, dev_ip, 0, 0, 0666,
 144                         "ip");
 145                 dt_tcp = make_dev(&streams_cdevsw, dev_tcp, 0, 0, 0666,
 146                         "tcp");
 147                 dt_udp = make_dev(&streams_cdevsw, dev_udp, 0, 0, 0666,
 148                         "udp");
 149                 dt_rawip = make_dev(&streams_cdevsw, dev_rawip, 0, 0, 0666,
 150                         "rawip");
 151                 dt_unix_dgram = make_dev(&streams_cdevsw, dev_unix_dgram,
 152                         0, 0, 0666, "ticlts");
 153                 dt_unix_stream = make_dev(&streams_cdevsw, dev_unix_stream,
 154                         0, 0, 0666, "ticots");
 155                 dt_unix_ord_stream = make_dev(&streams_cdevsw,
 156                         dev_unix_ord_stream, 0, 0, 0666, "ticotsord");
 157
 158                 if (! (dt_ptm && dt_arp && dt_icmp && dt_ip && dt_tcp &&
 159                                 dt_udp && dt_rawip && dt_unix_dgram &&
 160                                 dt_unix_stream && dt_unix_ord_stream)) {
 161                         printf("WARNING: device config for STREAMS failed\n");
 162                         printf("Suggest unloading streams KLD\n");
 163                 }
 164                 return 0;
 165         case MOD_UNLOAD:
 166                 /* XXX should check to see if it's busy first */
 167                 destroy_dev(dt_ptm);
 168                 destroy_dev(dt_arp);
 169                 destroy_dev(dt_icmp);
 170                 destroy_dev(dt_ip);
 171                 destroy_dev(dt_tcp);
 172                 destroy_dev(dt_udp);
 173                 destroy_dev(dt_rawip);
 174                 destroy_dev(dt_unix_dgram);
 175                 destroy_dev(dt_unix_stream);
 176                 destroy_dev(dt_unix_ord_stream);
 177
 178                 return 0;
 179         default:
 180                 break;
 181         }
 182         return 0;
 183 }
 184
 185 static moduledata_t streams_mod = {
 186         "streams",
 187         streams_modevent,
 188         0
 189 };
 190 DECLARE_MODULE(streams, streams_mod, SI_SUB_DRIVERS, SI_ORDER_ANY);
 191
 192 /*
 193  * We only need open() and close() routines.  open() calls socreate()
 194  * to allocate a "real" object behind the stream and mallocs some state
 195  * info for use by the svr4 emulator;  close() deallocates the state
 196  * information and passes the underlying object to the normal socket close
 197  * routine.
 198  */
 199 static  int
 200 streamsopen(dev_t dev, int oflags, int devtype, struct proc *p)
 201 {
 202         int type, protocol;
 203         int fd;
 204         struct file *fp;
 205         struct socket *so;
 206         int error;
 207         int family;
 208
 209         if (p->p_dupfd >= 0)
 210           return ENODEV;
 211
 212         switch (minor(dev)) {
 213         case dev_udp:
 214           family = AF_INET;
 215           type = SOCK_DGRAM;
 216           protocol = IPPROTO_UDP;
 217           break;
 218
 219         case dev_tcp:
 220           family = AF_INET;
 221           type = SOCK_STREAM;
 222           protocol = IPPROTO_TCP;
 223           break;
 224
 225         case dev_ip:
 226         case dev_rawip:
 227           family = AF_INET;
 228           type = SOCK_RAW;
 229           protocol = IPPROTO_IP;
 230           break;
 231
 232         case dev_icmp:
 233           family = AF_INET;
 234           type = SOCK_RAW;
 235           protocol = IPPROTO_ICMP;
 236           break;
 237
 238         case dev_unix_dgram:
 239           family = AF_LOCAL;
 240           type = SOCK_DGRAM;
 241           protocol = 0;
 242           break;
 243
 244         case dev_unix_stream:
 245         case dev_unix_ord_stream:
 246           family = AF_LOCAL;
 247           type = SOCK_STREAM;
 248           protocol = 0;
 249           break;
 250
 251         case dev_ptm:
 252           return svr4_ptm_alloc(p);
 253
 254         default:
 255           return EOPNOTSUPP;
 256         }
 257
 258         if ((error = falloc(p, &fp, &fd)) != 0)
 259           return error;
 260
 261         if ((error = socreate(family, &so, type, protocol, p)) != 0) {
 262           p->p_fd->fd_ofiles[fd] = 0;
 263           ffree(fp);
 264           return error;
 265         }
 266
 267         fp->f_data = (caddr_t)so;
 268         fp->f_flag = FREAD|FWRITE;
 269         fp->f_ops = &svr4_netops;
 270         fp->f_type = DTYPE_SOCKET;
 271
 272         (void)svr4_stream_get(fp);
 273         p->p_dupfd = fd;
 274         return ENXIO;
 275 }
 276
 277 static int
 278 svr4_ptm_alloc(p)
 279         struct proc *p;
 280 {
 281         /*
 282          * XXX this is very, very ugly.  But I can't find a better
 283          * way that won't duplicate a big amount of code from
 284          * sys_open().  Ho hum...
 285          *
 286          * Fortunately for us, Solaris (at least 2.5.1) makes the
 287          * /dev/ptmx open automatically just open a pty, that (after
 288          * STREAMS I_PUSHes), is just a plain pty.  fstat() is used
 289          * to get the minor device number to map to a tty.
 290          *
 291          * Cycle through the names. If sys_open() returns ENOENT (or
 292          * ENXIO), short circuit the cycle and exit.
 293          */
 294         static char ptyname[] = "/dev/ptyXX";
 295         static char ttyletters[] = "pqrstuwxyzPQRST";
 296         static char ttynumbers[] = "0123456789abcdef";
 297         caddr_t sg = stackgap_init();
 298         char *path = stackgap_alloc(&sg, sizeof(ptyname));
 299         struct open_args oa;
 300         int l = 0, n = 0;
 301         register_t fd = -1;
 302         int error;
 303
 304         SCARG(&oa, path) = path;
 305         SCARG(&oa, flags) = O_RDWR;
 306         SCARG(&oa, mode) = 0;
 307
 308         while (fd == -1) {
 309                 ptyname[8] = ttyletters[l];
 310                 ptyname[9] = ttynumbers[n];
 311
 312                 if ((error = copyout(ptyname, path, sizeof(ptyname))) != 0)
 313                         return error;
 314
 315                 switch (error = open(p, &oa)) {
 316                 case ENOENT:
 317                 case ENXIO:
 318                         return error;
 319                 case 0:
 320                         p->p_dupfd = p->p_retval[0];
 321                         return ENXIO;
 322                 default:
 323                         if (ttynumbers[++n] == '\0') {
 324                                 if (ttyletters[++l] == '\0')
 325                                         break;
 326                                 n = 0;
 327                         }
 328                 }
 329         }
 330         return ENOENT;
 331 }
 332
 333
 334 struct svr4_strm *
 335 svr4_stream_get(fp)
 336         struct file *fp;
 337 {
 338         struct socket *so;
 339         struct svr4_strm *st;
 340
 341         if (fp == NULL || fp->f_type != DTYPE_SOCKET)
 342                 return NULL;
 343
 344         so = (struct socket *) fp->f_data;
 345
 346         if (so->so_emuldata)
 347                 return so->so_emuldata;
 348
 349         /* Allocate a new one. */
 350         st = malloc(sizeof(struct svr4_strm), M_TEMP, M_WAITOK);
 351         st->s_family = so->so_proto->pr_domain->dom_family;
 352         st->s_cmd = ~0;
 353         st->s_afd = -1;
 354         st->s_eventmask = 0;
 355         so->so_emuldata = st;
 356         fp->f_ops = &svr4_netops;
 357
 358         return st;
 359 }
 360
 361 void
 362 svr4_delete_socket(p, fp)
 363         struct proc *p;
 364         struct file *fp;
 365 {
 366         struct svr4_sockcache_entry *e;
 367         void *cookie = ((struct socket *) fp->f_data)->so_emuldata;
 368
 369         if (!svr4_str_initialized) {
 370                 TAILQ_INIT(&svr4_head);
 371                 svr4_str_initialized = 1;
 372                 return;
 373         }
 374
 375         for (e = svr4_head.tqh_first; e != NULL; e = e->entries.tqe_next)
 376                 if (e->p == p && e->cookie == cookie) {
 377                         TAILQ_REMOVE(&svr4_head, e, entries);
 378                         DPRINTF(("svr4_delete_socket: %s [%p,%d,%d]\n",
 379                                  e->sock.sun_path, p, e->dev, e->ino));
 380                         free(e, M_TEMP);
 381                         return;
 382                 }
 383 }
 384
 385 static int
 386 svr4_soo_close(struct file *fp, struct proc *p)
 387 {
 388         struct socket *so = (struct socket *)fp->f_data;
 389
 390         /*      CHECKUNIT_DIAG(ENXIO);*/
 391
 392         svr4_delete_socket(p, fp);
 393         free(so->so_emuldata, M_TEMP);
 394         return soo_close(fp, p);
 395         return (0);
 396 }