}
// Buffer functions
-// TODO: convert to ringbuffers to avoid memmove() operations.
+static bool buffer_wraps(struct buffer *buf) {
+ return buf->size - buf->offset < buf->used;
+}
+
+static bool buffer_resize(struct buffer *buf, uint32_t newsize) {
+ char *newdata = realloc(buf->data, newsize);
+
+ if(!newdata) {
+ return false;
+ }
+
+ buf->data = newdata;
+
+ if(buffer_wraps(buf)) {
+ // Shift the right part of the buffer until it hits the end of the new buffer.
+ // Old situation:
+ // [345......012]
+ // New situation:
+ // [345.........|........012]
+ uint32_t tailsize = buf->size - buf->offset;
+ uint32_t newoffset = newsize - tailsize;
+ memmove(buf + newoffset, buf + buf->offset, tailsize);
+ buf->offset = newoffset;
+ }
+
+ buf->size = newsize;
+ return true;
+}
// Store data into the buffer
static ssize_t buffer_put_at(struct buffer *buf, size_t offset, const void *data, size_t len) {
debug("buffer_put_at %lu %lu %lu\n", (unsigned long)buf->used, (unsigned long)offset, (unsigned long)len);
+ // Ensure we don't store more than maxsize bytes in total
size_t required = offset + len;
if(required > buf->maxsize) {
required = buf->maxsize;
}
+ // Check if we need to resize the buffer
if(required > buf->size) {
size_t newsize = buf->size;
if(!newsize) {
- newsize = required;
- } else {
- do {
- newsize *= 2;
- } while(newsize < required);
+ newsize = 4096;
}
+ do {
+ newsize *= 2;
+ } while(newsize < required);
+
if(newsize > buf->maxsize) {
newsize = buf->maxsize;
}
- char *newdata = realloc(buf->data, newsize);
-
- if(!newdata) {
+ if(!buffer_resize(buf, newsize)) {
return -1;
}
+ }
- buf->data = newdata;
- buf->size = newsize;
+ uint32_t realoffset = buf->offset + offset;
+
+ if(buf->size - buf->offset < offset) {
+ // The offset wrapped
+ realoffset -= buf->size;
}
- memcpy(buf->data + offset, data, len);
+ if(buf->size - realoffset < len) {
+ // The new chunk of data must be wrapped
+ memcpy(buf->data + realoffset, data, buf->size - realoffset);
+ memcpy(buf->data, (char *)data + buf->size - realoffset, len - (buf->size - realoffset));
+ } else {
+ memcpy(buf->data + realoffset, data, len);
+ }
if(required > buf->used) {
buf->used = required;
return buffer_put_at(buf, buf->used, data, len);
}
-// Get data from the buffer. data can be NULL.
-static ssize_t buffer_get(struct buffer *buf, void *data, size_t len) {
- if(len > buf->used) {
- len = buf->used;
+// Copy data from the buffer without removing it.
+static ssize_t buffer_copy(struct buffer *buf, void *data, size_t offset, size_t len) {
+ // Ensure we don't copy more than is actually stored in the buffer
+ if(offset >= buf->used) {
+ return 0;
}
- if(data) {
- memcpy(data, buf->data, len);
+ if(buf->used - offset < len) {
+ len = buf->used - offset;
}
- if(len < buf->used) {
- memmove(buf->data, buf->data + len, buf->used - len);
+ uint32_t realoffset = buf->offset + offset;
+
+ if(buf->size - buf->offset < offset) {
+ // The offset wrapped
+ realoffset -= buf->size;
+ }
+
+ if(buf->size - realoffset < len) {
+ // The data is wrapped
+ memcpy(data, buf->data + realoffset, buf->size - realoffset);
+ memcpy((char *)data + buf->size - realoffset, buf->data, len - (buf->size - realoffset));
+ } else {
+ memcpy(data, buf->data + realoffset, len);
}
- buf->used -= len;
return len;
}
-// Copy data from the buffer without removing it.
-static ssize_t buffer_copy(struct buffer *buf, void *data, size_t offset, size_t len) {
- if(offset >= buf->used) {
- return 0;
- }
+// Get data from the buffer.
+static ssize_t buffer_get(struct buffer *buf, void *data, size_t len) {
+ len = buffer_copy(buf, data, 0, len);
- if(offset + len > buf->used) {
- len = buf->used - offset;
+ if(buf->size - buf->offset < len) {
+ buf->offset -= buf->size;
}
- memcpy(data, buf->data + offset, len);
+ buf->offset += len;
+ buf->used -= len;
return len;
}
-static bool buffer_init(struct buffer *buf, uint32_t len, uint32_t maxlen) {
- memset(buf, 0, sizeof(*buf));
+// Discard data from the buffer.
+static ssize_t buffer_discard(struct buffer *buf, size_t len) {
+ if(buf->used < len) {
+ len = buf->used;
+ }
- if(len) {
- buf->data = malloc(len);
+ if(buf->size - buf->offset < len) {
+ buf->offset -= buf->size;
+ }
- if(!buf->data) {
- return false;
- }
+ buf->offset += len;
+ buf->used -= len;
+
+ return len;
+}
+
+static bool buffer_set_size(struct buffer *buf, uint32_t minsize, uint32_t maxsize) {
+ if(maxsize < minsize) {
+ maxsize = minsize;
}
- buf->size = len;
- buf->maxsize = maxlen;
- return true;
+ buf->maxsize = maxsize;
+
+ return buf->size >= minsize || buffer_resize(buf, minsize);
}
static void buffer_exit(struct buffer *buf) {
return NULL;
}
- if(!buffer_init(&c->sndbuf, DEFAULT_SNDBUFSIZE, DEFAULT_MAXSNDBUFSIZE)) {
+ if(!buffer_set_size(&c->sndbuf, DEFAULT_SNDBUFSIZE, DEFAULT_MAXSNDBUFSIZE)) {
free(c);
return NULL;
}
- if(!buffer_init(&c->rcvbuf, DEFAULT_RCVBUFSIZE, DEFAULT_MAXRCVBUFSIZE)) {
+ if(!buffer_set_size(&c->rcvbuf, DEFAULT_RCVBUFSIZE, DEFAULT_MAXRCVBUFSIZE)) {
buffer_exit(&c->sndbuf);
free(c);
return NULL;
struct {
struct hdr hdr;
uint8_t data[];
- } *pkt;
-
- pkt = malloc(sizeof(pkt->hdr) + c->utcp->mtu);
-
- if(!pkt) {
- return;
- }
+ } *pkt = c->utcp->pkt;
pkt->hdr.src = c->src;
pkt->hdr.dst = c->dst;
print_packet(c->utcp, "send", pkt, sizeof(pkt->hdr) + seglen);
c->utcp->send(c->utcp, pkt, sizeof(pkt->hdr) + seglen);
} while(left);
-
- free(pkt);
}
ssize_t utcp_send(struct utcp_connection *c, const void *data, size_t len) {
if(is_reliable(c) || (c->state != SYN_SENT && c->state != SYN_RECEIVED)) {
len = buffer_put(&c->sndbuf, data, len);
+ } else {
+ return 0;
}
if(len <= 0) {
struct {
struct hdr hdr;
uint8_t data[];
- } *pkt;
-
- pkt = malloc(sizeof(pkt->hdr) + c->utcp->mtu);
-
- if(!pkt) {
- return;
- }
+ } *pkt = c->utcp->pkt;
pkt->hdr.src = c->src;
pkt->hdr.dst = c->dst;
c->rtt_start.tv_sec = 0; // invalidate RTT timer
cleanup:
- free(pkt);
+ return;
}
/* Update receive buffer and SACK entries after consuming data.
assert(data_acked >= 0);
+#ifndef NDEBUG
int32_t bufused = seqdiff(c->snd.last, c->snd.una);
assert(data_acked <= bufused);
+#endif
if(data_acked) {
- buffer_get(&c->sndbuf, NULL, data_acked);
+ buffer_discard(&c->sndbuf, data_acked);
}
// Also advance snd.nxt if possible
utcp->pre_accept = pre_accept;
utcp->send = send;
utcp->priv = priv;
- utcp->mtu = DEFAULT_MTU;
+ utcp_set_mtu(utcp, DEFAULT_MTU);
utcp->timeout = DEFAULT_USER_TIMEOUT; // sec
utcp->rto = START_RTO; // usec
}
void utcp_set_mtu(struct utcp *utcp, uint16_t mtu) {
- // TODO: handle overhead of the header
- if(utcp) {
- utcp->mtu = mtu;
+ if(!utcp) {
+ return;
}
+
+ if(mtu <= sizeof(struct hdr)) {
+ return;
+ }
+
+ if(mtu > utcp->mtu) {
+ char *new = realloc(utcp->pkt, mtu + sizeof(struct hdr));
+
+ if(!new) {
+ return;
+ }
+
+ utcp->pkt = new;
+ }
+
+ utcp->mtu = mtu;
}
void utcp_reset_timers(struct utcp *utcp) {