Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 1 | /* |
| 2 | * internal HTTP message |
| 3 | * |
| 4 | * Copyright 2018 HAProxy Technologies, Christopher Faulet <cfaulet@haproxy.com> |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or |
| 7 | * modify it under the terms of the GNU General Public License |
| 8 | * as published by the Free Software Foundation; either version |
| 9 | * 2 of the License, or (at your option) any later version. |
| 10 | * |
| 11 | */ |
| 12 | |
Willy Tarreau | c13ed53 | 2020-06-02 10:22:45 +0200 | [diff] [blame] | 13 | #include <haproxy/chunk.h> |
Willy Tarreau | 16f958c | 2020-06-03 08:44:35 +0200 | [diff] [blame] | 14 | #include <haproxy/htx.h> |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 15 | |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 16 | struct htx htx_empty = { .size = 0, .data = 0, .head = -1, .tail = -1, .first = -1 }; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 17 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 18 | /* Defragments an HTX message. It removes unused blocks and unwraps the payloads |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 19 | * part. A temporary buffer is used to do so. This function never fails. Most of |
| 20 | * time, we need keep a ref on a specific HTX block. Thus is <blk> is set, the |
| 21 | * pointer on its new position, after defrag, is returned. In addition, if the |
| 22 | * size of the block must be altered, <blkinfo> info must be provided (!= |
| 23 | * 0). But in this case, it remains the caller responsibility to update the |
| 24 | * block content. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 25 | */ |
| 26 | /* TODO: merge data blocks into one */ |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 27 | struct htx_blk *htx_defrag(struct htx *htx, struct htx_blk *blk, uint32_t blkinfo) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 28 | { |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 29 | struct buffer *chunk = get_trash_chunk(); |
| 30 | struct htx *tmp = htxbuf(chunk); |
| 31 | struct htx_blk *newblk, *oldblk; |
Christopher Faulet | 200f895 | 2019-01-02 11:23:44 +0100 | [diff] [blame] | 32 | uint32_t new, old, blkpos; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 33 | uint32_t addr, blksz; |
Christopher Faulet | 29f1758 | 2019-05-23 11:03:26 +0200 | [diff] [blame] | 34 | int32_t first = -1; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 35 | |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 36 | if (htx->head == -1) |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 37 | return NULL; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 38 | |
Christopher Faulet | 200f895 | 2019-01-02 11:23:44 +0100 | [diff] [blame] | 39 | blkpos = -1; |
| 40 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 41 | new = 0; |
| 42 | addr = 0; |
| 43 | tmp->size = htx->size; |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 44 | tmp->data = 0; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 45 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 46 | /* start from the head */ |
| 47 | for (old = htx_get_head(htx); old != -1; old = htx_get_next(htx, old)) { |
| 48 | oldblk = htx_get_blk(htx, old); |
Christopher Faulet | 28f29c7 | 2019-04-30 17:55:45 +0200 | [diff] [blame] | 49 | if (htx_get_blk_type(oldblk) == HTX_BLK_UNUSED) |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 50 | continue; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 51 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 52 | blksz = htx_get_blksz(oldblk); |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 53 | memcpy((void *)tmp->blocks + addr, htx_get_blk_ptr(htx, oldblk), blksz); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 54 | |
Christopher Faulet | 9c66b98 | 2019-04-30 18:08:26 +0200 | [diff] [blame] | 55 | /* update the start-line position */ |
Christopher Faulet | 29f1758 | 2019-05-23 11:03:26 +0200 | [diff] [blame] | 56 | if (htx->first == old) |
| 57 | first = new; |
Christopher Faulet | 174bfb1 | 2018-12-06 14:31:12 +0100 | [diff] [blame] | 58 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 59 | newblk = htx_get_blk(tmp, new); |
| 60 | newblk->addr = addr; |
| 61 | newblk->info = oldblk->info; |
| 62 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 63 | /* if <blk> is defined, save its new position */ |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 64 | if (blk != NULL && blk == oldblk) { |
| 65 | if (blkinfo) |
| 66 | newblk->info = blkinfo; |
Christopher Faulet | 200f895 | 2019-01-02 11:23:44 +0100 | [diff] [blame] | 67 | blkpos = new; |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 68 | } |
Christopher Faulet | 200f895 | 2019-01-02 11:23:44 +0100 | [diff] [blame] | 69 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 70 | blksz = htx_get_blksz(newblk); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 71 | addr += blksz; |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 72 | tmp->data += blksz; |
| 73 | new++; |
Christopher Faulet | b8fd4c0 | 2019-05-20 09:32:25 +0200 | [diff] [blame] | 74 | } |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 75 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 76 | htx->data = tmp->data; |
Christopher Faulet | 29f1758 | 2019-05-23 11:03:26 +0200 | [diff] [blame] | 77 | htx->first = first; |
Christopher Faulet | 28f29c7 | 2019-04-30 17:55:45 +0200 | [diff] [blame] | 78 | htx->head = 0; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 79 | htx->tail = new - 1; |
| 80 | htx->head_addr = htx->end_addr = 0; |
| 81 | htx->tail_addr = addr; |
Christopher Faulet | 4697c92 | 2021-09-21 15:39:30 +0200 | [diff] [blame] | 82 | htx->flags &= ~HTX_FL_FRAGMENTED; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 83 | memcpy((void *)htx->blocks, (void *)tmp->blocks, htx->size); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 84 | |
Christopher Faulet | 200f895 | 2019-01-02 11:23:44 +0100 | [diff] [blame] | 85 | return ((blkpos == -1) ? NULL : htx_get_blk(htx, blkpos)); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 86 | } |
| 87 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 88 | /* Degragments HTX blocks of an HTX message. Payloads part is keep untouched |
| 89 | * here. This function will move back all blocks starting at the position 0, |
| 90 | * removing unused blocks. It must never be called with an empty message. |
| 91 | */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 92 | static void htx_defrag_blks(struct htx *htx) |
| 93 | { |
| 94 | int32_t pos, new; |
| 95 | |
| 96 | new = 0; |
| 97 | for (pos = htx_get_head(htx); pos != -1; pos = htx_get_next(htx, pos)) { |
| 98 | struct htx_blk *posblk, *newblk; |
| 99 | |
| 100 | if (pos == new) { |
| 101 | new++; |
| 102 | continue; |
| 103 | } |
| 104 | |
| 105 | posblk = htx_get_blk(htx, pos); |
| 106 | if (htx_get_blk_type(posblk) == HTX_BLK_UNUSED) |
| 107 | continue; |
| 108 | |
| 109 | if (htx->first == pos) |
| 110 | htx->first = new; |
| 111 | newblk = htx_get_blk(htx, new++); |
| 112 | newblk->info = posblk->info; |
| 113 | newblk->addr = posblk->addr; |
| 114 | } |
| 115 | BUG_ON(!new); |
| 116 | htx->head = 0; |
| 117 | htx->tail = new - 1; |
| 118 | } |
| 119 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 120 | /* Reserves a new block in the HTX message <htx> with a content of <blksz> |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 121 | * bytes. If there is not enough space, NULL is returned. Otherwise the reserved |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 122 | * block is returned and the HTX message is updated. Space for this new block is |
| 123 | * reserved in the HTX message. But it is the caller responsibility to set right |
| 124 | * info in the block to reflect the stored data. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 125 | */ |
| 126 | static struct htx_blk *htx_reserve_nxblk(struct htx *htx, uint32_t blksz) |
| 127 | { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 128 | struct htx_blk *blk; |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 129 | uint32_t tail, headroom, tailroom; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 130 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 131 | if (blksz > htx_free_data_space(htx)) |
| 132 | return NULL; /* full */ |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 133 | |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 134 | if (htx->head == -1) { |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 135 | /* Empty message */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 136 | htx->head = htx->tail = htx->first = 0; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 137 | blk = htx_get_blk(htx, htx->tail); |
| 138 | blk->addr = 0; |
| 139 | htx->data = blksz; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 140 | htx->tail_addr = blksz; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 141 | return blk; |
| 142 | } |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 143 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 144 | /* Find the block's position. First, we try to get the next position in |
| 145 | * the message, increasing the tail by one. If this position is not |
| 146 | * available with some holes, we try to defrag the blocks without |
| 147 | * touching their paylood. If it is impossible, we fully defrag the |
| 148 | * message. |
| 149 | */ |
Christopher Faulet | 28f29c7 | 2019-04-30 17:55:45 +0200 | [diff] [blame] | 150 | tail = htx->tail + 1; |
Christopher Faulet | 2bf43f0 | 2019-06-12 11:28:11 +0200 | [diff] [blame] | 151 | if (htx_pos_to_addr(htx, tail) >= htx->tail_addr) |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 152 | ; |
| 153 | else if (htx->head > 0) { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 154 | htx_defrag_blks(htx); |
| 155 | tail = htx->tail + 1; |
Christopher Faulet | 2bf43f0 | 2019-06-12 11:28:11 +0200 | [diff] [blame] | 156 | BUG_ON(htx_pos_to_addr(htx, tail) < htx->tail_addr); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 157 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 158 | else |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 159 | goto defrag; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 160 | |
Thayne McCombs | 8f0cc5c | 2021-01-07 21:35:52 -0700 | [diff] [blame] | 161 | /* Now, we have found the block's position. Try to find where to put its |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 162 | * payload. The free space is split in two areas: |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 163 | * |
Thayne McCombs | 8f0cc5c | 2021-01-07 21:35:52 -0700 | [diff] [blame] | 164 | * * The free space in front of the blocks table. This one is used if and |
| 165 | * only if the other one was not used yet. |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 166 | * |
| 167 | * * The free space at the beginning of the message. Once this one is |
Thayne McCombs | 8f0cc5c | 2021-01-07 21:35:52 -0700 | [diff] [blame] | 168 | * used, the other one is never used again, until the next defrag. |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 169 | */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 170 | headroom = (htx->end_addr - htx->head_addr); |
Christopher Faulet | 2bf43f0 | 2019-06-12 11:28:11 +0200 | [diff] [blame] | 171 | tailroom = (!htx->head_addr ? htx_pos_to_addr(htx, tail) - htx->tail_addr : 0); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 172 | BUG_ON((int32_t)headroom < 0); |
| 173 | BUG_ON((int32_t)tailroom < 0); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 174 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 175 | if (blksz <= tailroom) { |
| 176 | blk = htx_get_blk(htx, tail); |
| 177 | blk->addr = htx->tail_addr; |
| 178 | htx->tail_addr += blksz; |
| 179 | } |
| 180 | else if (blksz <= headroom) { |
| 181 | blk = htx_get_blk(htx, tail); |
| 182 | blk->addr = htx->head_addr; |
| 183 | htx->head_addr += blksz; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 184 | } |
| 185 | else { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 186 | defrag: |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 187 | /* need to defragment the message before inserting upfront */ |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 188 | htx_defrag(htx, NULL, 0); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 189 | tail = htx->tail + 1; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 190 | blk = htx_get_blk(htx, tail); |
| 191 | blk->addr = htx->tail_addr; |
| 192 | htx->tail_addr += blksz; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 193 | } |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 194 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 195 | htx->tail = tail; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 196 | htx->data += blksz; |
Christopher Faulet | 29f1758 | 2019-05-23 11:03:26 +0200 | [diff] [blame] | 197 | /* Set first position if not already set */ |
| 198 | if (htx->first == -1) |
| 199 | htx->first = tail; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 200 | |
| 201 | BUG_ON((int32_t)htx->tail_addr < 0); |
| 202 | BUG_ON((int32_t)htx->head_addr < 0); |
| 203 | BUG_ON(htx->end_addr > htx->tail_addr); |
| 204 | BUG_ON(htx->head_addr > htx->end_addr); |
| 205 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 206 | return blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 207 | } |
| 208 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 209 | /* Prepares the block to an expansion of its payload. The payload will be |
| 210 | * expanded by <delta> bytes and we need find where this expansion will be |
| 211 | * performed. It can be a compression if <delta> is negative. This function only |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 212 | * updates all addresses. The caller have the responsibility to perform the |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 213 | * expansion and update the block and the HTX message accordingly. No error must |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 214 | * occur. It returns following values: |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 215 | * |
| 216 | * 0: The expansion cannot be performed, there is not enough space. |
| 217 | * |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 218 | * 1: the expansion must be performed in place, there is enough space after |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 219 | * the block's payload to handle it. This is especially true if it is a |
| 220 | * compression and not an expension. |
| 221 | * |
| 222 | * 2: the block's payload must be moved at the new block address before doing |
| 223 | * the expansion. |
| 224 | * |
| 225 | * 3: the HTX message message must be defragmented |
| 226 | */ |
| 227 | static int htx_prepare_blk_expansion(struct htx *htx, struct htx_blk *blk, int32_t delta) |
| 228 | { |
| 229 | uint32_t sz, tailroom, headroom; |
| 230 | int ret = 3; |
| 231 | |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 232 | BUG_ON(htx->head == -1); |
| 233 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 234 | headroom = (htx->end_addr - htx->head_addr); |
Christopher Faulet | 2bf43f0 | 2019-06-12 11:28:11 +0200 | [diff] [blame] | 235 | tailroom = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 236 | BUG_ON((int32_t)headroom < 0); |
| 237 | BUG_ON((int32_t)tailroom < 0); |
| 238 | |
| 239 | sz = htx_get_blksz(blk); |
| 240 | if (delta <= 0) { |
| 241 | /* It is a compression, it can be performed in place */ |
| 242 | if (blk->addr+sz == htx->tail_addr) |
| 243 | htx->tail_addr += delta; |
| 244 | else if (blk->addr+sz == htx->head_addr) |
| 245 | htx->head_addr += delta; |
| 246 | ret = 1; |
| 247 | } |
| 248 | else if (delta > htx_free_space(htx)) { |
Ilya Shipitsin | 46a030c | 2020-07-05 16:36:08 +0500 | [diff] [blame] | 249 | /* There is not enough space to handle the expansion */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 250 | ret = 0; |
| 251 | } |
| 252 | else if (blk->addr+sz == htx->tail_addr) { |
| 253 | /* The block's payload is just before the tail room */ |
| 254 | if (delta < tailroom) { |
| 255 | /* Expand the block's payload */ |
| 256 | htx->tail_addr += delta; |
| 257 | ret = 1; |
| 258 | } |
| 259 | else if ((sz + delta) < headroom) { |
Christopher Faulet | 61ed779 | 2019-07-29 10:50:28 +0200 | [diff] [blame] | 260 | uint32_t oldaddr = blk->addr; |
| 261 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 262 | /* Move the block's payload into the headroom */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 263 | blk->addr = htx->head_addr; |
| 264 | htx->tail_addr -= sz; |
| 265 | htx->head_addr += sz + delta; |
Christopher Faulet | 61ed779 | 2019-07-29 10:50:28 +0200 | [diff] [blame] | 266 | if (oldaddr == htx->end_addr) { |
Christopher Faulet | 8c65486 | 2019-06-12 11:08:11 +0200 | [diff] [blame] | 267 | if (htx->end_addr == htx->tail_addr) { |
| 268 | htx->tail_addr = htx->head_addr; |
| 269 | htx->head_addr = htx->end_addr = 0; |
| 270 | } |
| 271 | else |
| 272 | htx->end_addr += sz; |
| 273 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 274 | ret = 2; |
| 275 | } |
| 276 | } |
| 277 | else if (blk->addr+sz == htx->head_addr) { |
| 278 | /* The block's payload is just before the head room */ |
| 279 | if (delta < headroom) { |
| 280 | /* Expand the block's payload */ |
| 281 | htx->head_addr += delta; |
| 282 | ret = 1; |
| 283 | } |
| 284 | } |
| 285 | else { |
| 286 | /* The block's payload is not at the rooms edge */ |
| 287 | if (!htx->head_addr && sz+delta < tailroom) { |
| 288 | /* Move the block's payload into the tailroom */ |
| 289 | if (blk->addr == htx->end_addr) |
| 290 | htx->end_addr += sz; |
| 291 | blk->addr = htx->tail_addr; |
| 292 | htx->tail_addr += sz + delta; |
| 293 | ret = 2; |
| 294 | } |
| 295 | else if (sz+delta < headroom) { |
| 296 | /* Move the block's payload into the headroom */ |
| 297 | if (blk->addr == htx->end_addr) |
| 298 | htx->end_addr += sz; |
| 299 | blk->addr = htx->head_addr; |
| 300 | htx->head_addr += sz + delta; |
| 301 | ret = 2; |
| 302 | } |
| 303 | } |
| 304 | /* Otherwise defrag the HTX message */ |
| 305 | |
| 306 | BUG_ON((int32_t)htx->tail_addr < 0); |
| 307 | BUG_ON((int32_t)htx->head_addr < 0); |
| 308 | BUG_ON(htx->end_addr > htx->tail_addr); |
| 309 | BUG_ON(htx->head_addr > htx->end_addr); |
| 310 | return ret; |
| 311 | } |
| 312 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 313 | /* Adds a new block of type <type> in the HTX message <htx>. Its content size is |
| 314 | * passed but it is the caller responsibility to do the copy. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 315 | */ |
| 316 | struct htx_blk *htx_add_blk(struct htx *htx, enum htx_blk_type type, uint32_t blksz) |
| 317 | { |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 318 | struct htx_blk *blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 319 | |
Willy Tarreau | 3d5f19e | 2021-08-26 16:07:22 +0200 | [diff] [blame] | 320 | BUG_ON(blksz >= 256 << 20); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 321 | blk = htx_reserve_nxblk(htx, blksz); |
| 322 | if (!blk) |
| 323 | return NULL; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 324 | BUG_ON(blk->addr > htx->size); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 325 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 326 | blk->info = (type << 28); |
| 327 | return blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 328 | } |
| 329 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 330 | /* Removes the block <blk> from the HTX message <htx>. The function returns the |
| 331 | * block following <blk> or NULL if <blk> is the last block or the last inserted |
| 332 | * one. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 333 | */ |
| 334 | struct htx_blk *htx_remove_blk(struct htx *htx, struct htx_blk *blk) |
| 335 | { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 336 | enum htx_blk_type type; |
| 337 | uint32_t pos, addr, sz; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 338 | |
Christopher Faulet | 234a10a | 2022-02-28 15:29:56 +0100 | [diff] [blame] | 339 | BUG_ON(!blk || htx->head == -1); |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 340 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 341 | /* This is the last block in use */ |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 342 | if (htx->head == htx->tail) { |
Christopher Faulet | 4697c92 | 2021-09-21 15:39:30 +0200 | [diff] [blame] | 343 | uint32_t flags = (htx->flags & ~HTX_FL_FRAGMENTED); /* Preserve flags except FRAGMENTED */ |
Christopher Faulet | d1ac2b9 | 2020-12-02 19:12:22 +0100 | [diff] [blame] | 344 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 345 | htx_reset(htx); |
Christopher Faulet | 4697c92 | 2021-09-21 15:39:30 +0200 | [diff] [blame] | 346 | htx->flags = flags; /* restore flags */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 347 | return NULL; |
| 348 | } |
| 349 | |
| 350 | type = htx_get_blk_type(blk); |
Christopher Faulet | 9c66b98 | 2019-04-30 18:08:26 +0200 | [diff] [blame] | 351 | pos = htx_get_blk_pos(htx, blk); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 352 | sz = htx_get_blksz(blk); |
| 353 | addr = blk->addr; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 354 | if (type != HTX_BLK_UNUSED) { |
| 355 | /* Mark the block as unused, decrement allocated size */ |
| 356 | htx->data -= htx_get_blksz(blk); |
| 357 | blk->info = ((uint32_t)HTX_BLK_UNUSED << 28); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 358 | } |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 359 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 360 | /* There is at least 2 blocks, so tail is always > 0 */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 361 | if (pos == htx->head) { |
| 362 | /* move the head forward */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 363 | htx->head++; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 364 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 365 | else if (pos == htx->tail) { |
| 366 | /* remove the tail. this was the last inserted block so |
| 367 | * return NULL. */ |
| 368 | htx->tail--; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 369 | blk = NULL; |
| 370 | goto end; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 371 | } |
Christopher Faulet | 4697c92 | 2021-09-21 15:39:30 +0200 | [diff] [blame] | 372 | else |
| 373 | htx->flags |= HTX_FL_FRAGMENTED; |
| 374 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 375 | blk = htx_get_blk(htx, pos+1); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 376 | |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 377 | end: |
Christopher Faulet | 29f1758 | 2019-05-23 11:03:26 +0200 | [diff] [blame] | 378 | if (pos == htx->first) |
| 379 | htx->first = (blk ? htx_get_blk_pos(htx, blk) : -1); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 380 | |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 381 | if (htx->head == htx->tail) { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 382 | /* If there is just one block in the HTX message, free space can |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 383 | * be adjusted. This operation could save some defrags. */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 384 | struct htx_blk *lastblk = htx_get_blk(htx, htx->tail); |
| 385 | |
| 386 | htx->head_addr = 0; |
| 387 | htx->end_addr = lastblk->addr; |
| 388 | htx->tail_addr = lastblk->addr+htx->data; |
| 389 | } |
| 390 | else { |
| 391 | if (addr+sz == htx->tail_addr) |
| 392 | htx->tail_addr = addr; |
| 393 | else if (addr+sz == htx->head_addr) |
| 394 | htx->head_addr = addr; |
Christopher Faulet | 8c65486 | 2019-06-12 11:08:11 +0200 | [diff] [blame] | 395 | if (addr == htx->end_addr) { |
| 396 | if (htx->tail_addr == htx->end_addr) { |
| 397 | htx->tail_addr = htx->head_addr; |
| 398 | htx->head_addr = htx->end_addr = 0; |
| 399 | } |
| 400 | else |
| 401 | htx->end_addr += sz; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 402 | } |
| 403 | } |
| 404 | |
| 405 | BUG_ON((int32_t)htx->tail_addr < 0); |
| 406 | BUG_ON((int32_t)htx->head_addr < 0); |
| 407 | BUG_ON(htx->end_addr > htx->tail_addr); |
| 408 | BUG_ON(htx->head_addr > htx->end_addr); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 409 | return blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 410 | } |
| 411 | |
Christopher Faulet | 1cdceb9 | 2020-02-24 11:41:59 +0100 | [diff] [blame] | 412 | /* Looks for the HTX block containing the offset <offset>, starting at the HTX |
| 413 | * message's head. The function returns an htx_ret with the found HTX block and |
| 414 | * the position inside this block where the offset is. If the offset <offset> is |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 415 | * outside of the HTX message, htx_ret.blk is set to NULL. |
Christopher Faulet | 1cdceb9 | 2020-02-24 11:41:59 +0100 | [diff] [blame] | 416 | */ |
| 417 | struct htx_ret htx_find_offset(struct htx *htx, uint32_t offset) |
| 418 | { |
| 419 | struct htx_blk *blk; |
| 420 | struct htx_ret htxret = { .blk = NULL, .ret = 0 }; |
| 421 | |
| 422 | if (offset >= htx->data) |
| 423 | return htxret; |
| 424 | |
| 425 | for (blk = htx_get_head_blk(htx); blk && offset; blk = htx_get_next_blk(htx, blk)) { |
| 426 | uint32_t sz = htx_get_blksz(blk); |
| 427 | |
| 428 | if (offset < sz) |
| 429 | break; |
| 430 | offset -= sz; |
| 431 | } |
| 432 | htxret.blk = blk; |
| 433 | htxret.ret = offset; |
| 434 | return htxret; |
| 435 | } |
| 436 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 437 | /* Removes all blocks after the one containing the offset <offset>. This last |
| 438 | * one may be truncated if it is a DATA block. |
Christopher Faulet | 00cf697 | 2019-01-07 14:53:27 +0100 | [diff] [blame] | 439 | */ |
| 440 | void htx_truncate(struct htx *htx, uint32_t offset) |
| 441 | { |
| 442 | struct htx_blk *blk; |
Christopher Faulet | bb76aa4 | 2020-02-24 15:09:24 +0100 | [diff] [blame] | 443 | struct htx_ret htxret = htx_find_offset(htx, offset); |
Christopher Faulet | 00cf697 | 2019-01-07 14:53:27 +0100 | [diff] [blame] | 444 | |
Christopher Faulet | bb76aa4 | 2020-02-24 15:09:24 +0100 | [diff] [blame] | 445 | blk = htxret.blk; |
| 446 | if (blk && htxret.ret && htx_get_blk_type(blk) == HTX_BLK_DATA) { |
| 447 | htx_change_blk_value_len(htx, blk, htxret.ret); |
| 448 | blk = htx_get_next_blk(htx, blk); |
Christopher Faulet | 00cf697 | 2019-01-07 14:53:27 +0100 | [diff] [blame] | 449 | } |
| 450 | while (blk) |
| 451 | blk = htx_remove_blk(htx, blk); |
| 452 | } |
| 453 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 454 | /* Drains <count> bytes from the HTX message <htx>. If the last block is a DATA |
| 455 | * block, it will be cut if necessary. Others blocks will be removed at once if |
| 456 | * <count> is large enough. The function returns an htx_ret with the first block |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 457 | * remaining in the message and the amount of data drained. If everything is |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 458 | * removed, htx_ret.blk is set to NULL. |
Christopher Faulet | 549822f | 2019-02-25 10:23:19 +0100 | [diff] [blame] | 459 | */ |
| 460 | struct htx_ret htx_drain(struct htx *htx, uint32_t count) |
| 461 | { |
| 462 | struct htx_blk *blk; |
| 463 | struct htx_ret htxret = { .blk = NULL, .ret = 0 }; |
| 464 | |
Christopher Faulet | 0f6d6a9 | 2019-05-23 11:11:52 +0200 | [diff] [blame] | 465 | if (count == htx->data) { |
Christopher Faulet | 4697c92 | 2021-09-21 15:39:30 +0200 | [diff] [blame] | 466 | uint32_t flags = (htx->flags & ~HTX_FL_FRAGMENTED); /* Preserve flags except FRAGMENTED */ |
Christopher Faulet | 5e9b24f | 2021-04-22 09:43:47 +0200 | [diff] [blame] | 467 | |
Christopher Faulet | 0f6d6a9 | 2019-05-23 11:11:52 +0200 | [diff] [blame] | 468 | htx_reset(htx); |
Christopher Faulet | 5e9b24f | 2021-04-22 09:43:47 +0200 | [diff] [blame] | 469 | htx->flags = flags; /* restore flags */ |
Christopher Faulet | 0f6d6a9 | 2019-05-23 11:11:52 +0200 | [diff] [blame] | 470 | htxret.ret = count; |
| 471 | return htxret; |
| 472 | } |
| 473 | |
Christopher Faulet | 549822f | 2019-02-25 10:23:19 +0100 | [diff] [blame] | 474 | blk = htx_get_head_blk(htx); |
| 475 | while (count && blk) { |
| 476 | uint32_t sz = htx_get_blksz(blk); |
| 477 | enum htx_blk_type type = htx_get_blk_type(blk); |
| 478 | |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 479 | /* Ignore unused block */ |
Christopher Faulet | 549822f | 2019-02-25 10:23:19 +0100 | [diff] [blame] | 480 | if (type == HTX_BLK_UNUSED) |
| 481 | goto next; |
| 482 | |
| 483 | if (sz > count) { |
| 484 | if (type == HTX_BLK_DATA) { |
| 485 | htx_cut_data_blk(htx, blk, count); |
| 486 | htxret.ret += count; |
| 487 | } |
| 488 | break; |
| 489 | } |
| 490 | count -= sz; |
| 491 | htxret.ret += sz; |
| 492 | next: |
| 493 | blk = htx_remove_blk(htx, blk); |
| 494 | } |
| 495 | htxret.blk = blk; |
| 496 | |
| 497 | return htxret; |
| 498 | } |
| 499 | |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 500 | /* Tries to append data to the last inserted block, if the type matches and if |
Willy Tarreau | d4908fa | 2019-05-28 10:23:46 +0200 | [diff] [blame] | 501 | * there is enough space to take it all. If the space wraps, the buffer is |
| 502 | * defragmented and a new block is inserted. If an error occurred, NULL is |
Christopher Faulet | 6177509 | 2019-05-07 21:42:27 +0200 | [diff] [blame] | 503 | * returned. Otherwise, on success, the updated block (or the new one) is |
Willy Tarreau | d4908fa | 2019-05-28 10:23:46 +0200 | [diff] [blame] | 504 | * returned. Due to its nature this function can be expensive and should be |
| 505 | * avoided whenever possible. |
| 506 | */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 507 | struct htx_blk *htx_add_data_atonce(struct htx *htx, struct ist data) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 508 | { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 509 | struct htx_blk *blk, *tailblk; |
| 510 | void *ptr; |
| 511 | uint32_t len, sz, tailroom, headroom; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 512 | |
Christopher Faulet | 192c6a2 | 2019-06-11 16:32:24 +0200 | [diff] [blame] | 513 | if (htx->head == -1) |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 514 | goto add_new_block; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 515 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 516 | /* Not enough space to store data */ |
| 517 | if (data.len > htx_free_data_space(htx)) |
| 518 | return NULL; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 519 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 520 | /* get the tail block and its size */ |
Christopher Faulet | f1449b7 | 2019-04-10 14:54:46 +0200 | [diff] [blame] | 521 | tailblk = htx_get_tail_blk(htx); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 522 | if (tailblk == NULL) |
Christopher Faulet | f1449b7 | 2019-04-10 14:54:46 +0200 | [diff] [blame] | 523 | goto add_new_block; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 524 | sz = htx_get_blksz(tailblk); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 525 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 526 | /* Don't try to append data if the last inserted block is not of the |
| 527 | * same type */ |
Willy Tarreau | d4908fa | 2019-05-28 10:23:46 +0200 | [diff] [blame] | 528 | if (htx_get_blk_type(tailblk) != HTX_BLK_DATA) |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 529 | goto add_new_block; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 530 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 531 | /* |
| 532 | * Same type and enough space: append data |
| 533 | */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 534 | headroom = (htx->end_addr - htx->head_addr); |
Christopher Faulet | 2bf43f0 | 2019-06-12 11:28:11 +0200 | [diff] [blame] | 535 | tailroom = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 536 | BUG_ON((int32_t)headroom < 0); |
| 537 | BUG_ON((int32_t)tailroom < 0); |
| 538 | |
| 539 | len = data.len; |
| 540 | if (tailblk->addr+sz == htx->tail_addr) { |
| 541 | if (data.len <= tailroom) |
| 542 | goto append_data; |
| 543 | else if (!htx->head_addr) { |
| 544 | len = tailroom; |
| 545 | goto append_data; |
| 546 | } |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 547 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 548 | else if (tailblk->addr+sz == htx->head_addr && data.len <= headroom) |
| 549 | goto append_data; |
Christopher Faulet | f1449b7 | 2019-04-10 14:54:46 +0200 | [diff] [blame] | 550 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 551 | goto add_new_block; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 552 | |
| 553 | append_data: |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 554 | /* Append data and update the block itself */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 555 | ptr = htx_get_blk_ptr(htx, tailblk); |
| 556 | memcpy(ptr+sz, data.ptr, len); |
Christopher Faulet | 3e2638e | 2019-06-18 09:49:16 +0200 | [diff] [blame] | 557 | htx_change_blk_value_len(htx, tailblk, sz+len); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 558 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 559 | if (data.len == len) { |
| 560 | blk = tailblk; |
| 561 | goto end; |
| 562 | } |
Tim Duesterhus | 154374c | 2021-03-02 18:57:27 +0100 | [diff] [blame] | 563 | data = istadv(data, len); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 564 | |
| 565 | add_new_block: |
Willy Tarreau | d4908fa | 2019-05-28 10:23:46 +0200 | [diff] [blame] | 566 | blk = htx_add_blk(htx, HTX_BLK_DATA, data.len); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 567 | if (!blk) |
| 568 | return NULL; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 569 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 570 | blk->info += data.len; |
| 571 | memcpy(htx_get_blk_ptr(htx, blk), data.ptr, data.len); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 572 | |
| 573 | end: |
| 574 | BUG_ON((int32_t)htx->tail_addr < 0); |
| 575 | BUG_ON((int32_t)htx->head_addr < 0); |
| 576 | BUG_ON(htx->end_addr > htx->tail_addr); |
| 577 | BUG_ON(htx->head_addr > htx->end_addr); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 578 | return blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 579 | } |
| 580 | |
| 581 | /* Replaces a value part of a block by a new one. The new part can be smaller or |
| 582 | * larger than the old one. This function works for any kind of block with |
| 583 | * attached data. It returns the new block on success, otherwise it returns |
| 584 | * NULL. |
| 585 | */ |
| 586 | struct htx_blk *htx_replace_blk_value(struct htx *htx, struct htx_blk *blk, |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 587 | const struct ist old, const struct ist new) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 588 | { |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 589 | struct ist n, v; |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 590 | int32_t delta; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 591 | int ret; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 592 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 593 | n = htx_get_blk_name(htx, blk); |
| 594 | v = htx_get_blk_value(htx, blk); |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 595 | delta = new.len - old.len; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 596 | ret = htx_prepare_blk_expansion(htx, blk, delta); |
| 597 | if (!ret) |
| 598 | return NULL; /* not enough space */ |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 599 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 600 | if (ret == 1) { /* Replace in place */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 601 | if (delta <= 0) { |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 602 | /* compression: copy new data first then move the end */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 603 | memcpy(old.ptr, new.ptr, new.len); |
Tim Duesterhus | 4c8f75f | 2021-11-06 15:14:44 +0100 | [diff] [blame] | 604 | memmove(old.ptr + new.len, istend(old), |
| 605 | istend(v) - istend(old)); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 606 | } |
| 607 | else { |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 608 | /* expansion: move the end first then copy new data */ |
Tim Duesterhus | 4c8f75f | 2021-11-06 15:14:44 +0100 | [diff] [blame] | 609 | memmove(old.ptr + new.len, istend(old), |
| 610 | istend(v) - istend(old)); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 611 | memcpy(old.ptr, new.ptr, new.len); |
| 612 | } |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 613 | |
| 614 | /* set the new block size and update HTX message */ |
| 615 | htx_set_blk_value_len(blk, v.len + delta); |
| 616 | htx->data += delta; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 617 | } |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 618 | else if (ret == 2) { /* New address but no defrag */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 619 | void *ptr = htx_get_blk_ptr(htx, blk); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 620 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 621 | /* Copy the name, if any */ |
| 622 | memcpy(ptr, n.ptr, n.len); |
| 623 | ptr += n.len; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 624 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 625 | /* Copy value before old part, if any */ |
| 626 | memcpy(ptr, v.ptr, old.ptr - v.ptr); |
| 627 | ptr += old.ptr - v.ptr; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 628 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 629 | /* Copy new value */ |
| 630 | memcpy(ptr, new.ptr, new.len); |
| 631 | ptr += new.len; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 632 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 633 | /* Copy value after old part, if any */ |
Tim Duesterhus | 4c8f75f | 2021-11-06 15:14:44 +0100 | [diff] [blame] | 634 | memcpy(ptr, istend(old), istend(v) - istend(old)); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 635 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 636 | /* set the new block size and update HTX message */ |
| 637 | htx_set_blk_value_len(blk, v.len + delta); |
| 638 | htx->data += delta; |
| 639 | } |
| 640 | else { /* Do a degrag first (it is always an expansion) */ |
| 641 | struct htx_blk tmpblk; |
| 642 | int32_t offset; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 643 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 644 | /* use tmpblk to set new block size before defrag and to compute |
| 645 | * the offset after defrag |
| 646 | */ |
| 647 | tmpblk.addr = blk->addr; |
| 648 | tmpblk.info = blk->info; |
| 649 | htx_set_blk_value_len(&tmpblk, v.len + delta); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 650 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 651 | /* htx_defrag() will take care to update the block size and the htx message */ |
| 652 | blk = htx_defrag(htx, blk, tmpblk.info); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 653 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 654 | /* newblk is now the new HTX block. Compute the offset to copy/move payload */ |
| 655 | offset = blk->addr - tmpblk.addr; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 656 | |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 657 | /* move the end first and copy new data |
| 658 | */ |
Tim Duesterhus | 4c8f75f | 2021-11-06 15:14:44 +0100 | [diff] [blame] | 659 | memmove(old.ptr + offset + new.len, old.ptr + offset + old.len, |
| 660 | istend(v) - istend(old)); |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 661 | memcpy(old.ptr + offset, new.ptr, new.len); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 662 | } |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 663 | return blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 664 | } |
| 665 | |
| 666 | /* Transfer HTX blocks from <src> to <dst>, stopping on the first block of the |
Christopher Faulet | d1ac2b9 | 2020-12-02 19:12:22 +0100 | [diff] [blame] | 667 | * type <mark> (typically EOH or EOT) or when <count> bytes were moved |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 668 | * (including payload and meta-data). It returns the number of bytes moved and |
| 669 | * the last HTX block inserted in <dst>. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 670 | */ |
| 671 | struct htx_ret htx_xfer_blks(struct htx *dst, struct htx *src, uint32_t count, |
| 672 | enum htx_blk_type mark) |
| 673 | { |
| 674 | struct htx_blk *blk, *dstblk; |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 675 | struct htx_blk *srcref, *dstref; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 676 | enum htx_blk_type type; |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 677 | uint32_t info, max, sz, ret; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 678 | |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 679 | ret = htx_used_space(dst); |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 680 | srcref = dstref = dstblk = NULL; |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 681 | |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 682 | /* blocks are not removed yet from <src> HTX message to be able to |
| 683 | * rollback the transfer if all the headers/trailers are not copied. |
| 684 | */ |
| 685 | for (blk = htx_get_head_blk(src); blk && count; blk = htx_get_next_blk(src, blk)) { |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 686 | type = htx_get_blk_type(blk); |
| 687 | |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 688 | /* Ignore unused block */ |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 689 | if (type == HTX_BLK_UNUSED) |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 690 | continue; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 691 | |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 692 | |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 693 | max = htx_get_max_blksz(dst, count); |
| 694 | if (!max) |
| 695 | break; |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 696 | |
| 697 | sz = htx_get_blksz(blk); |
| 698 | info = blk->info; |
Willy Tarreau | 90caa07 | 2019-04-09 16:21:54 +0200 | [diff] [blame] | 699 | if (sz > max) { |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 700 | /* Only DATA blocks can be partially xferred */ |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 701 | if (type != HTX_BLK_DATA) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 702 | break; |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 703 | sz = max; |
| 704 | info = (type << 28) + sz; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 705 | } |
| 706 | |
| 707 | dstblk = htx_reserve_nxblk(dst, sz); |
| 708 | if (!dstblk) |
| 709 | break; |
| 710 | dstblk->info = info; |
| 711 | memcpy(htx_get_blk_ptr(dst, dstblk), htx_get_blk_ptr(src, blk), sz); |
| 712 | |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 713 | count -= sizeof(dstblk) + sz; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 714 | if (blk->info != info) { |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 715 | /* Partial xfer: don't remove <blk> from <src> but |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 716 | * resize its content */ |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 717 | htx_cut_data_blk(src, blk, sz); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 718 | break; |
| 719 | } |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 720 | |
| 721 | if (type == mark) { |
| 722 | blk = htx_get_next_blk(src, blk); |
| 723 | srcref = dstref = NULL; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 724 | break; |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 725 | } |
| 726 | |
| 727 | /* Save <blk> to <srcref> and <dstblk> to <dstref> when we start |
| 728 | * to xfer headers or trailers. When EOH/EOT block is reached, |
| 729 | * both are reset. It is mandatory to be able to rollback a |
| 730 | * partial transfer. |
| 731 | */ |
| 732 | if (!srcref && !dstref && |
| 733 | (type == HTX_BLK_REQ_SL || type == HTX_BLK_RES_SL || type == HTX_BLK_TLR)) { |
| 734 | srcref = blk; |
| 735 | dstref = dstblk; |
| 736 | } |
| 737 | else if (type == HTX_BLK_EOH || type == HTX_BLK_EOT) |
| 738 | srcref = dstref = NULL; |
| 739 | } |
| 740 | |
| 741 | if (unlikely(dstref)) { |
Christopher Faulet | 234a10a | 2022-02-28 15:29:56 +0100 | [diff] [blame] | 742 | /* Headers or trailers part was partially xferred, so rollback |
| 743 | * the copy by removing all block between <dstref> and <dstblk>, |
| 744 | * both included. <dstblk> may be NULL. |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 745 | */ |
| 746 | while (dstref && dstref != dstblk) |
| 747 | dstref = htx_remove_blk(dst, dstref); |
Christopher Faulet | 234a10a | 2022-02-28 15:29:56 +0100 | [diff] [blame] | 748 | if (dstblk) |
| 749 | htx_remove_blk(dst, dstblk); |
Christopher Faulet | c92ec0b | 2021-04-22 09:45:18 +0200 | [diff] [blame] | 750 | |
| 751 | /* <dst> HTX message is empty, it means the headers or trailers |
| 752 | * part is too big to be copied at once. |
| 753 | */ |
| 754 | if (htx_is_empty(dst)) |
| 755 | src->flags |= HTX_FL_PARSING_ERROR; |
| 756 | } |
| 757 | |
| 758 | /* Now, remove xferred blocks from <src> htx message */ |
| 759 | if (!blk && !srcref) { |
| 760 | /* End of src reached, all blocks were consumed, drain all data */ |
| 761 | htx_drain(src, src->data); |
| 762 | } |
| 763 | else { |
| 764 | /* Remove all block from the head to <blk>, or <srcref> if defined, excluded */ |
| 765 | srcref = (srcref ? srcref : blk); |
| 766 | for (blk = htx_get_head_blk(src); blk && blk != srcref; blk = htx_remove_blk(src, blk)); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 767 | } |
| 768 | |
Christopher Faulet | 156852b | 2019-05-16 11:29:13 +0200 | [diff] [blame] | 769 | end: |
| 770 | ret = htx_used_space(dst) - ret; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 771 | return (struct htx_ret){.ret = ret, .blk = dstblk}; |
| 772 | } |
| 773 | |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 774 | /* Replaces an header by a new one. The new header can be smaller or larger than |
| 775 | * the old one. It returns the new block on success, otherwise it returns NULL. |
Willy Tarreau | ed00e34 | 2018-12-07 08:47:45 +0100 | [diff] [blame] | 776 | * The header name is always lower cased. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 777 | */ |
| 778 | struct htx_blk *htx_replace_header(struct htx *htx, struct htx_blk *blk, |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 779 | const struct ist name, const struct ist value) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 780 | { |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 781 | enum htx_blk_type type; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 782 | void *ptr; |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 783 | int32_t delta; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 784 | int ret; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 785 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 786 | type = htx_get_blk_type(blk); |
| 787 | if (type != HTX_BLK_HDR) |
| 788 | return NULL; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 789 | |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 790 | delta = name.len + value.len - htx_get_blksz(blk); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 791 | ret = htx_prepare_blk_expansion(htx, blk, delta); |
| 792 | if (!ret) |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 793 | return NULL; /* not enough space */ |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 794 | |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 795 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 796 | /* Replace in place or at a new address is the same. We replace all the |
| 797 | * header (name+value). Only take care to defrag the message if |
| 798 | * necessary. */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 799 | if (ret == 3) |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 800 | blk = htx_defrag(htx, blk, (type << 28) + (value.len << 8) + name.len); |
| 801 | else { |
| 802 | /* Set the new block size and update HTX message */ |
| 803 | blk->info = (type << 28) + (value.len << 8) + name.len; |
| 804 | htx->data += delta; |
| 805 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 806 | |
Ilya Shipitsin | 47d1718 | 2020-06-21 21:42:57 +0500 | [diff] [blame] | 807 | /* Finally, copy data. */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 808 | ptr = htx_get_blk_ptr(htx, blk); |
| 809 | ist2bin_lc(ptr, name); |
| 810 | memcpy(ptr + name.len, value.ptr, value.len); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 811 | return blk; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 812 | } |
| 813 | |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 814 | /* Replaces the parts of the start-line. It returns the new start-line on |
| 815 | * success, otherwise it returns NULL. It is the caller responsibility to update |
| 816 | * sl->info, if necessary. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 817 | */ |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 818 | struct htx_sl *htx_replace_stline(struct htx *htx, struct htx_blk *blk, const struct ist p1, |
| 819 | const struct ist p2, const struct ist p3) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 820 | { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 821 | enum htx_blk_type type; |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 822 | struct htx_sl *sl; |
| 823 | struct htx_sl tmp; /* used to save sl->info and sl->flags */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 824 | uint32_t sz; |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 825 | int32_t delta; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 826 | int ret; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 827 | |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 828 | type = htx_get_blk_type(blk); |
Willy Tarreau | c706cd7 | 2018-12-07 17:12:22 +0100 | [diff] [blame] | 829 | if (type != HTX_BLK_REQ_SL && type != HTX_BLK_RES_SL) |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 830 | return NULL; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 831 | |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 832 | /* Save start-line info and flags */ |
| 833 | sl = htx_get_blk_ptr(htx, blk); |
| 834 | tmp.info = sl->info; |
| 835 | tmp.flags = sl->flags; |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 836 | |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 837 | sz = htx_get_blksz(blk); |
| 838 | delta = sizeof(*sl) + p1.len + p2.len + p3.len - sz; |
| 839 | ret = htx_prepare_blk_expansion(htx, blk, delta); |
| 840 | if (!ret) |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 841 | return NULL; /* not enough space */ |
| 842 | |
Christopher Faulet | 3b21972 | 2019-06-19 13:48:09 +0200 | [diff] [blame] | 843 | /* Replace in place or at a new address is the same. We replace all the |
| 844 | * start-line. Only take care to defrag the message if necessary. */ |
Christopher Faulet | 1cf414b | 2021-06-09 17:30:40 +0200 | [diff] [blame] | 845 | if (ret == 3) { |
| 846 | blk = htx_defrag(htx, blk, (type << 28) + sz + delta); |
| 847 | } |
| 848 | else { |
| 849 | /* Set the new block size and update HTX message */ |
| 850 | blk->info = (type << 28) + sz + delta; |
| 851 | htx->data += delta; |
| 852 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 853 | |
Christopher Faulet | e97f3ba | 2018-12-10 15:39:40 +0100 | [diff] [blame] | 854 | /* Restore start-line info and flags and copy parts of the start-line */ |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 855 | sl = htx_get_blk_ptr(htx, blk); |
| 856 | sl->info = tmp.info; |
| 857 | sl->flags = tmp.flags; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 858 | |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 859 | HTX_SL_P1_LEN(sl) = p1.len; |
| 860 | HTX_SL_P2_LEN(sl) = p2.len; |
| 861 | HTX_SL_P3_LEN(sl) = p3.len; |
Christopher Faulet | 54483df | 2018-11-26 15:05:52 +0100 | [diff] [blame] | 862 | |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 863 | memcpy(HTX_SL_P1_PTR(sl), p1.ptr, p1.len); |
| 864 | memcpy(HTX_SL_P2_PTR(sl), p2.ptr, p2.len); |
| 865 | memcpy(HTX_SL_P3_PTR(sl), p3.ptr, p3.len); |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 866 | |
Christopher Faulet | f1ba18d | 2018-11-26 21:37:08 +0100 | [diff] [blame] | 867 | return sl; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 868 | } |
| 869 | |
Christopher Faulet | e071f0e | 2021-02-03 12:11:31 +0100 | [diff] [blame] | 870 | /* Reserves the maximum possible size for an HTX data block, by extending an |
| 871 | * existing one or by creating a now one. It returns a compound result with the |
| 872 | * HTX block and the position where new data must be inserted (0 for a new |
| 873 | * block). If an error occurs or if there is no space left, NULL is returned |
| 874 | * instead of a pointer on an HTX block. |
| 875 | */ |
| 876 | struct htx_ret htx_reserve_max_data(struct htx *htx) |
| 877 | { |
| 878 | struct htx_blk *blk, *tailblk; |
| 879 | uint32_t sz, room; |
| 880 | int32_t len = htx_free_data_space(htx); |
| 881 | |
| 882 | if (htx->head == -1) |
| 883 | goto rsv_new_block; |
| 884 | |
| 885 | if (!len) |
| 886 | return (struct htx_ret){.ret = 0, .blk = NULL}; |
| 887 | |
| 888 | /* get the tail and head block */ |
| 889 | tailblk = htx_get_tail_blk(htx); |
| 890 | if (tailblk == NULL) |
| 891 | goto rsv_new_block; |
| 892 | sz = htx_get_blksz(tailblk); |
| 893 | |
| 894 | /* Don't try to append data if the last inserted block is not of the |
| 895 | * same type */ |
| 896 | if (htx_get_blk_type(tailblk) != HTX_BLK_DATA) |
| 897 | goto rsv_new_block; |
| 898 | |
| 899 | /* |
| 900 | * Same type and enough space: append data |
| 901 | */ |
| 902 | if (!htx->head_addr) { |
| 903 | if (tailblk->addr+sz != htx->tail_addr) |
| 904 | goto rsv_new_block; |
| 905 | room = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); |
| 906 | } |
| 907 | else { |
| 908 | if (tailblk->addr+sz != htx->head_addr) |
| 909 | goto rsv_new_block; |
| 910 | room = (htx->end_addr - htx->head_addr); |
| 911 | } |
| 912 | BUG_ON((int32_t)room < 0); |
| 913 | if (room < len) |
| 914 | len = room; |
| 915 | |
| 916 | append_data: |
| 917 | htx_change_blk_value_len(htx, tailblk, sz+len); |
| 918 | |
| 919 | BUG_ON((int32_t)htx->tail_addr < 0); |
| 920 | BUG_ON((int32_t)htx->head_addr < 0); |
| 921 | BUG_ON(htx->end_addr > htx->tail_addr); |
| 922 | BUG_ON(htx->head_addr > htx->end_addr); |
| 923 | return (struct htx_ret){.ret = sz, .blk = tailblk}; |
| 924 | |
| 925 | rsv_new_block: |
Christopher Faulet | e071f0e | 2021-02-03 12:11:31 +0100 | [diff] [blame] | 926 | blk = htx_add_blk(htx, HTX_BLK_DATA, len); |
| 927 | if (!blk) |
| 928 | return (struct htx_ret){.ret = 0, .blk = NULL}; |
| 929 | blk->info += len; |
| 930 | return (struct htx_ret){.ret = 0, .blk = blk}; |
| 931 | } |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 932 | |
| 933 | /* Adds an HTX block of type DATA in <htx>. It first tries to append data if |
Willy Tarreau | 0a7ef02 | 2019-05-28 10:30:11 +0200 | [diff] [blame] | 934 | * possible. It returns the number of bytes consumed from <data>, which may be |
| 935 | * zero if nothing could be copied. |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 936 | */ |
Willy Tarreau | 0a7ef02 | 2019-05-28 10:30:11 +0200 | [diff] [blame] | 937 | size_t htx_add_data(struct htx *htx, const struct ist data) |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 938 | { |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 939 | struct htx_blk *blk, *tailblk; |
| 940 | void *ptr; |
| 941 | uint32_t sz, room; |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 942 | int32_t len = data.len; |
Willy Tarreau | 0a7ef02 | 2019-05-28 10:30:11 +0200 | [diff] [blame] | 943 | |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 944 | /* Not enough space to store data */ |
| 945 | if (len > htx_free_data_space(htx)) |
| 946 | len = htx_free_data_space(htx); |
| 947 | |
| 948 | if (!len) |
| 949 | return 0; |
| 950 | |
Christopher Faulet | 28e7ba8 | 2022-01-12 14:03:42 +0100 | [diff] [blame] | 951 | if (htx->head == -1) |
| 952 | goto add_new_block; |
| 953 | |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 954 | /* get the tail and head block */ |
| 955 | tailblk = htx_get_tail_blk(htx); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 956 | if (tailblk == NULL) |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 957 | goto add_new_block; |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 958 | sz = htx_get_blksz(tailblk); |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 959 | |
| 960 | /* Don't try to append data if the last inserted block is not of the |
| 961 | * same type */ |
| 962 | if (htx_get_blk_type(tailblk) != HTX_BLK_DATA) |
| 963 | goto add_new_block; |
| 964 | |
| 965 | /* |
| 966 | * Same type and enough space: append data |
| 967 | */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 968 | if (!htx->head_addr) { |
| 969 | if (tailblk->addr+sz != htx->tail_addr) |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 970 | goto add_new_block; |
Christopher Faulet | 2bf43f0 | 2019-06-12 11:28:11 +0200 | [diff] [blame] | 971 | room = (htx_pos_to_addr(htx, htx->tail) - htx->tail_addr); |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 972 | } |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 973 | else { |
| 974 | if (tailblk->addr+sz != htx->head_addr) |
| 975 | goto add_new_block; |
| 976 | room = (htx->end_addr - htx->head_addr); |
| 977 | } |
| 978 | BUG_ON((int32_t)room < 0); |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 979 | if (room < len) |
| 980 | len = room; |
| 981 | |
| 982 | append_data: |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 983 | /* Append data and update the block itself */ |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 984 | ptr = htx_get_blk_ptr(htx, tailblk); |
| 985 | memcpy(ptr + sz, data.ptr, len); |
Christopher Faulet | 3e2638e | 2019-06-18 09:49:16 +0200 | [diff] [blame] | 986 | htx_change_blk_value_len(htx, tailblk, sz+len); |
Christopher Faulet | d7884d3 | 2019-06-11 10:40:43 +0200 | [diff] [blame] | 987 | |
| 988 | BUG_ON((int32_t)htx->tail_addr < 0); |
| 989 | BUG_ON((int32_t)htx->head_addr < 0); |
| 990 | BUG_ON(htx->end_addr > htx->tail_addr); |
| 991 | BUG_ON(htx->head_addr > htx->end_addr); |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 992 | return len; |
| 993 | |
| 994 | add_new_block: |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 995 | blk = htx_add_blk(htx, HTX_BLK_DATA, len); |
| 996 | if (!blk) |
Willy Tarreau | 0a7ef02 | 2019-05-28 10:30:11 +0200 | [diff] [blame] | 997 | return 0; |
Willy Tarreau | 0350b90 | 2019-05-28 10:58:50 +0200 | [diff] [blame] | 998 | |
| 999 | blk->info += len; |
| 1000 | memcpy(htx_get_blk_ptr(htx, blk), data.ptr, len); |
| 1001 | return len; |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 1002 | } |
| 1003 | |
Christopher Faulet | 86bc8df | 2019-06-11 10:38:38 +0200 | [diff] [blame] | 1004 | |
| 1005 | /* Adds an HTX block of type DATA in <htx> just after all other DATA |
| 1006 | * blocks. Because it relies on htx_add_data_atonce(), It may be happened to a |
| 1007 | * DATA block if possible. But, if the function succeeds, it will be the last |
| 1008 | * DATA block in all cases. If an error occurred, NULL is returned. Otherwise, |
| 1009 | * on success, the updated block (or the new one) is returned. |
| 1010 | */ |
| 1011 | struct htx_blk *htx_add_last_data(struct htx *htx, struct ist data) |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1012 | { |
Christopher Faulet | 86bc8df | 2019-06-11 10:38:38 +0200 | [diff] [blame] | 1013 | struct htx_blk *blk, *pblk; |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1014 | |
Christopher Faulet | 86bc8df | 2019-06-11 10:38:38 +0200 | [diff] [blame] | 1015 | blk = htx_add_data_atonce(htx, data); |
Christopher Faulet | aa75b3d | 2018-12-05 16:20:40 +0100 | [diff] [blame] | 1016 | if (!blk) |
| 1017 | return NULL; |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1018 | |
Christopher Faulet | 86bc8df | 2019-06-11 10:38:38 +0200 | [diff] [blame] | 1019 | for (pblk = htx_get_prev_blk(htx, blk); pblk; pblk = htx_get_prev_blk(htx, pblk)) { |
Christopher Faulet | 86bc8df | 2019-06-11 10:38:38 +0200 | [diff] [blame] | 1020 | if (htx_get_blk_type(pblk) <= HTX_BLK_DATA) |
| 1021 | break; |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1022 | |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1023 | /* Swap .addr and .info fields */ |
| 1024 | blk->addr ^= pblk->addr; pblk->addr ^= blk->addr; blk->addr ^= pblk->addr; |
| 1025 | blk->info ^= pblk->info; pblk->info ^= blk->info; blk->info ^= pblk->info; |
| 1026 | |
| 1027 | if (blk->addr == pblk->addr) |
| 1028 | blk->addr += htx_get_blksz(pblk); |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1029 | blk = pblk; |
| 1030 | } |
Christopher Faulet | 05aab64 | 2019-04-11 13:43:57 +0200 | [diff] [blame] | 1031 | |
Christopher Faulet | 24ed835 | 2018-11-22 11:20:43 +0100 | [diff] [blame] | 1032 | return blk; |
| 1033 | } |
Christopher Faulet | a3d2a16 | 2018-10-22 08:59:39 +0200 | [diff] [blame] | 1034 | |
Christopher Faulet | 86fcf6d | 2019-06-11 10:41:19 +0200 | [diff] [blame] | 1035 | /* Moves the block <blk> just before the block <ref>. Both blocks must be in the |
| 1036 | * HTX message <htx> and <blk> must be placed after <ref>. pointer to these |
| 1037 | * blocks are updated to remain valid after the move. */ |
| 1038 | void htx_move_blk_before(struct htx *htx, struct htx_blk **blk, struct htx_blk **ref) |
| 1039 | { |
| 1040 | struct htx_blk *cblk, *pblk; |
| 1041 | |
| 1042 | cblk = *blk; |
| 1043 | for (pblk = htx_get_prev_blk(htx, cblk); pblk; pblk = htx_get_prev_blk(htx, pblk)) { |
| 1044 | /* Swap .addr and .info fields */ |
| 1045 | cblk->addr ^= pblk->addr; pblk->addr ^= cblk->addr; cblk->addr ^= pblk->addr; |
| 1046 | cblk->info ^= pblk->info; pblk->info ^= cblk->info; cblk->info ^= pblk->info; |
| 1047 | |
| 1048 | if (cblk->addr == pblk->addr) |
| 1049 | cblk->addr += htx_get_blksz(pblk); |
| 1050 | if (pblk == *ref) |
| 1051 | break; |
| 1052 | cblk = pblk; |
| 1053 | } |
| 1054 | *blk = cblk; |
| 1055 | *ref = pblk; |
| 1056 | } |
Christopher Faulet | 0ea0c86 | 2020-01-23 11:47:53 +0100 | [diff] [blame] | 1057 | |
| 1058 | /* Append the HTX message <src> to the HTX message <dst>. It returns 1 on |
| 1059 | * success and 0 on error. All the message or nothing is copied. If an error |
| 1060 | * occurred, all blocks from <src> already appended to <dst> are truncated. |
| 1061 | */ |
| 1062 | int htx_append_msg(struct htx *dst, const struct htx *src) |
| 1063 | { |
| 1064 | struct htx_blk *blk, *newblk; |
| 1065 | enum htx_blk_type type; |
| 1066 | uint32_t blksz, offset = dst->data; |
| 1067 | |
| 1068 | for (blk = htx_get_head_blk(src); blk; blk = htx_get_next_blk(src, blk)) { |
| 1069 | type = htx_get_blk_type(blk); |
| 1070 | |
| 1071 | if (type == HTX_BLK_UNUSED) |
| 1072 | continue; |
| 1073 | |
| 1074 | blksz = htx_get_blksz(blk); |
| 1075 | newblk = htx_add_blk(dst, type, blksz); |
| 1076 | if (!newblk) |
| 1077 | goto error; |
| 1078 | newblk->info = blk->info; |
| 1079 | memcpy(htx_get_blk_ptr(dst, newblk), htx_get_blk_ptr(src, blk), blksz); |
| 1080 | } |
| 1081 | |
| 1082 | return 1; |
| 1083 | |
| 1084 | error: |
| 1085 | htx_truncate(dst, offset); |
| 1086 | return 0; |
| 1087 | } |