/* $NetBSD: svr4_stream.c,v 1.4 1995/02/01 01:37:37 christos Exp $ */ /* * Copyright (c) 1994 Christos Zoulas * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ /* * Pretend that we have streams... */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include static int svr4_sockmod(fp, ioc, p) struct file *fp; struct svr4_strioctl *ioc; struct proc *p; { int error; switch (ioc->cmd) { case SVR4_SI_GETUDATA: { struct svr4_si_udata ud; struct socket *so = (struct socket *) fp->f_data; DPRINTF(("SI_GETUDATA\n")); if (sizeof(ud) != ioc->len) { DPRINTF(("Wrong size %d != %d\n", sizeof(ud), ioc->len)); return EINVAL; } if ((error = copyin(ioc->buf, &ud, sizeof(ud))) != 0) return error; /* I have no idea what these should be! */ ud.tidusize = 16384; ud.addrsize = sizeof(struct sockaddr_in); ud.optsize = 128; switch (so->so_type) { case SOCK_DGRAM: ud.etsdusize = 0; ud.servtype = 3; /* SOCK_DGRAM ??? */ break; case SOCK_STREAM: ud.etsdusize = 1; ud.servtype = 2; /* SOCK_STREAM ??? */ break; case SOCK_RAW: ud.etsdusize = 0; ud.servtype = 1; /* SOCK_RAW ??? */ break; default: ud.etsdusize = 0; ud.servtype = 0; break; } /* XXX: Fixme */ ud.so_state = 0; ud.so_options = 0; return copyout(&ud, ioc->buf, sizeof(ud)); } case SVR4_SI_SHUTDOWN: DPRINTF(("SI_SHUTDOWN\n")); return 0; case SVR4_SI_LISTEN: DPRINTF(("SI_LISTEN\n")); return 0; case SVR4_SI_SETMYNAME: DPRINTF(("SI_SETMYNAME\n")); return 0; case SVR4_SI_SETPEERNAME: DPRINTF(("SI_SETPEERNAME\n")); return 0; case SVR4_SI_GETINTRANSIT: DPRINTF(("SI_GETINTRANSIT\n")); return 0; case SVR4_SI_TCL_LINK: DPRINTF(("SI_TCL_LINK\n")); return 0; case SVR4_SI_TCL_UNLINK: DPRINTF(("SI_TCL_UNLINK\n")); return 0; default: DPRINTF(("Unknown sockmod ioctl %x\n", ioc->cmd)); return 0; } } static int svr4_timod(fp, ioc, p) struct file *fp; struct svr4_strioctl *ioc; struct proc *p; { int error; switch (ioc->cmd) { case SVR4_TI_GETINFO: DPRINTF(("TI_GETINFO\n")); { struct svr4_infocmd info; bzero(&info, sizeof(info)); if ((error = copyin(ioc->buf, &info, ioc->len)) != 0) return error; if (info.cmd != SVR4_TI_INFO_REQUEST) return EINVAL; info.cmd = SVR4_TI_INFO_REPLY; info.tsdu = 0; info.etsdu = 1; info.cdata = -2; info.ddata = -2; info.addr = 16; info.opt = -1; info.tidu = 16384; info.serv = 2; info.current = 0; info.provider = 2; ioc->len = sizeof(info); if ((error = copyout(&info, ioc->buf, ioc->len)) != 0) return error; } return 0; case SVR4_TI_OPTMGMT: DPRINTF(("TI_OPTMGMT\n")); return 0; case SVR4_TI_BIND: DPRINTF(("TI_BIND\n")); { struct svr4_strmcmd bnd; bzero(&bnd, sizeof(bnd)); if ((error = copyin(ioc->buf, &bnd, ioc->len)) != 0) return error; if (bnd.cmd != SVR4_TI_BIND_REQUEST) return EINVAL; ioc->len = 32; bzero(&bnd, sizeof(bnd)); bnd.cmd = SVR4_TI_BIND_REPLY; bnd.len = sizeof(struct sockaddr_in); bnd.offs = 0x10; if ((error = copyout(&bnd, ioc->buf, ioc->len)) != 0) return error; } return 0; case SVR4_TI_UNBIND: DPRINTF(("TI_UNBIND\n")); return 0; case SVR4_TI_GETMYNAME: DPRINTF(("TI_GETMYNAME\n")); return 0; case SVR4_TI_GETPEERNAME: DPRINTF(("TI_GETPEERNAME\n")); return 0; case SVR4_TI_SETMYNAME: DPRINTF(("TI_SETMYNAME\n")); return 0; case SVR4_TI_SETPEERNAME: DPRINTF(("TI_SETPEERNAME\n")); return 0; default: DPRINTF(("Unknown timod ioctl %x\n", ioc->cmd)); return 0; } } int svr4_streamioctl(fp, cmd, dat, p, retval) struct file *fp; u_long cmd; caddr_t dat; struct proc *p; register_t *retval; { struct svr4_strioctl ioc; int error; *retval = 0; /* * All the following stuff assumes "sockmod" is pushed... */ switch (cmd) { case SVR4_I_NREAD: DPRINTF(("I_NREAD\n")); { int nread = 0; /* XXX: is that FIONREAD? */ if ((error = copyout(&nread, dat, sizeof(nread))) != 0) return error; } return 0; case SVR4_I_PUSH: DPRINTF(("I_PUSH\n")); return 0; case SVR4_I_POP: DPRINTF(("I_POP\n")); return 0; case SVR4_I_LOOK: DPRINTF(("I_LOOK\n")); return 0; case SVR4_I_FLUSH: DPRINTF(("I_FLUSH\n")); return 0; case SVR4_I_SRDOPT: DPRINTF(("I_SRDOPT\n")); return 0; case SVR4_I_GRDOPT: DPRINTF(("I_GRDOPT\n")); return 0; case SVR4_I_STR: DPRINTF(("I_STR\n")); if ((error = copyin(dat, &ioc, sizeof(ioc))) != 0) return error; #ifdef DEBUG_SVR4 { char *ptr = (char *) malloc(ioc.len, M_TEMP, M_WAITOK); int i; printf("cmd = %d, timeout = %d, len = %d, buf = %x { ", ioc.cmd, ioc.timeout, ioc.len, ioc.buf); if ((error = copyin(ioc.buf, ptr, ioc.len)) != 0) { free((char *) ptr, M_TEMP); return error; } for (i = 0; i < ioc.len; i++) printf("%x ", (unsigned char) ptr[i]); printf("}\n"); free((char *) ptr, M_TEMP); } #endif switch (ioc.cmd & 0xff00) { case SVR4_SIMOD: if ((error = svr4_sockmod(fp, &ioc, p)) != 0) return error; break; case SVR4_TIMOD: if ((error = svr4_timod(fp, &ioc, p)) != 0) return error; break; default: DPRINTF(("Unimplemented module %c %d\n", (char) (cmd >> 8), cmd & 0xff)); return 0; } return copyout(&ioc, dat, sizeof(ioc)); case SVR4_I_SETSIG: DPRINTF(("I_SETSIG\n")); return 0; case SVR4_I_GETSIG: DPRINTF(("I_GETSIG\n")); return EINVAL; case SVR4_I_FIND: DPRINTF(("I_FIND\n")); /* * Here we are not pushing modules really, we just * pretend all are present */ *retval = 1; return 0; case SVR4_I_LINK: DPRINTF(("I_LINK\n")); return 0; case SVR4_I_UNLINK: DPRINTF(("I_UNLINK\n")); return 0; case SVR4_I_ERECVFD: DPRINTF(("I_ERECVFD\n")); return 0; case SVR4_I_PEEK: DPRINTF(("I_PEEK\n")); return 0; case SVR4_I_FDINSERT: DPRINTF(("I_FDINSERT\n")); return 0; case SVR4_I_SENDFD: DPRINTF(("I_SENDFD\n")); return 0; case SVR4_I_RECVFD: DPRINTF(("I_RECVFD\n")); return 0; case SVR4_I_SWROPT: DPRINTF(("I_SWROPT\n")); return 0; case SVR4_I_GWROPT: DPRINTF(("I_GWROPT\n")); return 0; case SVR4_I_LIST: DPRINTF(("I_LIST\n")); return 0; case SVR4_I_PLINK: DPRINTF(("I_PLINK\n")); return 0; case SVR4_I_PUNLINK: DPRINTF(("I_PUNLINK\n")); return 0; case SVR4_I_SETEV: DPRINTF(("I_SETEV\n")); return 0; case SVR4_I_GETEV: DPRINTF(("I_GETEV\n")); return 0; case SVR4_I_STREV: DPRINTF(("I_STREV\n")); return 0; case SVR4_I_UNSTREV: DPRINTF(("I_UNSTREV\n")); return 0; case SVR4_I_FLUSHBAND: DPRINTF(("I_FLUSHBAND\n")); return 0; case SVR4_I_CKBAND: DPRINTF(("I_CKBAND\n")); return 0; case SVR4_I_GETBAND: DPRINTF(("I_GETBANK\n")); return 0; case SVR4_I_ATMARK: DPRINTF(("I_ATMARK\n")); return 0; case SVR4_I_SETCLTIME: DPRINTF(("I_SETCLTIME\n")); return 0; case SVR4_I_GETCLTIME: DPRINTF(("I_GETCLTIME\n")); return 0; case SVR4_I_CANPUT: DPRINTF(("I_CANPUT\n")); return 0; default: DPRINTF(("unimpl cmd = %x\n", cmd)); break; } return 0; } #ifdef DEBUG_SVR4 static int svr4_getstrbuf(str) struct svr4_strbuf *str; { int error; int i; char *ptr = NULL; int maxlen = str->maxlen; int len = str->len; if (maxlen < 0) maxlen = 0; if (len >= maxlen || len <= 0) len = maxlen; if (len != 0) { ptr = malloc(len, M_TEMP, M_WAITOK); if ((error = copyin(str->buf, ptr, len)) != 0) { free((char *) ptr, M_TEMP); return error; } } printf(", { %d, %d, %x=[ ", str->maxlen, str->len, str->buf); for (i = 0; i < len; i++) printf("%x ", (unsigned char) ptr[i]); printf("]}"); if (ptr) free((char *) ptr, M_TEMP); return 0; } static void svr4_showmsg(str, fd, ctl, dat, flags) const char *str; int fd; struct svr4_strbuf *ctl; struct svr4_strbuf *dat; int flags; { struct svr4_strbuf buf; int error; printf("%s(%d", str, fd); if (ctl != NULL) { if ((error = copyin(ctl, &buf, sizeof(buf))) != 0) return; svr4_getstrbuf(&buf); } else printf(", NULL"); if (dat != NULL) { if ((error = copyin(dat, &buf, sizeof(buf))) != 0) return; svr4_getstrbuf(&buf); } else printf(", NULL"); printf(", %x);\n", flags); } #endif int svr4_putmsg(p, uap, retval) register struct proc *p; register struct svr4_putmsg_args *uap; register_t *retval; { struct filedesc *fdp = p->p_fd; struct file *fp = fdp->fd_ofiles[SCARG(uap, fd)]; struct svr4_strbuf dat, ctl; struct svr4_strmcmd sc; struct svr4_netaddr *na; struct socket *so; struct svr4_strm *st; int error; struct sockaddr_in sa, *sap; caddr_t sg; #ifdef DEBUG_SVR4 svr4_showmsg(">putmsg", SCARG(uap, fd), SCARG(uap, ctl), SCARG(uap, dat), SCARG(uap, flags)); #endif if (SCARG(uap, ctl) != NULL) { if ((error = copyin(SCARG(uap, ctl), &ctl, sizeof(ctl))) != 0) return error; } else ctl.len = -1; if (SCARG(uap, dat) != NULL) { if ((error = copyin(SCARG(uap, dat), &dat, sizeof(dat))) != 0) return error; } else dat.len = -1; /* * Only for sockets for now. */ if (fp == NULL || fp->f_type != DTYPE_SOCKET) { DPRINTF(("putmsg: bad file type\n")); return EINVAL; } so = (struct socket *) fp->f_data; st = (struct svr4_strm *) so->so_tpcb; if (ctl.len > sizeof(sc)) { DPRINTF(("putmsg: Bad control size %d != %d\n", ctl.len, sizeof(struct svr4_strmcmd))); return EINVAL; } if ((error = copyin(ctl.buf, &sc, ctl.len)) != 0) return error; if (sc.len != sizeof(sa)) return ENOSYS; na = SVR4_ADDROF(&sc); bzero(&sa, sizeof(sa)); sa.sin_family = na->family; sa.sin_port = na->port; sa.sin_addr.s_addr = na->addr; sg = stackgap_init(); sap = (struct sockaddr_in *) stackgap_alloc(&sg, sizeof(struct sockaddr_in)); if ((error = copyout(&sa, sap, sizeof(sa))) != 0) return error; switch (st->s_cmd = sc.cmd) { case SVR4_TI_CONNECT_REQUEST: /* connect */ { struct connect_args co; co.s = SCARG(uap, fd); co.name = (caddr_t) sap; co.namelen = (int) sizeof(sa); return connect(p, &co, retval); } case SVR4_TI_SENDTO_REQUEST: /* sendto */ { struct msghdr msg; struct iovec aiov; msg.msg_name = (caddr_t) sap; msg.msg_namelen = sizeof(sa); msg.msg_iov = &aiov; msg.msg_iovlen = 1; msg.msg_control = 0; #ifdef COMPAT_OLDSOCK msg.msg_flags = 0; #endif aiov.iov_base = dat.buf; aiov.iov_len = dat.len; error = sendit(p, SCARG(uap, fd), &msg, SCARG(uap, flags), retval); *retval = 0; return error; } default: DPRINTF(("Unimplemented putmsg command %x\n", sc.cmd)); return ENOSYS; } } int svr4_getmsg(p, uap, retval) register struct proc *p; register struct svr4_getmsg_args *uap; register_t *retval; { struct filedesc *fdp = p->p_fd; struct file *fp = fdp->fd_ofiles[SCARG(uap, fd)]; struct getpeername_args ga; struct svr4_strbuf dat, ctl; struct svr4_strmcmd sc; struct svr4_netaddr *na; int error; struct msghdr msg; struct iovec aiov; struct sockaddr_in sa, *sap; struct socket *so; struct svr4_strm *st; int *flen; int fl; caddr_t sg; bzero(&sc, sizeof(sc)); #ifdef DEBUG_SVR4 svr4_showmsg(">getmsg", SCARG(uap, fd), SCARG(uap, ctl), SCARG(uap, dat), 0); #endif if (SCARG(uap, ctl) != NULL) { if ((error = copyin(SCARG(uap, ctl), &ctl, sizeof(ctl))) != 0) return error; } else { ctl.len = -1; ctl.maxlen = 0; } if (SCARG(uap, dat) != NULL) { if ((error = copyin(SCARG(uap, dat), &dat, sizeof(dat))) != 0) return error; } else { dat.len = -1; dat.maxlen = 0; } /* * Only for sockets for now. */ if (fp == NULL || fp->f_type != DTYPE_SOCKET) { DPRINTF(("getmsg: bad file type\n")); return EINVAL; } so = (struct socket *) fp->f_data; st = (struct svr4_strm *) so->so_tpcb; if (ctl.maxlen == -1 || dat.maxlen == -1) { DPRINTF(("getmsg: Cannot handle -1 maxlen (yet)\n")); return ENOSYS; } sg = stackgap_init(); sap = (struct sockaddr_in *) stackgap_alloc(&sg, sizeof(struct sockaddr_in)); flen = (int *) stackgap_alloc(&sg, sizeof(*flen)); fl = sizeof(sa); if ((error = copyout(&fl, flen, sizeof(fl))) != 0) return error; switch (st->s_cmd) { case SVR4_TI_CONNECT_REQUEST: /* * We do the connect in one step, so the putmsg should * have gotten the error. */ sc.cmd = SVR4_TI_OK_REPLY; sc.len = 0; ctl.len = 8; dat.len = -1; fl = 1; break; case SVR4_TI_OK_REPLY: /* * We are immediately after a connect reply, so we send * an connect verification. */ SCARG(&ga, fdes) = SCARG(uap, fd); SCARG(&ga, asa) = (caddr_t) sap; SCARG(&ga, alen) = flen; if ((error = getpeername(p, &ga, retval)) != 0) { DPRINTF(("getpeername failed %d\n", error)); return error; } if ((error = copyin(sap, &sa, sizeof(sa))) != 0) return error; sc.cmd = SVR4_TI_CONNECT_REPLY; sc.len = sizeof(struct sockaddr_in); sc.offs = 0x18; sc.pad[0] = 0x4; sc.pad[1] = 0x14; sc.pad[2] = 0x04000402; na = SVR4_ADDROF(&sc); na->family = sa.sin_family; na->port = sa.sin_port; na->addr = sa.sin_addr.s_addr; ctl.len = 40; dat.len = -1; fl = 0; break; case SVR4_TI_SENDTO_REQUEST: if (ctl.maxlen > 36 && ctl.len < 36) ctl.len = 36; if ((error = copyin(ctl.buf, &sc, ctl.len)) != 0) return error; na = SVR4_ADDROF(&sc); bzero(&sa, sizeof(sa)); sa.sin_family = na->family; sa.sin_port = na->port; sa.sin_addr.s_addr = na->addr; if ((error = copyout(&sa, sap, sizeof(sa))) != 0) return error; msg.msg_name = (caddr_t) sap; msg.msg_namelen = sizeof(sa); msg.msg_iov = &aiov; msg.msg_iovlen = 1; msg.msg_control = 0; aiov.iov_base = dat.buf; aiov.iov_len = dat.maxlen; msg.msg_flags = 0; error = recvit(p, SCARG(uap, fd), &msg, flen, retval); if (error) { DPRINTF(("recvit failed %d\n", error)) return error; } if ((error = copyin(msg.msg_name, &sa, sizeof(sa))) != 0) return error; sc.cmd = SVR4_TI_RECVFROM_REPLY; sc.len = sizeof(sa); na->family = sa.sin_family; na->port = sa.sin_port; na->addr = sa.sin_addr.s_addr; dat.len = *retval; fl = 0; break; default: DPRINTF(("Unknown state %x\n", st->s_cmd)); return EINVAL; } st->s_cmd = sc.cmd; if (SCARG(uap, ctl)) { if (ctl.len != -1) if ((error = copyout(&sc, ctl.buf, ctl.len)) != 0) return error; if ((error = copyout(&ctl, SCARG(uap, ctl), sizeof(ctl))) != 0) return error; } if (SCARG(uap, dat)) { if ((error = copyout(&dat, SCARG(uap, dat), sizeof(dat))) != 0) return error; } if (SCARG(uap, flags)) { /* XXX: Need translation */ if ((error = copyout(&fl, SCARG(uap, flags), sizeof(fl))) != 0) return error; } *retval = 0; #ifdef DEBUG_SVR4 svr4_showmsg("