1b5e334bfSbostic /*-
2b5e334bfSbostic * Copyright (c) 1988, 1990 The Regents of the University of California.
3608e088dSsklower * All rights reserved.
4608e088dSsklower *
5608e088dSsklower * %sccs.include.redist.c%
6608e088dSsklower */
7b5e334bfSbostic
8608e088dSsklower #ifndef lint
9b5e334bfSbostic char copyright[] =
10b5e334bfSbostic "@(#) Copyright (c) 1988, 1990 The Regents of the University of California.\n\
11b5e334bfSbostic All rights reserved.\n";
12b5e334bfSbostic #endif /* not lint */
13b5e334bfSbostic
14b5e334bfSbostic #ifndef lint
15*4d63cfedSsklower static char sccsid[] = "@(#)tisink.c 7.11 (Berkeley) 02/25/93";
16608e088dSsklower #endif /* not lint */
17608e088dSsklower
18608e088dSsklower /*
1920437e83Ssklower * This is a test program to be a sink for ISO packets.
20608e088dSsklower */
21088910ecSsklower #include <unistd.h>
22608e088dSsklower #include <sys/param.h>
23608e088dSsklower #include <sys/uio.h>
24608e088dSsklower #include <sys/socket.h>
25608e088dSsklower #include <sys/ioctl.h>
26088910ecSsklower #include <sys/syscall.h>
27608e088dSsklower #include <net/route.h>
28608e088dSsklower #include <net/if.h>
29608e088dSsklower #define TCPT_NTIMERS 4
30608e088dSsklower #include <netiso/iso.h>
31608e088dSsklower #include <netiso/tp_param.h>
32608e088dSsklower #include <netiso/tp_user.h>
33608e088dSsklower
34608e088dSsklower #include <stdio.h>
35608e088dSsklower #include <errno.h>
36608e088dSsklower #include <ctype.h>
37608e088dSsklower #include <netdb.h>
38608e088dSsklower
39608e088dSsklower
40608e088dSsklower #define dbprintf if(verbose)printf
41ee953ebfSsklower #ifdef __STDC__
42ee953ebfSsklower #define try(a,b,c) {x = (a b); dbprintf("%s%s returns %d\n",c,#a,x);\
43ee953ebfSsklower if (x<0) {perror(#a); myexit(0);}}
44ee953ebfSsklower #else
45608e088dSsklower #define try(a,b,c) {x = (a b); dbprintf("%s%s returns %d\n",c,"a",x);\
46608e088dSsklower if (x<0) {perror("a"); myexit(0);}}
47ee953ebfSsklower #endif
48608e088dSsklower
49608e088dSsklower
50608e088dSsklower struct ifreq ifr;
51608e088dSsklower short port = 3000;
52608e088dSsklower struct sockaddr_iso faddr, laddr = { sizeof(laddr), AF_ISO };
53608e088dSsklower struct sockaddr_iso *siso = &laddr;
548c38a06fSsklower char **xenvp;
55608e088dSsklower
56088910ecSsklower long size, forkp = 0, confp = 0, mynamep, verbose = 1, echop = 0;
57530c0008Ssklower long records, intercept = 0, isode_mode = 0, dgramp = 0, tp0mode = 0;
58*4d63cfedSsklower long dumpnodata = 0, playtag = 0, select_mode = 0, tuba = 0;
59530c0008Ssklower void savedata();
60608e088dSsklower
61608e088dSsklower char buf[2048];
62608e088dSsklower char your_it[] = "You're it!";
63088910ecSsklower fd_set readfds, exceptfds;
64608e088dSsklower
65608e088dSsklower char *Servername;
66608e088dSsklower
main(argc,argv,envp)678c38a06fSsklower main(argc, argv, envp)
68608e088dSsklower int argc;
69608e088dSsklower char *argv[];
708c38a06fSsklower char *envp[];
71608e088dSsklower {
72608e088dSsklower register char **av = argv;
73608e088dSsklower register char *cp;
7420437e83Ssklower struct iso_addr *iso_addr();
75608e088dSsklower
768c38a06fSsklower xenvp = envp;
77608e088dSsklower while(--argc > 0) {
78608e088dSsklower av++;
79608e088dSsklower if(strcmp(*av,"Servername")==0) {
80608e088dSsklower av++;
81608e088dSsklower Servername = *av;
82608e088dSsklower argc--;
83608e088dSsklower } else if (strcmp(*av,"host")==0) {
84608e088dSsklower av++;
8520437e83Ssklower laddr.siso_addr = *iso_addr(*av);
86608e088dSsklower argc--;
87608e088dSsklower } else if (strcmp(*av,"port")==0) {
88608e088dSsklower av++;
89608e088dSsklower sscanf(*av,"%hd",&port);
90608e088dSsklower argc--;
91608e088dSsklower } else if (strcmp(*av,"size")==0) {
92608e088dSsklower av++;
93608e088dSsklower sscanf(*av,"%ld",&size);
94608e088dSsklower argc--;
95ee953ebfSsklower } else if (strcmp(*av, "echo")==0) {
96ee953ebfSsklower echop++;
973bbb5c56Ssklower } else if (strcmp(*av, "intercept")==0) {
983bbb5c56Ssklower intercept++;
99608e088dSsklower }
100608e088dSsklower }
101608e088dSsklower if (Servername) {
102608e088dSsklower int tlen = laddr.siso_tlen = strlen(Servername);
103608e088dSsklower int len = TSEL(siso) + tlen - (caddr_t) &siso;
104608e088dSsklower if (len > sizeof(*siso)) {
105608e088dSsklower siso = (struct sockaddr_iso *)malloc(len);
106608e088dSsklower *siso = laddr;
107608e088dSsklower siso->siso_len = len;
108608e088dSsklower }
109608e088dSsklower bcopy(Servername, TSEL(siso), tlen);
110608e088dSsklower } else {
111608e088dSsklower port = htons(port);
112608e088dSsklower laddr.siso_tlen = sizeof(port);
113608e088dSsklower bcopy((char *)&port, TSEL(siso), sizeof(port));
114608e088dSsklower }
115608e088dSsklower tisink();
116608e088dSsklower }
117608e088dSsklower #define BIG 2048
118608e088dSsklower #define MIDLIN 512
119608e088dSsklower char readbuf[BIG];
120608e088dSsklower struct iovec iov[1] = {
121608e088dSsklower readbuf,
122608e088dSsklower sizeof readbuf,
123608e088dSsklower };
124608e088dSsklower char name[MIDLIN];
125608e088dSsklower union {
126608e088dSsklower struct {
127608e088dSsklower struct cmsghdr cmhdr;
128608e088dSsklower char cmdata[128 - sizeof(struct cmsghdr)];
129608e088dSsklower } cm;
130608e088dSsklower char data[128];
131608e088dSsklower } cbuf;
132608e088dSsklower #define control cbuf.data
133608e088dSsklower struct msghdr msghdr = {
134608e088dSsklower name, sizeof(name),
135608e088dSsklower iov, sizeof(iov)/sizeof(iov[1]),
136608e088dSsklower control, sizeof control,
137608e088dSsklower 0 /* flags */
138608e088dSsklower };
139608e088dSsklower
tisink()140608e088dSsklower tisink()
141608e088dSsklower {
14220437e83Ssklower int x, s, pid, on = 1, loop = 0, n, ns;
143608e088dSsklower extern int errno;
144*4d63cfedSsklower int socktype = (dgramp ? SOCK_DGRAM :
145*4d63cfedSsklower (tuba ? SOCK_STREAM :SOCK_SEQPACKET));
146*4d63cfedSsklower int proto = (tp0mode ? ISOPROTO_TP0 : (tuba ? ISOPROTO_TCP : 0 ));
14720437e83Ssklower int addrlen = sizeof(faddr);
148608e088dSsklower
149530c0008Ssklower try(socket, (AF_ISO, socktype, proto),"");
150608e088dSsklower
151608e088dSsklower s = x;
152608e088dSsklower
153608e088dSsklower try(bind, (s, (struct sockaddr *) siso, siso->siso_len), "");
154608e088dSsklower
155608e088dSsklower /*try(setsockopt, (s, SOL_SOCKET, SO_DEBUG, &on, sizeof (on)), ""); */
15620437e83Ssklower if (dgramp) {
15720437e83Ssklower ns = s;
15820437e83Ssklower goto dgram1;
15920437e83Ssklower }
160608e088dSsklower
161608e088dSsklower try(listen, (s, 5), "");
1624de03591Ssklower if (intercept) {
1634de03591Ssklower try(setsockopt,
1644de03591Ssklower (s, SOL_TRANSPORT, TPOPT_INTERCEPT, &on, sizeof(on)), "");
1654de03591Ssklower }
166608e088dSsklower for(;;) {
16720437e83Ssklower int child;
168608e088dSsklower char childname[50];
169608e088dSsklower
170530c0008Ssklower try (accept, (s, (struct sockaddr *)&faddr, &addrlen), "");
171608e088dSsklower ns = x;
172608e088dSsklower dumpit("connection from:", &faddr, sizeof faddr);
1733bbb5c56Ssklower if (mynamep || intercept) {
174608e088dSsklower addrlen = sizeof(faddr);
175530c0008Ssklower try (getsockname,
176530c0008Ssklower (ns, (struct sockaddr *)&faddr, &addrlen), "");
177608e088dSsklower dumpit("connected as:", &faddr, addrlen);
178608e088dSsklower }
179608e088dSsklower loop++;
180608e088dSsklower if(loop > 3) myexit(0);
181608e088dSsklower if (forkp) {
182608e088dSsklower try(fork, (), "");
183608e088dSsklower } else
184608e088dSsklower x = 0;
185608e088dSsklower if (x == 0) {
186608e088dSsklower long n, count = 0, cn, flags;
187608e088dSsklower records = 0;
188608e088dSsklower if (confp) {
189608e088dSsklower msghdr.msg_iovlen = 0;
190608e088dSsklower msghdr.msg_namelen = 0;
191608e088dSsklower msghdr.msg_controllen =
192608e088dSsklower cbuf.cm.cmhdr.cmsg_len = sizeof (cbuf.cm.cmhdr);
193608e088dSsklower cbuf.cm.cmhdr.cmsg_level = SOL_TRANSPORT;
194608e088dSsklower cbuf.cm.cmhdr.cmsg_type = TPOPT_CFRM_DATA;
195608e088dSsklower n = sendmsg(ns, &msghdr, 0);
19620437e83Ssklower if (n < 0) {
197608e088dSsklower printf("confirm: errno is %d\n", errno);
198608e088dSsklower fflush(stdout);
199608e088dSsklower perror("Confirm error");
200608e088dSsklower } else {
201608e088dSsklower dbprintf("confim ok\n");
202608e088dSsklower }
203088910ecSsklower sleep(3);
204608e088dSsklower }
2058c38a06fSsklower #ifdef ISODE_MODE
2068c38a06fSsklower if (isode_mode) {
2078c38a06fSsklower static char fdbuf[10];
2088c38a06fSsklower static char *nargv[4] =
2098c38a06fSsklower {"/usr/sbin/isod.tsap", fdbuf, "", 0};
2108c38a06fSsklower sprintf(fdbuf, "Z%d", ns);
2118c38a06fSsklower old_isod_main(3, nargv, xenvp);
212088910ecSsklower myexit(0);
213088910ecSsklower }
2148c38a06fSsklower #endif
215608e088dSsklower for (;;) {
21620437e83Ssklower dgram1:
217608e088dSsklower msghdr.msg_iovlen = 1;
218608e088dSsklower msghdr.msg_controllen = sizeof(control);
21920437e83Ssklower msghdr.msg_namelen = (dgramp ? (sizeof name) : 0);
220608e088dSsklower iov->iov_len = sizeof(readbuf);
221088910ecSsklower if (select_mode)
222088910ecSsklower sel_recvwait(ns);
223608e088dSsklower n = recvmsg(ns, &msghdr, 0);
224608e088dSsklower flags = msghdr.msg_flags;
225608e088dSsklower count++;
226608e088dSsklower dbprintf("recvmsg from child %d got %d ctl %d flags %x\n",
22720437e83Ssklower getpid(), n, (cn = msghdr.msg_controllen), flags);
228608e088dSsklower fflush(stdout);
22920437e83Ssklower if (dgramp && msghdr.msg_namelen && verbose)
23020437e83Ssklower dumpit("from:\n", name, msghdr.msg_namelen);
231608e088dSsklower if (cn && verbose)
232608e088dSsklower dumpit("control data:\n", control, cn);
233608e088dSsklower if (n < 0) {
234608e088dSsklower fprintf(stderr, "errno is %d\n", errno);
235608e088dSsklower perror("recvmsg");
236608e088dSsklower /*sleep (10);*/
237608e088dSsklower break;
238608e088dSsklower } else {
239608e088dSsklower if (verbose)
240608e088dSsklower dumpit("data:\n", readbuf, n);
241608e088dSsklower }
242530c0008Ssklower if (echop)
243530c0008Ssklower savedata(n, flags);
244530c0008Ssklower if (flags & MSG_EOR) {
245608e088dSsklower records++;
246530c0008Ssklower if (echop)
247530c0008Ssklower answerback(ns);
248608e088dSsklower }
249608e088dSsklower errno = 0;
250608e088dSsklower }
251608e088dSsklower myexit(0);
252608e088dSsklower }
253608e088dSsklower }
254ee953ebfSsklower }
255530c0008Ssklower struct savebuf {
256530c0008Ssklower struct savebuf *s_next;
257530c0008Ssklower struct savebuf *s_prev;
258530c0008Ssklower int s_n;
259530c0008Ssklower int s_flags;
260530c0008Ssklower } savebuf = {&savebuf, &savebuf};
261530c0008Ssklower
262530c0008Ssklower void
savedata(n,flags)263530c0008Ssklower savedata(n, flags)
264530c0008Ssklower int n, flags;
265608e088dSsklower {
266530c0008Ssklower register struct savebuf *s = (struct savebuf *)malloc(n + sizeof *s);
267530c0008Ssklower if (s == 0)
268530c0008Ssklower return;
269530c0008Ssklower insque(s, savebuf.s_prev);
270530c0008Ssklower s->s_n = n;
271530c0008Ssklower s->s_flags = flags;
272530c0008Ssklower bcopy(readbuf, (char *)(s + 1), n);
273530c0008Ssklower }
274530c0008Ssklower
answerback(ns)275530c0008Ssklower answerback(ns)
276530c0008Ssklower {
277530c0008Ssklower int n;
278530c0008Ssklower register struct savebuf *s = savebuf.s_next, *t;
279530c0008Ssklower static struct iovec iov[1];
280530c0008Ssklower static struct msghdr msghdr = { 0, 0, iov, 1, 0, 0, 0};
281530c0008Ssklower while (s != &savebuf) {
282530c0008Ssklower iov->iov_len = s->s_n;
283530c0008Ssklower iov->iov_base = (char *)(s + 1);
284530c0008Ssklower n = sendmsg(ns, &msghdr, s->s_flags);
285608e088dSsklower dbprintf("echoed %d\n", n);
286530c0008Ssklower t = s; s = s->s_next; remque(t); free((char *)t);
287530c0008Ssklower }
288608e088dSsklower }
289608e088dSsklower
dumpit(what,where,n)290608e088dSsklower dumpit(what, where, n)
291608e088dSsklower char *what; unsigned short *where; int n;
292608e088dSsklower {
293608e088dSsklower unsigned short *s = where;
294608e088dSsklower unsigned short *z = where + (n+1)/2;
295608e088dSsklower int count = 0;
296ee953ebfSsklower if (dumpnodata)
297ee953ebfSsklower return;
298608e088dSsklower printf(what);
299608e088dSsklower while(s < z) {
300608e088dSsklower count++;
301608e088dSsklower printf("%x ",*s++);
302608e088dSsklower if ((count & 15) == 0)
303608e088dSsklower putchar('\n');
304608e088dSsklower }
305608e088dSsklower if (count & 15)
306608e088dSsklower putchar('\n');
307608e088dSsklower fflush(stdout);
308608e088dSsklower }
myexit(n)309608e088dSsklower myexit(n)
310608e088dSsklower {
311608e088dSsklower fflush(stderr);
312608e088dSsklower printf("got %d records\n", records);
313608e088dSsklower fflush(stdout);
314608e088dSsklower exit(n);
315608e088dSsklower }
316088910ecSsklower
sel_recvwait(fd)317088910ecSsklower sel_recvwait(fd)
318088910ecSsklower int fd;
319088910ecSsklower {
320088910ecSsklower int x;
321088910ecSsklower do {
322088910ecSsklower FD_ZERO(&readfds);
323088910ecSsklower FD_ZERO(&exceptfds);
324088910ecSsklower FD_SET(fd, &readfds);
325088910ecSsklower FD_SET(fd, &exceptfds);
326088910ecSsklower x = select(fd+1, &readfds, (fd_set *)0, &exceptfds, (void *)0);
327088910ecSsklower dbprintf("select returns %d\n", x);
328088910ecSsklower } while (x <= 0 ||
329088910ecSsklower (FD_ISSET(fd,&readfds) == 0 && FD_ISSET(fd,&exceptfds) == 0));
330088910ecSsklower }
331088910ecSsklower
332088910ecSsklower #include <sys/syscall.h>
333088910ecSsklower /* Here for gdb trapping */
setsockopt(s,level,optname,optval,optlen)334088910ecSsklower setsockopt(s, level, optname, optval, optlen)
335088910ecSsklower int s, level, optname, optlen;
336088910ecSsklower const void *optval;
337088910ecSsklower {
338088910ecSsklower
339088910ecSsklower dbprintf("setsocket called s %d, level 0x%x, optname %d, optlen %d\n",
340088910ecSsklower s, level, optname, optlen);
341088910ecSsklower dumpit("", optval, optlen);
342088910ecSsklower return syscall(SYS_setsockopt, s, level, optname, optval, optlen);
343088910ecSsklower }
344