From da76459dc21b5af2449af2d36eb95226cb186ce2 Mon Sep 17 00:00:00 2001 From: Daniel Baumann Date: Sun, 28 Apr 2024 11:35:11 +0200 Subject: Adding upstream version 2.6.12. Signed-off-by: Daniel Baumann --- src/htx.c | 1087 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 1087 insertions(+) create mode 100644 src/htx.c (limited to 'src/htx.c') diff --git a/src/htx.c b/src/htx.c new file mode 100644 index 0000000..7e5bd46 --- /dev/null +++ b/src/htx.c @@ -0,0 +1,1087 @@ +/* + * internal HTTP message + * + * Copyright 2018 HAProxy Technologies, Christopher Faulet + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version + * 2 of the License, or (at your option) any later version. + * + */ + +#include +#include + +struct htx htx_empty = { .size = 0, .data = 0, .head = -1, .tail = -1, .first = -1 }; + +/* Defragments an HTX message. It removes unused blocks and unwraps the payloads + * part. A temporary buffer is used to do so. This function never fails. Most of + * time, we need keep a ref on a specific HTX block. Thus is is set, the + * pointer on its new position, after defrag, is returned. In addition, if the + * size of the block must be altered, info must be provided (!= + * 0). But in this case, it remains the caller responsibility to update the + * block content. + */ +/* TODO: merge data blocks into one */ +struct htx_blk *htx_defrag(struct htx *htx, struct htx_blk *blk, uint32_t blkinfo) +{ + struct buffer *chunk = get_trash_chunk(); + struct htx *tmp = htxbuf(chunk); + struct htx_blk *newblk, *oldblk; + uint32_t new, old, blkpos; + uint32_t addr, blksz; + int32_t first = -1; + + if (htx->head == -1) + return NULL; + + blkpos = -1; + + new = 0; + addr = 0; + tmp->size = htx->size; + tmp->data = 0; + + /* start from the head */ + for (old = htx_get_head(htx); old != -1; old = htx_get_next(htx, old)) { + oldblk = htx_get_blk(htx, old); + if (htx_get_blk_type(oldblk) == HTX_BLK_UNUSED) + continue; + + blksz = htx_get_blksz(oldblk); + memcpy((void *)tmp->blocks + addr, htx_get_blk_ptr(htx, oldblk), blksz); + + /* update the start-line position */ + if (htx->first == old) + first = new; + + newblk = htx_get_blk(tmp, new); + newblk->addr = addr; + newblk->info = oldblk->info; + + /* if is defined, save its new position */ + if (blk != NULL && blk == oldblk) { + if (blkinfo) + newblk->info = blkinfo; + blkpos = new; + } + + blksz = htx_get_blksz(newblk); + addr += blksz; + tmp->data += blksz; + new++; + } + + htx->data = tmp->data; + htx->first = first; + htx->head = 0; + htx->tail = new - 1; + htx->head_addr = htx->end_addr = 0; + htx->tail_addr = addr; + htx->flags &= ~HTX_FL_FRAGMENTED; + memcpy((void *)htx->blocks, (void *)tmp->blocks, htx->size); + + return ((blkpos == -1) ? NULL : htx_get_blk(htx, blkpos)); +} + +/* Degragments HTX blocks of an HTX message. Payloads part is keep untouched + * here. This function will move back all blocks starting at the position 0, + * removing unused blocks. It must never be called with an empty message. + */ +static void htx_defrag_blks(struct htx *htx) +{ + int32_t pos, new; + + new = 0; + for (pos = htx_get_head(htx); pos != -1; pos = htx_get_next(htx, pos)) { + struct htx_blk *posblk, *newblk; + + if (pos == new) { + new++; + continue; + } + + posblk = htx_get_blk(htx, pos); + if (htx_get_blk_type(posblk) == HTX_BLK_UNUSED) + continue; + + if (htx->first == pos) + htx->first = new; + newblk = htx_get_blk(htx, new++); + newblk->info = posblk->info; + newblk->addr = posblk->addr; + } + BUG_ON(!new); + htx->head = 0; + htx->tail = new - 1; +} + +/* Reserves a new block in the HTX message with a content of + * bytes. If there is not enough space, NULL is returned. Otherwise the reserved + * block is returned and the HTX message is updated. Space for this new block is + * reserved in the HTX message. But it is the caller responsibility to set right + * info in the block to reflect the stored data. + */ +static struct htx_blk *htx_reserve_nxblk(struct htx *htx, uint32_t blksz) +{ + struct htx_blk *blk; + uint32_t tail, headroom, tailroom; + + if (blksz > htx_free_data_space(htx)) + return NULL; /* full */ + + if (htx->head == -1) { + /* Empty message */ + htx->head = htx->tail = htx->first = 0; + blk = htx_get_blk(htx, htx->tail); + blk->addr = 0; + htx->data = blksz; + htx->tail_addr = blksz; + return blk; + } + + /* Find the block's position. First, we try to get the next position in + * the message, increasing the tail by one. If this position is not + * available with some holes, we try to defrag the blocks without + * touching their paylood. If it is impossible, we fully defrag the + * message. + */ + tail = htx->tail + 1; + if (htx_pos_to_addr(htx, tail) >= htx->tail_addr) + ; + else if (htx->head > 0) { + htx_defrag_blks(htx); + tail = htx->tail + 1; + BUG_ON(htx_pos_to_addr(htx, tail) < htx->tail_addr); + } + else + goto defrag; + + /* Now, we have found the block's position. Try to find where to put its + * payload. The free space is split in two areas: + * + * * The free space in front of the blocks table. This one is used if and + * only if the other one was not used yet. + * + * * The free space at the beginning of the message. Once this one is + * used, the other one is never used again, until the next defrag. + */ + headroom = (htx->end_addr - htx->head_addr); + tailroom = (!htx->head_addr ? htx_pos_to_addr(htx, tail) - htx->tail_addr : 0); + BUG_ON((int32_t)headroom < 0); + BUG_ON((int32_t)tailroom < 0); + + if (blksz <= tailroom) { + blk = htx_get_blk(htx, tail); + blk->addr = htx->tail_addr; + htx->tail_addr += blksz; + } + else if (blksz <= headroom) { + blk = htx_get_blk(htx, tail); + blk->addr = htx->head_addr; + htx->head_addr += blksz; + } + else { + defrag: + /* need to defragment the message before inserting upfront */ + htx_defrag(htx, NULL, 0); + tail = htx->tail + 1; + blk = htx_get_blk(htx, tail); + blk->addr = htx->tail_addr; + htx->tail_addr += blksz; + } + + htx->tail = tail; + htx->data += blksz; + /* Set first position if not already set */ + if (htx->first == -1) + htx->first = tail; + + BUG_ON((int32_t)htx->tail_addr < 0); + BUG_ON((int32_t)htx->head_addr < 0); + BUG_ON(htx->end_addr > htx->tail_addr); + BUG_ON(htx->head_addr > htx->end_addr); + + return blk; +} + +/* Prepares the block to an expansion of its payload. The payload will be + * expanded by bytes and we need find where this expansion will be + * performed. It can be a compression if is negative. This function only + * updates all addresses. The caller have the responsibility to perform the + * expansion and update the block and the HTX message accordingly. No error must + * occur. It returns following values: + * + * 0: The expansion cannot be performed, there is not enough space. + * + * 1: the expansion must be performed in place, there is enough space after + * the block's payload to handle it. This is especially true if it is a + * compression and not an expension. + * + * 2: the block's payload must be moved at the new block address before doing + * the expansion. + * + * 3: the HTX message message must be defragmented + */ +static int htx_prepare_blk_expansion(struct htx *htx, struct htx_blk *blk, int32_t delta) +{ + uint32_t sz, tailroom, headroom; + int ret = 3; + + BUG_ON(htx->head == -1); + + headroom = (htx->end_addr - htx->head_addr); + tailroom = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); + BUG_ON((int32_t)headroom < 0); + BUG_ON((int32_t)tailroom < 0); + + sz = htx_get_blksz(blk); + if (delta <= 0) { + /* It is a compression, it can be performed in place */ + if (blk->addr+sz == htx->tail_addr) + htx->tail_addr += delta; + else if (blk->addr+sz == htx->head_addr) + htx->head_addr += delta; + ret = 1; + } + else if (delta > htx_free_space(htx)) { + /* There is not enough space to handle the expansion */ + ret = 0; + } + else if (blk->addr+sz == htx->tail_addr) { + /* The block's payload is just before the tail room */ + if (delta < tailroom) { + /* Expand the block's payload */ + htx->tail_addr += delta; + ret = 1; + } + else if ((sz + delta) < headroom) { + uint32_t oldaddr = blk->addr; + + /* Move the block's payload into the headroom */ + blk->addr = htx->head_addr; + htx->tail_addr -= sz; + htx->head_addr += sz + delta; + if (oldaddr == htx->end_addr) { + if (htx->end_addr == htx->tail_addr) { + htx->tail_addr = htx->head_addr; + htx->head_addr = htx->end_addr = 0; + } + else + htx->end_addr += sz; + } + ret = 2; + } + } + else if (blk->addr+sz == htx->head_addr) { + /* The block's payload is just before the head room */ + if (delta < headroom) { + /* Expand the block's payload */ + htx->head_addr += delta; + ret = 1; + } + } + else { + /* The block's payload is not at the rooms edge */ + if (!htx->head_addr && sz+delta < tailroom) { + /* Move the block's payload into the tailroom */ + if (blk->addr == htx->end_addr) + htx->end_addr += sz; + blk->addr = htx->tail_addr; + htx->tail_addr += sz + delta; + ret = 2; + } + else if (sz+delta < headroom) { + /* Move the block's payload into the headroom */ + if (blk->addr == htx->end_addr) + htx->end_addr += sz; + blk->addr = htx->head_addr; + htx->head_addr += sz + delta; + ret = 2; + } + } + /* Otherwise defrag the HTX message */ + + BUG_ON((int32_t)htx->tail_addr < 0); + BUG_ON((int32_t)htx->head_addr < 0); + BUG_ON(htx->end_addr > htx->tail_addr); + BUG_ON(htx->head_addr > htx->end_addr); + return ret; +} + +/* Adds a new block of type in the HTX message . Its content size is + * passed but it is the caller responsibility to do the copy. + */ +struct htx_blk *htx_add_blk(struct htx *htx, enum htx_blk_type type, uint32_t blksz) +{ + struct htx_blk *blk; + + BUG_ON(blksz >= 256 << 20); + blk = htx_reserve_nxblk(htx, blksz); + if (!blk) + return NULL; + BUG_ON(blk->addr > htx->size); + + blk->info = (type << 28); + return blk; +} + +/* Removes the block from the HTX message . The function returns the + * block following or NULL if is the last block or the last inserted + * one. + */ +struct htx_blk *htx_remove_blk(struct htx *htx, struct htx_blk *blk) +{ + enum htx_blk_type type; + uint32_t pos, addr, sz; + + BUG_ON(!blk || htx->head == -1); + + /* This is the last block in use */ + if (htx->head == htx->tail) { + uint32_t flags = (htx->flags & ~HTX_FL_FRAGMENTED); /* Preserve flags except FRAGMENTED */ + + htx_reset(htx); + htx->flags = flags; /* restore flags */ + return NULL; + } + + type = htx_get_blk_type(blk); + pos = htx_get_blk_pos(htx, blk); + sz = htx_get_blksz(blk); + addr = blk->addr; + if (type != HTX_BLK_UNUSED) { + /* Mark the block as unused, decrement allocated size */ + htx->data -= htx_get_blksz(blk); + blk->info = ((uint32_t)HTX_BLK_UNUSED << 28); + } + + /* There is at least 2 blocks, so tail is always > 0 */ + if (pos == htx->head) { + /* move the head forward */ + htx->head++; + } + else if (pos == htx->tail) { + /* remove the tail. this was the last inserted block so + * return NULL. */ + htx->tail--; + blk = NULL; + goto end; + } + else + htx->flags |= HTX_FL_FRAGMENTED; + + blk = htx_get_blk(htx, pos+1); + + end: + if (pos == htx->first) + htx->first = (blk ? htx_get_blk_pos(htx, blk) : -1); + + if (htx->head == htx->tail) { + /* If there is just one block in the HTX message, free space can + * be adjusted. This operation could save some defrags. */ + struct htx_blk *lastblk = htx_get_blk(htx, htx->tail); + + htx->head_addr = 0; + htx->end_addr = lastblk->addr; + htx->tail_addr = lastblk->addr+htx->data; + } + else { + if (addr+sz == htx->tail_addr) + htx->tail_addr = addr; + else if (addr+sz == htx->head_addr) + htx->head_addr = addr; + if (addr == htx->end_addr) { + if (htx->tail_addr == htx->end_addr) { + htx->tail_addr = htx->head_addr; + htx->head_addr = htx->end_addr = 0; + } + else + htx->end_addr += sz; + } + } + + BUG_ON((int32_t)htx->tail_addr < 0); + BUG_ON((int32_t)htx->head_addr < 0); + BUG_ON(htx->end_addr > htx->tail_addr); + BUG_ON(htx->head_addr > htx->end_addr); + return blk; +} + +/* Looks for the HTX block containing the offset , starting at the HTX + * message's head. The function returns an htx_ret with the found HTX block and + * the position inside this block where the offset is. If the offset is + * outside of the HTX message, htx_ret.blk is set to NULL. + */ +struct htx_ret htx_find_offset(struct htx *htx, uint32_t offset) +{ + struct htx_blk *blk; + struct htx_ret htxret = { .blk = NULL, .ret = 0 }; + + if (offset >= htx->data) + return htxret; + + for (blk = htx_get_head_blk(htx); blk && offset; blk = htx_get_next_blk(htx, blk)) { + uint32_t sz = htx_get_blksz(blk); + + if (offset < sz) + break; + offset -= sz; + } + htxret.blk = blk; + htxret.ret = offset; + return htxret; +} + +/* Removes all blocks after the one containing the offset . This last + * one may be truncated if it is a DATA block. + */ +void htx_truncate(struct htx *htx, uint32_t offset) +{ + struct htx_blk *blk; + struct htx_ret htxret = htx_find_offset(htx, offset); + + blk = htxret.blk; + if (blk && htxret.ret && htx_get_blk_type(blk) == HTX_BLK_DATA) { + htx_change_blk_value_len(htx, blk, htxret.ret); + blk = htx_get_next_blk(htx, blk); + } + while (blk) + blk = htx_remove_blk(htx, blk); +} + +/* Drains bytes from the HTX message . If the last block is a DATA + * block, it will be cut if necessary. Others blocks will be removed at once if + * is large enough. The function returns an htx_ret with the first block + * remaining in the message and the amount of data drained. If everything is + * removed, htx_ret.blk is set to NULL. + */ +struct htx_ret htx_drain(struct htx *htx, uint32_t count) +{ + struct htx_blk *blk; + struct htx_ret htxret = { .blk = NULL, .ret = 0 }; + + if (count == htx->data) { + uint32_t flags = (htx->flags & ~HTX_FL_FRAGMENTED); /* Preserve flags except FRAGMENTED */ + + htx_reset(htx); + htx->flags = flags; /* restore flags */ + htxret.ret = count; + return htxret; + } + + blk = htx_get_head_blk(htx); + while (count && blk) { + uint32_t sz = htx_get_blksz(blk); + enum htx_blk_type type = htx_get_blk_type(blk); + + /* Ignore unused block */ + if (type == HTX_BLK_UNUSED) + goto next; + + if (sz > count) { + if (type == HTX_BLK_DATA) { + htx_cut_data_blk(htx, blk, count); + htxret.ret += count; + } + break; + } + count -= sz; + htxret.ret += sz; + next: + blk = htx_remove_blk(htx, blk); + } + htxret.blk = blk; + + return htxret; +} + +/* Tries to append data to the last inserted block, if the type matches and if + * there is enough space to take it all. If the space wraps, the buffer is + * defragmented and a new block is inserted. If an error occurred, NULL is + * returned. Otherwise, on success, the updated block (or the new one) is + * returned. Due to its nature this function can be expensive and should be + * avoided whenever possible. + */ +struct htx_blk *htx_add_data_atonce(struct htx *htx, struct ist data) +{ + struct htx_blk *blk, *tailblk; + void *ptr; + uint32_t len, sz, tailroom, headroom; + + if (htx->head == -1) + goto add_new_block; + + /* Not enough space to store data */ + if (data.len > htx_free_data_space(htx)) + return NULL; + + /* get the tail block and its size */ + tailblk = htx_get_tail_blk(htx); + if (tailblk == NULL) + goto add_new_block; + sz = htx_get_blksz(tailblk); + + /* Don't try to append data if the last inserted block is not of the + * same type */ + if (htx_get_blk_type(tailblk) != HTX_BLK_DATA) + goto add_new_block; + + /* + * Same type and enough space: append data + */ + headroom = (htx->end_addr - htx->head_addr); + tailroom = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); + BUG_ON((int32_t)headroom < 0); + BUG_ON((int32_t)tailroom < 0); + + len = data.len; + if (tailblk->addr+sz == htx->tail_addr) { + if (data.len <= tailroom) + goto append_data; + else if (!htx->head_addr) { + len = tailroom; + goto append_data; + } + } + else if (tailblk->addr+sz == htx->head_addr && data.len <= headroom) + goto append_data; + + goto add_new_block; + + append_data: + /* Append data and update the block itself */ + ptr = htx_get_blk_ptr(htx, tailblk); + memcpy(ptr+sz, data.ptr, len); + htx_change_blk_value_len(htx, tailblk, sz+len); + + if (data.len == len) { + blk = tailblk; + goto end; + } + data = istadv(data, len); + + add_new_block: + blk = htx_add_blk(htx, HTX_BLK_DATA, data.len); + if (!blk) + return NULL; + + blk->info += data.len; + memcpy(htx_get_blk_ptr(htx, blk), data.ptr, data.len); + + end: + BUG_ON((int32_t)htx->tail_addr < 0); + BUG_ON((int32_t)htx->head_addr < 0); + BUG_ON(htx->end_addr > htx->tail_addr); + BUG_ON(htx->head_addr > htx->end_addr); + return blk; +} + +/* Replaces a value part of a block by a new one. The new part can be smaller or + * larger than the old one. This function works for any kind of block with + * attached data. It returns the new block on success, otherwise it returns + * NULL. + */ +struct htx_blk *htx_replace_blk_value(struct htx *htx, struct htx_blk *blk, + const struct ist old, const struct ist new) +{ + struct ist n, v; + int32_t delta; + int ret; + + n = htx_get_blk_name(htx, blk); + v = htx_get_blk_value(htx, blk); + delta = new.len - old.len; + ret = htx_prepare_blk_expansion(htx, blk, delta); + if (!ret) + return NULL; /* not enough space */ + + if (ret == 1) { /* Replace in place */ + if (delta <= 0) { + /* compression: copy new data first then move the end */ + memcpy(old.ptr, new.ptr, new.len); + memmove(old.ptr + new.len, istend(old), + istend(v) - istend(old)); + } + else { + /* expansion: move the end first then copy new data */ + memmove(old.ptr + new.len, istend(old), + istend(v) - istend(old)); + memcpy(old.ptr, new.ptr, new.len); + } + + /* set the new block size and update HTX message */ + htx_set_blk_value_len(blk, v.len + delta); + htx->data += delta; + } + else if (ret == 2) { /* New address but no defrag */ + void *ptr = htx_get_blk_ptr(htx, blk); + + /* Copy the name, if any */ + memcpy(ptr, n.ptr, n.len); + ptr += n.len; + + /* Copy value before old part, if any */ + memcpy(ptr, v.ptr, old.ptr - v.ptr); + ptr += old.ptr - v.ptr; + + /* Copy new value */ + memcpy(ptr, new.ptr, new.len); + ptr += new.len; + + /* Copy value after old part, if any */ + memcpy(ptr, istend(old), istend(v) - istend(old)); + + /* set the new block size and update HTX message */ + htx_set_blk_value_len(blk, v.len + delta); + htx->data += delta; + } + else { /* Do a degrag first (it is always an expansion) */ + struct htx_blk tmpblk; + int32_t offset; + + /* use tmpblk to set new block size before defrag and to compute + * the offset after defrag + */ + tmpblk.addr = blk->addr; + tmpblk.info = blk->info; + htx_set_blk_value_len(&tmpblk, v.len + delta); + + /* htx_defrag() will take care to update the block size and the htx message */ + blk = htx_defrag(htx, blk, tmpblk.info); + + /* newblk is now the new HTX block. Compute the offset to copy/move payload */ + offset = blk->addr - tmpblk.addr; + + /* move the end first and copy new data + */ + memmove(old.ptr + offset + new.len, old.ptr + offset + old.len, + istend(v) - istend(old)); + memcpy(old.ptr + offset, new.ptr, new.len); + } + return blk; +} + +/* Transfer HTX blocks from to , stopping on the first block of the + * type (typically EOH or EOT) or when bytes were moved + * (including payload and meta-data). It returns the number of bytes moved and + * the last HTX block inserted in . + */ +struct htx_ret htx_xfer_blks(struct htx *dst, struct htx *src, uint32_t count, + enum htx_blk_type mark) +{ + struct htx_blk *blk, *dstblk; + struct htx_blk *srcref, *dstref; + enum htx_blk_type type; + uint32_t info, max, sz, ret; + + ret = htx_used_space(dst); + srcref = dstref = dstblk = NULL; + + /* blocks are not removed yet from HTX message to be able to + * rollback the transfer if all the headers/trailers are not copied. + */ + for (blk = htx_get_head_blk(src); blk && count; blk = htx_get_next_blk(src, blk)) { + type = htx_get_blk_type(blk); + + /* Ignore unused block */ + if (type == HTX_BLK_UNUSED) + continue; + + + max = htx_get_max_blksz(dst, count); + if (!max) + break; + + sz = htx_get_blksz(blk); + info = blk->info; + if (sz > max) { + /* Only DATA blocks can be partially xferred */ + if (type != HTX_BLK_DATA) + break; + sz = max; + info = (type << 28) + sz; + } + + dstblk = htx_reserve_nxblk(dst, sz); + if (!dstblk) + break; + dstblk->info = info; + memcpy(htx_get_blk_ptr(dst, dstblk), htx_get_blk_ptr(src, blk), sz); + + count -= sizeof(dstblk) + sz; + if (blk->info != info) { + /* Partial xfer: don't remove from but + * resize its content */ + htx_cut_data_blk(src, blk, sz); + break; + } + + if (type == mark) { + blk = htx_get_next_blk(src, blk); + srcref = dstref = NULL; + break; + } + + /* Save to and to when we start + * to xfer headers or trailers. When EOH/EOT block is reached, + * both are reset. It is mandatory to be able to rollback a + * partial transfer. + */ + if (!srcref && !dstref && + (type == HTX_BLK_REQ_SL || type == HTX_BLK_RES_SL || type == HTX_BLK_TLR)) { + srcref = blk; + dstref = dstblk; + } + else if (type == HTX_BLK_EOH || type == HTX_BLK_EOT) + srcref = dstref = NULL; + } + + if (unlikely(dstref)) { + /* Headers or trailers part was partially xferred, so rollback + * the copy by removing all block between and , + * both included. may be NULL. + */ + while (dstref && dstref != dstblk) + dstref = htx_remove_blk(dst, dstref); + if (dstblk) + htx_remove_blk(dst, dstblk); + + /* HTX message is empty, it means the headers or trailers + * part is too big to be copied at once. + */ + if (htx_is_empty(dst)) + src->flags |= HTX_FL_PARSING_ERROR; + } + + /* Now, remove xferred blocks from htx message */ + if (!blk && !srcref) { + /* End of src reached, all blocks were consumed, drain all data */ + htx_drain(src, src->data); + } + else { + /* Remove all block from the head to , or if defined, excluded */ + srcref = (srcref ? srcref : blk); + for (blk = htx_get_head_blk(src); blk && blk != srcref; blk = htx_remove_blk(src, blk)); + } + + end: + ret = htx_used_space(dst) - ret; + return (struct htx_ret){.ret = ret, .blk = dstblk}; +} + +/* Replaces an header by a new one. The new header can be smaller or larger than + * the old one. It returns the new block on success, otherwise it returns NULL. + * The header name is always lower cased. + */ +struct htx_blk *htx_replace_header(struct htx *htx, struct htx_blk *blk, + const struct ist name, const struct ist value) +{ + enum htx_blk_type type; + void *ptr; + int32_t delta; + int ret; + + type = htx_get_blk_type(blk); + if (type != HTX_BLK_HDR) + return NULL; + + delta = name.len + value.len - htx_get_blksz(blk); + ret = htx_prepare_blk_expansion(htx, blk, delta); + if (!ret) + return NULL; /* not enough space */ + + + /* Replace in place or at a new address is the same. We replace all the + * header (name+value). Only take care to defrag the message if + * necessary. */ + if (ret == 3) + blk = htx_defrag(htx, blk, (type << 28) + (value.len << 8) + name.len); + else { + /* Set the new block size and update HTX message */ + blk->info = (type << 28) + (value.len << 8) + name.len; + htx->data += delta; + } + + /* Finally, copy data. */ + ptr = htx_get_blk_ptr(htx, blk); + ist2bin_lc(ptr, name); + memcpy(ptr + name.len, value.ptr, value.len); + return blk; +} + +/* Replaces the parts of the start-line. It returns the new start-line on + * success, otherwise it returns NULL. It is the caller responsibility to update + * sl->info, if necessary. + */ +struct htx_sl *htx_replace_stline(struct htx *htx, struct htx_blk *blk, const struct ist p1, + const struct ist p2, const struct ist p3) +{ + enum htx_blk_type type; + struct htx_sl *sl; + struct htx_sl tmp; /* used to save sl->info and sl->flags */ + uint32_t sz; + int32_t delta; + int ret; + + type = htx_get_blk_type(blk); + if (type != HTX_BLK_REQ_SL && type != HTX_BLK_RES_SL) + return NULL; + + /* Save start-line info and flags */ + sl = htx_get_blk_ptr(htx, blk); + tmp.info = sl->info; + tmp.flags = sl->flags; + + sz = htx_get_blksz(blk); + delta = sizeof(*sl) + p1.len + p2.len + p3.len - sz; + ret = htx_prepare_blk_expansion(htx, blk, delta); + if (!ret) + return NULL; /* not enough space */ + + /* Replace in place or at a new address is the same. We replace all the + * start-line. Only take care to defrag the message if necessary. */ + if (ret == 3) { + blk = htx_defrag(htx, blk, (type << 28) + sz + delta); + } + else { + /* Set the new block size and update HTX message */ + blk->info = (type << 28) + sz + delta; + htx->data += delta; + } + + /* Restore start-line info and flags and copy parts of the start-line */ + sl = htx_get_blk_ptr(htx, blk); + sl->info = tmp.info; + sl->flags = tmp.flags; + + HTX_SL_P1_LEN(sl) = p1.len; + HTX_SL_P2_LEN(sl) = p2.len; + HTX_SL_P3_LEN(sl) = p3.len; + + memcpy(HTX_SL_P1_PTR(sl), p1.ptr, p1.len); + memcpy(HTX_SL_P2_PTR(sl), p2.ptr, p2.len); + memcpy(HTX_SL_P3_PTR(sl), p3.ptr, p3.len); + + return sl; +} + +/* Reserves the maximum possible size for an HTX data block, by extending an + * existing one or by creating a now one. It returns a compound result with the + * HTX block and the position where new data must be inserted (0 for a new + * block). If an error occurs or if there is no space left, NULL is returned + * instead of a pointer on an HTX block. + */ +struct htx_ret htx_reserve_max_data(struct htx *htx) +{ + struct htx_blk *blk, *tailblk; + uint32_t sz, room; + int32_t len = htx_free_data_space(htx); + + if (htx->head == -1) + goto rsv_new_block; + + if (!len) + return (struct htx_ret){.ret = 0, .blk = NULL}; + + /* get the tail and head block */ + tailblk = htx_get_tail_blk(htx); + if (tailblk == NULL) + goto rsv_new_block; + sz = htx_get_blksz(tailblk); + + /* Don't try to append data if the last inserted block is not of the + * same type */ + if (htx_get_blk_type(tailblk) != HTX_BLK_DATA) + goto rsv_new_block; + + /* + * Same type and enough space: append data + */ + if (!htx->head_addr) { + if (tailblk->addr+sz != htx->tail_addr) + goto rsv_new_block; + room = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); + } + else { + if (tailblk->addr+sz != htx->head_addr) + goto rsv_new_block; + room = (htx->end_addr - htx->head_addr); + } + BUG_ON((int32_t)room < 0); + if (room < len) + len = room; + + append_data: + htx_change_blk_value_len(htx, tailblk, sz+len); + + BUG_ON((int32_t)htx->tail_addr < 0); + BUG_ON((int32_t)htx->head_addr < 0); + BUG_ON(htx->end_addr > htx->tail_addr); + BUG_ON(htx->head_addr > htx->end_addr); + return (struct htx_ret){.ret = sz, .blk = tailblk}; + + rsv_new_block: + blk = htx_add_blk(htx, HTX_BLK_DATA, len); + if (!blk) + return (struct htx_ret){.ret = 0, .blk = NULL}; + blk->info += len; + return (struct htx_ret){.ret = 0, .blk = blk}; +} + +/* Adds an HTX block of type DATA in . It first tries to append data if + * possible. It returns the number of bytes consumed from , which may be + * zero if nothing could be copied. + */ +size_t htx_add_data(struct htx *htx, const struct ist data) +{ + struct htx_blk *blk, *tailblk; + void *ptr; + uint32_t sz, room; + int32_t len = data.len; + + /* Not enough space to store data */ + if (len > htx_free_data_space(htx)) + len = htx_free_data_space(htx); + + if (!len) + return 0; + + if (htx->head == -1) + goto add_new_block; + + /* get the tail and head block */ + tailblk = htx_get_tail_blk(htx); + if (tailblk == NULL) + goto add_new_block; + sz = htx_get_blksz(tailblk); + + /* Don't try to append data if the last inserted block is not of the + * same type */ + if (htx_get_blk_type(tailblk) != HTX_BLK_DATA) + goto add_new_block; + + /* + * Same type and enough space: append data + */ + if (!htx->head_addr) { + if (tailblk->addr+sz != htx->tail_addr) + goto add_new_block; + room = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); + } + else { + if (tailblk->addr+sz != htx->head_addr) + goto add_new_block; + room = (htx->end_addr - htx->head_addr); + } + BUG_ON((int32_t)room < 0); + if (room < len) + len = room; + + append_data: + /* Append data and update the block itself */ + ptr = htx_get_blk_ptr(htx, tailblk); + memcpy(ptr + sz, data.ptr, len); + htx_change_blk_value_len(htx, tailblk, sz+len); + + BUG_ON((int32_t)htx->tail_addr < 0); + BUG_ON((int32_t)htx->head_addr < 0); + BUG_ON(htx->end_addr > htx->tail_addr); + BUG_ON(htx->head_addr > htx->end_addr); + return len; + + add_new_block: + blk = htx_add_blk(htx, HTX_BLK_DATA, len); + if (!blk) + return 0; + + blk->info += len; + memcpy(htx_get_blk_ptr(htx, blk), data.ptr, len); + return len; +} + + +/* Adds an HTX block of type DATA in just after all other DATA + * blocks. Because it relies on htx_add_data_atonce(), It may be happened to a + * DATA block if possible. But, if the function succeeds, it will be the last + * DATA block in all cases. If an error occurred, NULL is returned. Otherwise, + * on success, the updated block (or the new one) is returned. + */ +struct htx_blk *htx_add_last_data(struct htx *htx, struct ist data) +{ + struct htx_blk *blk, *pblk; + + blk = htx_add_data_atonce(htx, data); + if (!blk) + return NULL; + + for (pblk = htx_get_prev_blk(htx, blk); pblk; pblk = htx_get_prev_blk(htx, pblk)) { + if (htx_get_blk_type(pblk) <= HTX_BLK_DATA) + break; + + /* Swap .addr and .info fields */ + blk->addr ^= pblk->addr; pblk->addr ^= blk->addr; blk->addr ^= pblk->addr; + blk->info ^= pblk->info; pblk->info ^= blk->info; blk->info ^= pblk->info; + + if (blk->addr == pblk->addr) + blk->addr += htx_get_blksz(pblk); + blk = pblk; + } + + return blk; +} + +/* Moves the block just before the block . Both blocks must be in the + * HTX message and must be placed after . pointer to these + * blocks are updated to remain valid after the move. */ +void htx_move_blk_before(struct htx *htx, struct htx_blk **blk, struct htx_blk **ref) +{ + struct htx_blk *cblk, *pblk; + + cblk = *blk; + for (pblk = htx_get_prev_blk(htx, cblk); pblk; pblk = htx_get_prev_blk(htx, pblk)) { + /* Swap .addr and .info fields */ + cblk->addr ^= pblk->addr; pblk->addr ^= cblk->addr; cblk->addr ^= pblk->addr; + cblk->info ^= pblk->info; pblk->info ^= cblk->info; cblk->info ^= pblk->info; + + if (cblk->addr == pblk->addr) + cblk->addr += htx_get_blksz(pblk); + if (pblk == *ref) + break; + cblk = pblk; + } + *blk = cblk; + *ref = pblk; +} + +/* Append the HTX message to the HTX message . It returns 1 on + * success and 0 on error. All the message or nothing is copied. If an error + * occurred, all blocks from already appended to are truncated. + */ +int htx_append_msg(struct htx *dst, const struct htx *src) +{ + struct htx_blk *blk, *newblk; + enum htx_blk_type type; + uint32_t blksz, offset = dst->data; + + for (blk = htx_get_head_blk(src); blk; blk = htx_get_next_blk(src, blk)) { + type = htx_get_blk_type(blk); + + if (type == HTX_BLK_UNUSED) + continue; + + blksz = htx_get_blksz(blk); + newblk = htx_add_blk(dst, type, blksz); + if (!newblk) + goto error; + newblk->info = blk->info; + memcpy(htx_get_blk_ptr(dst, newblk), htx_get_blk_ptr(src, blk), blksz); + } + + return 1; + + error: + htx_truncate(dst, offset); + return 0; +} -- cgit v1.2.3