socket.c 17.1 KB
Newer Older
B
bellard 已提交
1 2
/*
 * Copyright (c) 1995 Danny Gasparovski.
3 4
 *
 * Please read the file COPYRIGHT for the
B
bellard 已提交
5 6 7
 * terms and conditions of the copyright.
 */

8
#include "qemu-common.h"
B
bellard 已提交
9 10
#include <slirp.h>
#include "ip_icmp.h"
B
bellard 已提交
11 12 13
#ifdef __sun__
#include <sys/filio.h>
#endif
B
bellard 已提交
14

15 16 17
static void sofcantrcvmore(struct socket *so);
static void sofcantsendmore(struct socket *so);

B
bellard 已提交
18
struct socket *
19 20
solookup(struct socket *head, struct in_addr laddr, u_int lport,
         struct in_addr faddr, u_int fport)
B
bellard 已提交
21 22
{
	struct socket *so;
23

B
bellard 已提交
24
	for (so = head->so_next; so != head; so = so->so_next) {
25
		if (so->so_lport == lport &&
B
bellard 已提交
26 27 28 29 30
		    so->so_laddr.s_addr == laddr.s_addr &&
		    so->so_faddr.s_addr == faddr.s_addr &&
		    so->so_fport == fport)
		   break;
	}
31

B
bellard 已提交
32 33 34
	if (so == head)
	   return (struct socket *)NULL;
	return so;
35

B
bellard 已提交
36 37 38 39 40 41 42 43
}

/*
 * Create a new socket, initialise the fields
 * It is the responsibility of the caller to
 * insque() it into the correct linked-list
 */
struct socket *
44
socreate(void)
B
bellard 已提交
45 46
{
  struct socket *so;
47

B
bellard 已提交
48 49 50 51 52 53 54 55 56 57 58 59 60
  so = (struct socket *)malloc(sizeof(struct socket));
  if(so) {
    memset(so, 0, sizeof(struct socket));
    so->so_state = SS_NOFDREF;
    so->s = -1;
  }
  return(so);
}

/*
 * remque and free a socket, clobber cache
 */
void
61
sofree(struct socket *so)
B
bellard 已提交
62 63 64 65 66 67 68 69 70
{
  if (so->so_emu==EMU_RSH && so->extra) {
	sofree(so->extra);
	so->extra=NULL;
  }
  if (so == tcp_last_so)
    tcp_last_so = &tcb;
  else if (so == udp_last_so)
    udp_last_so = &udb;
71

B
bellard 已提交
72
  m_free(so->so_m);
73 74

  if(so->so_next && so->so_prev)
B
bellard 已提交
75 76 77 78 79
    remque(so);  /* crashes if so is not in a queue */

  free(so);
}

80
size_t sopreprbuf(struct socket *so, struct iovec *iov, int *np)
B
bellard 已提交
81
{
82
	int n, lss, total;
B
bellard 已提交
83 84 85
	struct sbuf *sb = &so->so_snd;
	int len = sb->sb_datalen - sb->sb_cc;
	int mss = so->so_tcpcb->t_maxseg;
86

87
	DEBUG_CALL("sopreprbuf");
B
bellard 已提交
88
	DEBUG_ARG("so = %lx", (long )so);
89

B
bellard 已提交
90
	len = sb->sb_datalen - sb->sb_cc;
91

92 93 94
	if (len <= 0)
		return 0;

B
bellard 已提交
95
	iov[0].iov_base = sb->sb_wptr;
96 97
        iov[1].iov_base = NULL;
        iov[1].iov_len = 0;
B
bellard 已提交
98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
	if (sb->sb_wptr < sb->sb_rptr) {
		iov[0].iov_len = sb->sb_rptr - sb->sb_wptr;
		/* Should never succeed, but... */
		if (iov[0].iov_len > len)
		   iov[0].iov_len = len;
		if (iov[0].iov_len > mss)
		   iov[0].iov_len -= iov[0].iov_len%mss;
		n = 1;
	} else {
		iov[0].iov_len = (sb->sb_data + sb->sb_datalen) - sb->sb_wptr;
		/* Should never succeed, but... */
		if (iov[0].iov_len > len) iov[0].iov_len = len;
		len -= iov[0].iov_len;
		if (len) {
			iov[1].iov_base = sb->sb_data;
			iov[1].iov_len = sb->sb_rptr - sb->sb_data;
			if(iov[1].iov_len > len)
			   iov[1].iov_len = len;
			total = iov[0].iov_len + iov[1].iov_len;
			if (total > mss) {
				lss = total%mss;
				if (iov[1].iov_len > lss) {
					iov[1].iov_len -= lss;
					n = 2;
				} else {
					lss -= iov[1].iov_len;
					iov[0].iov_len -= lss;
					n = 1;
				}
			} else
				n = 2;
		} else {
			if (iov[0].iov_len > mss)
			   iov[0].iov_len -= iov[0].iov_len%mss;
			n = 1;
		}
	}
135 136 137 138 139 140 141 142 143 144 145 146
	if (np)
		*np = n;

	return iov[0].iov_len + (n - 1) * iov[1].iov_len;
}

/*
 * Read from so's socket into sb_snd, updating all relevant sbuf fields
 * NOTE: This will only be called if it is select()ed for reading, so
 * a read() of 0 (or less) means it's disconnected
 */
int
147
soread(struct socket *so)
148 149 150 151 152 153 154 155 156 157 158 159 160
{
	int n, nn;
	struct sbuf *sb = &so->so_snd;
	struct iovec iov[2];

	DEBUG_CALL("soread");
	DEBUG_ARG("so = %lx", (long )so);

	/*
	 * No need to check if there's enough room to read.
	 * soread wouldn't have been called if there weren't
	 */
	sopreprbuf(so, iov, &n);
161

B
bellard 已提交
162 163 164 165
#ifdef HAVE_READV
	nn = readv(so->s, (struct iovec *)iov, n);
	DEBUG_MISC((dfd, " ... read nn = %d bytes\n", nn));
#else
B
bellard 已提交
166
	nn = recv(so->s, iov[0].iov_base, iov[0].iov_len,0);
167
#endif
B
bellard 已提交
168 169 170 171 172 173 174 175 176 177
	if (nn <= 0) {
		if (nn < 0 && (errno == EINTR || errno == EAGAIN))
			return 0;
		else {
			DEBUG_MISC((dfd, " --- soread() disconnected, nn = %d, errno = %d-%s\n", nn, errno,strerror(errno)));
			sofcantrcvmore(so);
			tcp_sockclosed(sototcpcb(so));
			return -1;
		}
	}
178

B
bellard 已提交
179 180 181 182 183 184 185 186 187 188
#ifndef HAVE_READV
	/*
	 * If there was no error, try and read the second time round
	 * We read again if n = 2 (ie, there's another part of the buffer)
	 * and we read as much as we could in the first read
	 * We don't test for <= 0 this time, because there legitimately
	 * might not be any more data (since the socket is non-blocking),
	 * a close will be detected on next iteration.
	 * A return of -1 wont (shouldn't) happen, since it didn't happen above
	 */
B
bellard 已提交
189 190 191 192 193 194
	if (n == 2 && nn == iov[0].iov_len) {
            int ret;
            ret = recv(so->s, iov[1].iov_base, iov[1].iov_len,0);
            if (ret > 0)
                nn += ret;
        }
195

B
bellard 已提交
196 197
	DEBUG_MISC((dfd, " ... read nn = %d bytes\n", nn));
#endif
198

B
bellard 已提交
199 200 201 202 203 204 205
	/* Update fields */
	sb->sb_cc += nn;
	sb->sb_wptr += nn;
	if (sb->sb_wptr >= (sb->sb_data + sb->sb_datalen))
		sb->sb_wptr -= sb->sb_datalen;
	return nn;
}
206

207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248
int soreadbuf(struct socket *so, const char *buf, int size)
{
    int n, nn, copy = size;
	struct sbuf *sb = &so->so_snd;
	struct iovec iov[2];

	DEBUG_CALL("soreadbuf");
	DEBUG_ARG("so = %lx", (long )so);

	/*
	 * No need to check if there's enough room to read.
	 * soread wouldn't have been called if there weren't
	 */
	if (sopreprbuf(so, iov, &n) < size)
        goto err;

    nn = MIN(iov[0].iov_len, copy);
    memcpy(iov[0].iov_base, buf, nn);

    copy -= nn;
    buf += nn;

    if (copy == 0)
        goto done;

    memcpy(iov[1].iov_base, buf, copy);

done:
    /* Update fields */
	sb->sb_cc += size;
	sb->sb_wptr += size;
	if (sb->sb_wptr >= (sb->sb_data + sb->sb_datalen))
		sb->sb_wptr -= sb->sb_datalen;
    return size;
err:

    sofcantrcvmore(so);
    tcp_sockclosed(sototcpcb(so));
    fprintf(stderr, "soreadbuf buffer to small");
    return -1;
}

B
bellard 已提交
249 250
/*
 * Get urgent data
251
 *
B
bellard 已提交
252 253 254 255 256
 * When the socket is created, we set it SO_OOBINLINE,
 * so when OOB data arrives, we soread() it and everything
 * in the send buffer is sent as urgent data
 */
void
257
sorecvoob(struct socket *so)
B
bellard 已提交
258 259 260 261 262
{
	struct tcpcb *tp = sototcpcb(so);

	DEBUG_CALL("sorecvoob");
	DEBUG_ARG("so = %lx", (long)so);
263

B
bellard 已提交
264 265 266 267 268
	/*
	 * We take a guess at how much urgent data has arrived.
	 * In most situations, when urgent data arrives, the next
	 * read() should get all the urgent data.  This guess will
	 * be wrong however if more data arrives just after the
269
	 * urgent data, or the read() doesn't return all the
B
bellard 已提交
270 271 272 273 274 275 276 277 278 279 280 281 282 283
	 * urgent data.
	 */
	soread(so);
	tp->snd_up = tp->snd_una + so->so_snd.sb_cc;
	tp->t_force = 1;
	tcp_output(tp);
	tp->t_force = 0;
}

/*
 * Send urgent data
 * There's a lot duplicated code here, but...
 */
int
284
sosendoob(struct socket *so)
B
bellard 已提交
285 286 287
{
	struct sbuf *sb = &so->so_rcv;
	char buff[2048]; /* XXX Shouldn't be sending more oob data than this */
288

B
bellard 已提交
289
	int n, len;
290

B
bellard 已提交
291 292 293
	DEBUG_CALL("sosendoob");
	DEBUG_ARG("so = %lx", (long)so);
	DEBUG_ARG("sb->sb_cc = %d", sb->sb_cc);
294

B
bellard 已提交
295 296
	if (so->so_urgc > 2048)
	   so->so_urgc = 2048; /* XXXX */
297

B
bellard 已提交
298 299
	if (sb->sb_rptr < sb->sb_wptr) {
		/* We can send it directly */
300
		n = slirp_send(so, sb->sb_rptr, so->so_urgc, (MSG_OOB)); /* |MSG_DONTWAIT)); */
B
bellard 已提交
301
		so->so_urgc -= n;
302

B
bellard 已提交
303 304
		DEBUG_MISC((dfd, " --- sent %d bytes urgent data, %d urgent bytes left\n", n, so->so_urgc));
	} else {
305
		/*
B
bellard 已提交
306 307 308 309 310 311 312 313 314 315 316 317 318 319 320
		 * Since there's no sendv or sendtov like writev,
		 * we must copy all data to a linear buffer then
		 * send it all
		 */
		len = (sb->sb_data + sb->sb_datalen) - sb->sb_rptr;
		if (len > so->so_urgc) len = so->so_urgc;
		memcpy(buff, sb->sb_rptr, len);
		so->so_urgc -= len;
		if (so->so_urgc) {
			n = sb->sb_wptr - sb->sb_data;
			if (n > so->so_urgc) n = so->so_urgc;
			memcpy((buff + len), sb->sb_data, n);
			so->so_urgc -= n;
			len += n;
		}
321
		n = slirp_send(so, buff, len, (MSG_OOB)); /* |MSG_DONTWAIT)); */
B
bellard 已提交
322 323 324
#ifdef DEBUG
		if (n != len)
		   DEBUG_ERROR((dfd, "Didn't send all data urgently XXXXX\n"));
325
#endif
B
bellard 已提交
326 327
		DEBUG_MISC((dfd, " ---2 sent %d bytes urgent data, %d urgent bytes left\n", n, so->so_urgc));
	}
328

B
bellard 已提交
329 330 331 332
	sb->sb_cc -= n;
	sb->sb_rptr += n;
	if (sb->sb_rptr >= (sb->sb_data + sb->sb_datalen))
		sb->sb_rptr -= sb->sb_datalen;
333

B
bellard 已提交
334 335 336 337
	return n;
}

/*
338
 * Write data from so_rcv to so's socket,
B
bellard 已提交
339 340 341
 * updating all sbuf field as necessary
 */
int
342
sowrite(struct socket *so)
B
bellard 已提交
343 344 345 346 347
{
	int  n,nn;
	struct sbuf *sb = &so->so_rcv;
	int len = sb->sb_cc;
	struct iovec iov[2];
348

B
bellard 已提交
349 350
	DEBUG_CALL("sowrite");
	DEBUG_ARG("so = %lx", (long)so);
351

B
bellard 已提交
352 353 354 355 356 357 358 359 360 361
	if (so->so_urgc) {
		sosendoob(so);
		if (sb->sb_cc == 0)
			return 0;
	}

	/*
	 * No need to check if there's something to write,
	 * sowrite wouldn't have been called otherwise
	 */
362

B
bellard 已提交
363
        len = sb->sb_cc;
364

B
bellard 已提交
365
	iov[0].iov_base = sb->sb_rptr;
366 367
        iov[1].iov_base = NULL;
        iov[1].iov_len = 0;
B
bellard 已提交
368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388
	if (sb->sb_rptr < sb->sb_wptr) {
		iov[0].iov_len = sb->sb_wptr - sb->sb_rptr;
		/* Should never succeed, but... */
		if (iov[0].iov_len > len) iov[0].iov_len = len;
		n = 1;
	} else {
		iov[0].iov_len = (sb->sb_data + sb->sb_datalen) - sb->sb_rptr;
		if (iov[0].iov_len > len) iov[0].iov_len = len;
		len -= iov[0].iov_len;
		if (len) {
			iov[1].iov_base = sb->sb_data;
			iov[1].iov_len = sb->sb_wptr - sb->sb_data;
			if (iov[1].iov_len > len) iov[1].iov_len = len;
			n = 2;
		} else
			n = 1;
	}
	/* Check if there's urgent data to send, and if so, send it */

#ifdef HAVE_READV
	nn = writev(so->s, (const struct iovec *)iov, n);
389

B
bellard 已提交
390 391
	DEBUG_MISC((dfd, "  ... wrote nn = %d bytes\n", nn));
#else
392
	nn = slirp_send(so, iov[0].iov_base, iov[0].iov_len,0);
B
bellard 已提交
393 394 395 396
#endif
	/* This should never happen, but people tell me it does *shrug* */
	if (nn < 0 && (errno == EAGAIN || errno == EINTR))
		return 0;
397

B
bellard 已提交
398 399 400 401 402 403 404
	if (nn <= 0) {
		DEBUG_MISC((dfd, " --- sowrite disconnected, so->so_state = %x, errno = %d\n",
			so->so_state, errno));
		sofcantsendmore(so);
		tcp_sockclosed(sototcpcb(so));
		return -1;
	}
405

B
bellard 已提交
406
#ifndef HAVE_READV
B
bellard 已提交
407 408
	if (n == 2 && nn == iov[0].iov_len) {
            int ret;
409
            ret = slirp_send(so, iov[1].iov_base, iov[1].iov_len,0);
B
bellard 已提交
410 411 412
            if (ret > 0)
                nn += ret;
        }
B
bellard 已提交
413 414
        DEBUG_MISC((dfd, "  ... wrote nn = %d bytes\n", nn));
#endif
415

B
bellard 已提交
416 417 418 419 420
	/* Update sbuf */
	sb->sb_cc -= nn;
	sb->sb_rptr += nn;
	if (sb->sb_rptr >= (sb->sb_data + sb->sb_datalen))
		sb->sb_rptr -= sb->sb_datalen;
421

B
bellard 已提交
422 423 424 425 426 427
	/*
	 * If in DRAIN mode, and there's no more data, set
	 * it CANTSENDMORE
	 */
	if ((so->so_state & SS_FWDRAIN) && sb->sb_cc == 0)
		sofcantsendmore(so);
428

B
bellard 已提交
429 430 431 432 433 434 435
	return nn;
}

/*
 * recvfrom() a UDP socket
 */
void
436
sorecvfrom(struct socket *so)
B
bellard 已提交
437 438
{
	struct sockaddr_in addr;
439
	socklen_t addrlen = sizeof(struct sockaddr_in);
440

B
bellard 已提交
441 442
	DEBUG_CALL("sorecvfrom");
	DEBUG_ARG("so = %lx", (long)so);
443

B
bellard 已提交
444 445 446
	if (so->so_type == IPPROTO_ICMP) {   /* This is a "ping" reply */
	  char buff[256];
	  int len;
447

448
	  len = recvfrom(so->s, buff, 256, 0,
B
bellard 已提交
449 450
			 (struct sockaddr *)&addr, &addrlen);
	  /* XXX Check if reply is "correct"? */
451

B
bellard 已提交
452 453 454 455 456
	  if(len == -1 || len == 0) {
	    u_char code=ICMP_UNREACH_PORT;

	    if(errno == EHOSTUNREACH) code=ICMP_UNREACH_HOST;
	    else if(errno == ENETUNREACH) code=ICMP_UNREACH_NET;
457

B
bellard 已提交
458 459 460 461 462
	    DEBUG_MISC((dfd," udp icmp rx errno = %d-%s\n",
			errno,strerror(errno)));
	    icmp_error(so->so_m, ICMP_UNREACH,code, 0,strerror(errno));
	  } else {
	    icmp_reflect(so->so_m);
463
            so->so_m = NULL; /* Don't m_free() it again! */
B
bellard 已提交
464 465 466 467 468
	  }
	  /* No need for this socket anymore, udp_detach it */
	  udp_detach(so);
	} else {                            	/* A "normal" UDP packet */
	  struct mbuf *m;
B
Blue Swirl 已提交
469 470 471 472 473 474
          int len;
#ifdef _WIN32
          unsigned long n;
#else
          int n;
#endif
B
bellard 已提交
475 476

	  if (!(m = m_get())) return;
477
	  m->m_data += IF_MAXLINKHDR;
478

479
	  /*
B
bellard 已提交
480 481 482 483 484
	   * XXX Shouldn't FIONREAD packets destined for port 53,
	   * but I don't know the max packet size for DNS lookups
	   */
	  len = M_FREEROOM(m);
	  /* if (so->so_fport != htons(53)) { */
B
bellard 已提交
485
	  ioctlsocket(so->s, FIONREAD, &n);
486

B
bellard 已提交
487 488 489 490 491 492
	  if (n > len) {
	    n = (m->m_data - m->m_dat) + m->m_len + n + 1;
	    m_inc(m, n);
	    len = M_FREEROOM(m);
	  }
	  /* } */
493

B
bellard 已提交
494 495
	  m->m_len = recvfrom(so->s, m->m_data, len, 0,
			      (struct sockaddr *)&addr, &addrlen);
496
	  DEBUG_MISC((dfd, " did recvfrom %d, errno = %d-%s\n",
B
bellard 已提交
497 498 499 500 501 502
		      m->m_len, errno,strerror(errno)));
	  if(m->m_len<0) {
	    u_char code=ICMP_UNREACH_PORT;

	    if(errno == EHOSTUNREACH) code=ICMP_UNREACH_HOST;
	    else if(errno == ENETUNREACH) code=ICMP_UNREACH_NET;
503

B
bellard 已提交
504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520
	    DEBUG_MISC((dfd," rx error, tx icmp ICMP_UNREACH:%i\n", code));
	    icmp_error(so->so_m, ICMP_UNREACH,code, 0,strerror(errno));
	    m_free(m);
	  } else {
	  /*
	   * Hack: domain name lookup will be used the most for UDP,
	   * and since they'll only be used once there's no need
	   * for the 4 minute (or whatever) timeout... So we time them
	   * out much quicker (10 seconds  for now...)
	   */
	    if (so->so_expire) {
	      if (so->so_fport == htons(53))
		so->so_expire = curtime + SO_EXPIREFAST;
	      else
		so->so_expire = curtime + SO_EXPIRE;
	    }

521
	    /*
B
bellard 已提交
522 523 524 525 526 527 528 529 530 531 532 533
	     * If this packet was destined for CTL_ADDR,
	     * make it look like that's where it came from, done by udp_output
	     */
	    udp_output(so, m, &addr);
	  } /* rx error */
	} /* if ping packet */
}

/*
 * sendto() a socket
 */
int
534
sosendto(struct socket *so, struct mbuf *m)
B
bellard 已提交
535 536 537 538 539 540 541
{
	int ret;
	struct sockaddr_in addr;

	DEBUG_CALL("sosendto");
	DEBUG_ARG("so = %lx", (long)so);
	DEBUG_ARG("m = %lx", (long)m);
542

B
bellard 已提交
543
        addr.sin_family = AF_INET;
544 545
	if ((so->so_faddr.s_addr & vnetwork_mask.s_addr) ==
	    vnetwork_addr.s_addr) {
B
bellard 已提交
546
	  /* It's an alias */
547
	  if (so->so_faddr.s_addr == vnameserver_addr.s_addr) {
B
bellard 已提交
548
	    addr.sin_addr = dns_addr;
549
	  } else {
B
bellard 已提交
550 551 552 553 554 555 556
	    addr.sin_addr = loopback_addr;
	  }
	} else
	  addr.sin_addr = so->so_faddr;
	addr.sin_port = so->so_fport;

	DEBUG_MISC((dfd, " sendto()ing, addr.sin_port=%d, addr.sin_addr.s_addr=%.16s\n", ntohs(addr.sin_port), inet_ntoa(addr.sin_addr)));
557

B
bellard 已提交
558 559 560 561 562
	/* Don't care what port we get */
	ret = sendto(so->s, m->m_data, m->m_len, 0,
		     (struct sockaddr *)&addr, sizeof (struct sockaddr));
	if (ret < 0)
		return -1;
563

B
bellard 已提交
564 565 566 567 568 569
	/*
	 * Kill the socket if there's no reply in 4 minutes,
	 * but only if it's an expirable socket
	 */
	if (so->so_expire)
		so->so_expire = curtime + SO_EXPIRE;
570 571
	so->so_state &= SS_PERSISTENT_MASK;
	so->so_state |= SS_ISFCONNECTED; /* So that it gets select()ed */
B
bellard 已提交
572 573 574 575
	return 0;
}

/*
576
 * Listen for incoming TCP connections
B
bellard 已提交
577 578
 */
struct socket *
579
tcp_listen(u_int32_t haddr, u_int hport, u_int32_t laddr, u_int lport, int flags)
B
bellard 已提交
580 581 582
{
	struct sockaddr_in addr;
	struct socket *so;
583 584
	int s, opt = 1;
	socklen_t addrlen = sizeof(addr);
B
bellard 已提交
585

586
	DEBUG_CALL("tcp_listen");
B
bellard 已提交
587 588 589 590
	DEBUG_ARG("port = %d", port);
	DEBUG_ARG("laddr = %x", laddr);
	DEBUG_ARG("lport = %d", lport);
	DEBUG_ARG("flags = %x", flags);
591

B
bellard 已提交
592 593 594
	if ((so = socreate()) == NULL) {
	  return NULL;
	}
595

B
bellard 已提交
596 597 598 599 600 601
	/* Don't tcp_attach... we don't need so_snd nor so_rcv */
	if ((so->so_tcpcb = tcp_newtcpcb(so)) == NULL) {
		free(so);
		return NULL;
	}
	insque(so,&tcb);
602 603

	/*
B
bellard 已提交
604 605 606 607
	 * SS_FACCEPTONCE sockets must time out.
	 */
	if (flags & SS_FACCEPTONCE)
	   so->so_tcpcb->t_timer[TCPT_KEEP] = TCPTV_KEEP_INIT*2;
608

609 610
	so->so_state &= SS_PERSISTENT_MASK;
	so->so_state |= (SS_FACCEPTCONN | flags);
B
bellard 已提交
611 612
	so->so_lport = lport; /* Kept in network format */
	so->so_laddr.s_addr = laddr; /* Ditto */
613

B
bellard 已提交
614
	addr.sin_family = AF_INET;
615 616
	addr.sin_addr.s_addr = haddr;
	addr.sin_port = hport;
617

B
bellard 已提交
618
	if (((s = socket(AF_INET,SOCK_STREAM,0)) < 0) ||
P
pbrook 已提交
619
	    (setsockopt(s,SOL_SOCKET,SO_REUSEADDR,(char *)&opt,sizeof(int)) < 0) ||
B
bellard 已提交
620 621 622
	    (bind(s,(struct sockaddr *)&addr, sizeof(addr)) < 0) ||
	    (listen(s,1) < 0)) {
		int tmperrno = errno; /* Don't clobber the real reason we failed */
623

B
bellard 已提交
624 625 626
		close(s);
		sofree(so);
		/* Restore the real errno */
B
bellard 已提交
627 628 629
#ifdef _WIN32
		WSASetLastError(tmperrno);
#else
B
bellard 已提交
630
		errno = tmperrno;
B
bellard 已提交
631
#endif
B
bellard 已提交
632 633 634
		return NULL;
	}
	setsockopt(s,SOL_SOCKET,SO_OOBINLINE,(char *)&opt,sizeof(int));
635

B
bellard 已提交
636 637 638
	getsockname(s,(struct sockaddr *)&addr,&addrlen);
	so->so_fport = addr.sin_port;
	if (addr.sin_addr.s_addr == 0 || addr.sin_addr.s_addr == loopback_addr.s_addr)
639
	   so->so_faddr = vhost_addr;
B
bellard 已提交
640 641 642 643 644 645 646 647 648 649 650 651 652 653
	else
	   so->so_faddr = addr.sin_addr;

	so->s = s;
	return so;
}

/*
 * Various session state calls
 * XXX Should be #define's
 * The socket state stuff needs work, these often get call 2 or 3
 * times each when only 1 was needed
 */
void
654
soisfconnecting(struct socket *so)
B
bellard 已提交
655 656 657 658 659 660 661
{
	so->so_state &= ~(SS_NOFDREF|SS_ISFCONNECTED|SS_FCANTRCVMORE|
			  SS_FCANTSENDMORE|SS_FWDRAIN);
	so->so_state |= SS_ISFCONNECTING; /* Clobber other states */
}

void
662
soisfconnected(struct socket *so)
B
bellard 已提交
663 664 665 666 667
{
	so->so_state &= ~(SS_ISFCONNECTING|SS_FWDRAIN|SS_NOFDREF);
	so->so_state |= SS_ISFCONNECTED; /* Clobber other states */
}

668 669
static void
sofcantrcvmore(struct socket *so)
B
bellard 已提交
670 671 672
{
	if ((so->so_state & SS_NOFDREF) == 0) {
		shutdown(so->s,0);
B
bellard 已提交
673 674 675
		if(global_writefds) {
		  FD_CLR(so->s,global_writefds);
		}
B
bellard 已提交
676 677
	}
	so->so_state &= ~(SS_ISFCONNECTING);
678 679 680 681
	if (so->so_state & SS_FCANTSENDMORE) {
	   so->so_state &= SS_PERSISTENT_MASK;
	   so->so_state |= SS_NOFDREF; /* Don't select it */
	} else {
B
bellard 已提交
682
	   so->so_state |= SS_FCANTRCVMORE;
683
	}
B
bellard 已提交
684 685
}

686 687
static void
sofcantsendmore(struct socket *so)
B
bellard 已提交
688 689
{
	if ((so->so_state & SS_NOFDREF) == 0) {
B
bellard 已提交
690 691 692 693 694 695 696
            shutdown(so->s,1);           /* send FIN to fhost */
            if (global_readfds) {
                FD_CLR(so->s,global_readfds);
            }
            if (global_xfds) {
                FD_CLR(so->s,global_xfds);
            }
B
bellard 已提交
697 698
	}
	so->so_state &= ~(SS_ISFCONNECTING);
699 700 701 702
	if (so->so_state & SS_FCANTRCVMORE) {
	   so->so_state &= SS_PERSISTENT_MASK;
	   so->so_state |= SS_NOFDREF; /* as above */
	} else {
B
bellard 已提交
703
	   so->so_state |= SS_FCANTSENDMORE;
704
	}
B
bellard 已提交
705 706 707 708 709 710 711
}

/*
 * Set write drain mode
 * Set CANTSENDMORE once all data has been write()n
 */
void
712
sofwdrain(struct socket *so)
B
bellard 已提交
713 714 715 716 717 718
{
	if (so->so_rcv.sb_cc)
		so->so_state |= SS_FWDRAIN;
	else
		sofcantsendmore(so);
}