855 lines
17 KiB
C
855 lines
17 KiB
C
/* $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 <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/tty.h>
|
|
#include <sys/file.h>
|
|
#include <sys/filedesc.h>
|
|
#include <sys/select.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/socketvar.h>
|
|
#include <net/if.h>
|
|
#include <netinet/in.h>
|
|
#include <sys/mount.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/vnode.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <sys/syscallargs.h>
|
|
|
|
#include <compat/svr4/svr4_types.h>
|
|
#include <compat/svr4/svr4_util.h>
|
|
#include <compat/svr4/svr4_signal.h>
|
|
#include <compat/svr4/svr4_syscallargs.h>
|
|
#include <compat/svr4/svr4_stropts.h>
|
|
#include <compat/svr4/svr4_timod.h>
|
|
#include <compat/svr4/svr4_sockmod.h>
|
|
#include <compat/svr4/svr4_ioctl.h>
|
|
|
|
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("<getmsg", SCARG(uap, fd), SCARG(uap, ctl),
|
|
SCARG(uap, dat), fl);
|
|
#endif
|
|
return error;
|
|
}
|