|
|
1.1 ! root 1: /* ! 2: * Copyright (c) 1995 Danny Gasparovski. ! 3: * ! 4: * Please read the file COPYRIGHT for the ! 5: * terms and conditions of the copyright. ! 6: */ ! 7: ! 8: #include <stdlib.h> ! 9: #include <slirp.h> ! 10: ! 11: /* Done as a macro in socket.h */ ! 12: /* int ! 13: * sbspace(struct sockbuff *sb) ! 14: * { ! 15: * return SB_DATALEN - sb->sb_cc; ! 16: * } ! 17: */ ! 18: ! 19: void ! 20: sbfree(sb) ! 21: struct sbuf *sb; ! 22: { ! 23: free(sb->sb_data); ! 24: } ! 25: ! 26: void ! 27: sbdrop(sb, num) ! 28: struct sbuf *sb; ! 29: int num; ! 30: { ! 31: /* ! 32: * We can only drop how much we have ! 33: * This should never succeed ! 34: */ ! 35: if(num > sb->sb_cc) ! 36: num = sb->sb_cc; ! 37: sb->sb_cc -= num; ! 38: sb->sb_rptr += num; ! 39: if(sb->sb_rptr >= sb->sb_data + sb->sb_datalen) ! 40: sb->sb_rptr -= sb->sb_datalen; ! 41: ! 42: } ! 43: ! 44: void ! 45: sbreserve(sb, size) ! 46: struct sbuf *sb; ! 47: int size; ! 48: { ! 49: if (sb->sb_data) { ! 50: /* Already alloced, realloc if necessary */ ! 51: if (sb->sb_datalen != size) { ! 52: sb->sb_wptr = sb->sb_rptr = sb->sb_data = (char *)realloc(sb->sb_data, size); ! 53: sb->sb_cc = 0; ! 54: if (sb->sb_wptr) ! 55: sb->sb_datalen = size; ! 56: else ! 57: sb->sb_datalen = 0; ! 58: } ! 59: } else { ! 60: sb->sb_wptr = sb->sb_rptr = sb->sb_data = (char *)malloc(size); ! 61: sb->sb_cc = 0; ! 62: if (sb->sb_wptr) ! 63: sb->sb_datalen = size; ! 64: else ! 65: sb->sb_datalen = 0; ! 66: } ! 67: } ! 68: ! 69: /* ! 70: * Try and write() to the socket, whatever doesn't get written ! 71: * append to the buffer... for a host with a fast net connection, ! 72: * this prevents an unnecessary copy of the data ! 73: * (the socket is non-blocking, so we won't hang) ! 74: */ ! 75: void ! 76: sbappend(so, m) ! 77: struct socket *so; ! 78: struct mbuf *m; ! 79: { ! 80: int ret = 0; ! 81: ! 82: DEBUG_CALL("sbappend"); ! 83: DEBUG_ARG("so = %lx", (long)so); ! 84: DEBUG_ARG("m = %lx", (long)m); ! 85: DEBUG_ARG("m->m_len = %d", m->m_len); ! 86: ! 87: /* Shouldn't happen, but... e.g. foreign host closes connection */ ! 88: if (m->m_len <= 0) { ! 89: m_free(m); ! 90: return; ! 91: } ! 92: ! 93: /* ! 94: * If there is urgent data, call sosendoob ! 95: * if not all was sent, sowrite will take care of the rest ! 96: * (The rest of this function is just an optimisation) ! 97: */ ! 98: if (so->so_urgc) { ! 99: sbappendsb(&so->so_rcv, m); ! 100: m_free(m); ! 101: sosendoob(so); ! 102: return; ! 103: } ! 104: ! 105: /* ! 106: * We only write if there's nothing in the buffer, ! 107: * ottherwise it'll arrive out of order, and hence corrupt ! 108: */ ! 109: if (!so->so_rcv.sb_cc) ! 110: ret = send(so->s, m->m_data, m->m_len, 0); ! 111: ! 112: if (ret <= 0) { ! 113: /* ! 114: * Nothing was written ! 115: * It's possible that the socket has closed, but ! 116: * we don't need to check because if it has closed, ! 117: * it will be detected in the normal way by soread() ! 118: */ ! 119: sbappendsb(&so->so_rcv, m); ! 120: } else if (ret != m->m_len) { ! 121: /* ! 122: * Something was written, but not everything.. ! 123: * sbappendsb the rest ! 124: */ ! 125: m->m_len -= ret; ! 126: m->m_data += ret; ! 127: sbappendsb(&so->so_rcv, m); ! 128: } /* else */ ! 129: /* Whatever happened, we free the mbuf */ ! 130: m_free(m); ! 131: } ! 132: ! 133: /* ! 134: * Copy the data from m into sb ! 135: * The caller is responsible to make sure there's enough room ! 136: */ ! 137: void ! 138: sbappendsb(sb, m) ! 139: struct sbuf *sb; ! 140: struct mbuf *m; ! 141: { ! 142: int len, n, nn; ! 143: ! 144: len = m->m_len; ! 145: ! 146: if (sb->sb_wptr < sb->sb_rptr) { ! 147: n = sb->sb_rptr - sb->sb_wptr; ! 148: if (n > len) n = len; ! 149: memcpy(sb->sb_wptr, m->m_data, n); ! 150: } else { ! 151: /* Do the right edge first */ ! 152: n = sb->sb_data + sb->sb_datalen - sb->sb_wptr; ! 153: if (n > len) n = len; ! 154: memcpy(sb->sb_wptr, m->m_data, n); ! 155: len -= n; ! 156: if (len) { ! 157: /* Now the left edge */ ! 158: nn = sb->sb_rptr - sb->sb_data; ! 159: if (nn > len) nn = len; ! 160: memcpy(sb->sb_data,m->m_data+n,nn); ! 161: n += nn; ! 162: } ! 163: } ! 164: ! 165: sb->sb_cc += n; ! 166: sb->sb_wptr += n; ! 167: if (sb->sb_wptr >= sb->sb_data + sb->sb_datalen) ! 168: sb->sb_wptr -= sb->sb_datalen; ! 169: } ! 170: ! 171: /* ! 172: * Copy data from sbuf to a normal, straight buffer ! 173: * Don't update the sbuf rptr, this will be ! 174: * done in sbdrop when the data is acked ! 175: */ ! 176: void ! 177: sbcopy(sb, off, len, to) ! 178: struct sbuf *sb; ! 179: int off; ! 180: int len; ! 181: char *to; ! 182: { ! 183: char *from; ! 184: ! 185: from = sb->sb_rptr + off; ! 186: if (from >= sb->sb_data + sb->sb_datalen) ! 187: from -= sb->sb_datalen; ! 188: ! 189: if (from < sb->sb_wptr) { ! 190: if (len > sb->sb_cc) len = sb->sb_cc; ! 191: memcpy(to,from,len); ! 192: } else { ! 193: /* re-use off */ ! 194: off = (sb->sb_data + sb->sb_datalen) - from; ! 195: if (off > len) off = len; ! 196: memcpy(to,from,off); ! 197: len -= off; ! 198: if (len) ! 199: memcpy(to+off,sb->sb_data,len); ! 200: } ! 201: } ! 202:
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.