blob: c6b2a6f5f528611258100b3e51fa431e60b2f0a1 [file] [log] [blame]
Laurence Lundbladeb69cad72018-09-13 11:09:01 -07001/*==============================================================================
Laurence Lundbladed92a6162018-11-01 11:38:35 +07002 Copyright (c) 2016-2018, The Linux Foundation.
Laurence Lundbladed39cd392019-01-11 18:17:38 -08003 Copyright (c) 2018-2019, Laurence Lundblade.
Laurence Lundbladed92a6162018-11-01 11:38:35 +07004 All rights reserved.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -08005
Laurence Lundblade0dbc9172018-11-01 14:17:21 +07006Redistribution and use in source and binary forms, with or without
7modification, are permitted provided that the following conditions are
8met:
9 * Redistributions of source code must retain the above copyright
10 notice, this list of conditions and the following disclaimer.
11 * Redistributions in binary form must reproduce the above
12 copyright notice, this list of conditions and the following
13 disclaimer in the documentation and/or other materials provided
14 with the distribution.
15 * Neither the name of The Linux Foundation nor the names of its
16 contributors, nor the name "Laurence Lundblade" may be used to
17 endorse or promote products derived from this software without
18 specific prior written permission.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080019
Laurence Lundblade0dbc9172018-11-01 14:17:21 +070020THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
21WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
22MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
23ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
24BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
27BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
28WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
29OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
30IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
Laurence Lundblade624405d2018-09-18 20:10:47 -070031 ==============================================================================*/
32
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070033/*===================================================================================
34 FILE: qcbor_encode.c
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080035
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070036 DESCRIPTION: This file contains the implementation of QCBOR.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080037
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070038 EDIT HISTORY FOR FILE:
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080039
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070040 This section contains comments describing changes made to the module.
41 Notice that changes are listed in reverse chronological order.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080042
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070043 when who what, where, why
44 -------- ---- ---------------------------------------------------
Laurence Lundblade83f5b7f2019-04-06 11:22:37 -070045 4/6/19 llundblade Wrapped bstr returned now includes the wrapping bstr
Laurence Lundblade9c097392018-12-30 13:52:24 -080046 12/30/18 llundblade Small efficient clever encode of type & argument.
Laurence Lundblade067035b2018-11-28 17:35:25 -080047 11/29/18 llundblade Rework to simpler handling of tags and labels.
48 11/9/18 llundblade Error codes are now enums.
49 11/1/18 llundblade Floating support.
50 10/31/18 llundblade Switch to one license that is almost BSD-3.
51 09/28/18 llundblade Added bstr wrapping feature for COSE implementation.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080052 02/05/18 llundbla Works on CPUs which require integer alignment.
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070053 Requires new version of UsefulBuf.
54 07/05/17 llundbla Add bstr wrapping of maps/arrays for COSE
55 03/01/17 llundbla More data types
56 11/13/16 llundbla Integrate most TZ changes back into github version.
57 09/30/16 gkanike Porting to TZ.
58 03/15/16 llundbla Initial Version.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080059
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070060 =====================================================================================*/
61
62#include "qcbor.h"
Laurence Lundblade12d32c52018-09-19 11:25:27 -070063#include "ieee754.h"
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070064
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070065
66/*...... This is a ruler that is 80 characters long...........................*/
67
68
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070069/*
70 CBOR's two nesting types, arrays and maps, are tracked here. There is a
71 limit of QCBOR_MAX_ARRAY_NESTING to the number of arrays and maps
72 that can be nested in one encoding so the encoding context stays
73 small enough to fit on the stack.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080074
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070075 When an array / map is opened, pCurrentNesting points to the element
76 in pArrays that records the type, start position and accumluates a
77 count of the number of items added. When closed the start position is
78 used to go back and fill in the type and number of items in the array
79 / map.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080080
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070081 Encoded output be just items like ints and strings that are
82 not part of any array / map. That is, the first thing encoded
83 does not have to be an array or a map.
84 */
85inline static void Nesting_Init(QCBORTrackNesting *pNesting)
86{
87 // assumes pNesting has been zeroed
88 pNesting->pCurrentNesting = &pNesting->pArrays[0];
89 // Implied CBOR array at the top nesting level. This is never returned,
90 // but makes the item count work correctly.
91 pNesting->pCurrentNesting->uMajorType = CBOR_MAJOR_TYPE_ARRAY;
92}
93
Laurence Lundblade2c40ab82018-12-30 14:20:29 -080094inline static QCBORError Nesting_Increase(QCBORTrackNesting *pNesting,
95 uint8_t uMajorType,
96 uint32_t uPos)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -070097{
Laurence Lundblade30816f22018-11-10 13:40:22 +070098 QCBORError nReturn = QCBOR_SUCCESS;
Laurence Lundblade3aee3a32018-12-17 16:17:45 -080099
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700100 if(pNesting->pCurrentNesting == &pNesting->pArrays[QCBOR_MAX_ARRAY_NESTING]) {
101 // trying to open one too many
102 nReturn = QCBOR_ERR_ARRAY_NESTING_TOO_DEEP;
103 } else {
104 pNesting->pCurrentNesting++;
105 pNesting->pCurrentNesting->uCount = 0;
106 pNesting->pCurrentNesting->uStart = uPos;
107 pNesting->pCurrentNesting->uMajorType = uMajorType;
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700108 }
109 return nReturn;
110}
111
112inline static void Nesting_Decrease(QCBORTrackNesting *pNesting)
113{
114 pNesting->pCurrentNesting--;
115}
116
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800117inline static QCBORError Nesting_Increment(QCBORTrackNesting *pNesting)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700118{
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800119 if(1 >= QCBOR_MAX_ITEMS_IN_ARRAY - pNesting->pCurrentNesting->uCount) {
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700120 return QCBOR_ERR_ARRAY_TOO_LONG;
121 }
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800122
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800123 pNesting->pCurrentNesting->uCount += 1;
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800124
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700125 return QCBOR_SUCCESS;
126}
127
128inline static uint16_t Nesting_GetCount(QCBORTrackNesting *pNesting)
129{
130 // The nesting count recorded is always the actual number of individiual
131 // data items in the array or map. For arrays CBOR uses the actual item
132 // count. For maps, CBOR uses the number of pairs. This function returns
133 // the number needed for the CBOR encoding, so it divides the number of
134 // items by two for maps to get the number of pairs. This implementation
135 // takes advantage of the map major type being one larger the array major
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800136 // type, hence uDivisor is either 1 or 2.
137 const uint16_t uDivisor = pNesting->pCurrentNesting->uMajorType - CBOR_MAJOR_TYPE_ARRAY+1;
138
139 return pNesting->pCurrentNesting->uCount / uDivisor;
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700140}
141
142inline static uint32_t Nesting_GetStartPos(QCBORTrackNesting *pNesting)
143{
144 return pNesting->pCurrentNesting->uStart;
145}
146
147inline static uint8_t Nesting_GetMajorType(QCBORTrackNesting *pNesting)
148{
149 return pNesting->pCurrentNesting->uMajorType;
150}
151
152inline static int Nesting_IsInNest(QCBORTrackNesting *pNesting)
153{
154 return pNesting->pCurrentNesting == &pNesting->pArrays[0] ? 0 : 1;
155}
156
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700157
158
159
160/*
161 Error tracking plan -- Errors are tracked internally and not returned
162 until Finish is called. The CBOR errors are in me->uError.
Laurence Lundblade067035b2018-11-28 17:35:25 -0800163 UsefulOutBuf also tracks whether the buffer is full or not in its
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700164 context. Once either of these errors is set they are never
Laurence Lundblade241705e2018-12-30 18:56:14 -0800165 cleared. Only QCBOREncode_Init() resets them. Or said another way, they must
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700166 never be cleared or we'll tell the caller all is good when it is not.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800167
Laurence Lundblade241705e2018-12-30 18:56:14 -0800168 Only one error code is reported by QCBOREncode_Finish() even if there are
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700169 multiple errors. The last one set wins. The caller might have to fix
170 one error to reveal the next one they have to fix. This is OK.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800171
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700172 The buffer full error tracked by UsefulBuf is only pulled out of
173 UsefulBuf in Finish() so it is the one that usually wins. UsefulBuf
174 will never go off the end of the buffer even if it is called again
175 and again when full.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800176
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700177 It is really tempting to not check for overflow on the count in the
178 number of items in an array. It would save a lot of code, it is
179 extremely unlikely that any one will every put 65,000 items in an
180 array, and the only bad thing that would happen is the CBOR would be
Laurence Lundblade241705e2018-12-30 18:56:14 -0800181 bogus.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800182
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700183 Since this does not parse any input, you could in theory remove all
184 error checks in this code if you knew the caller called it
185 correctly. Maybe someday CDDL or some such language will be able to
186 generate the code to call this and the calling code would always be
Laurence Lundblade56230d12018-11-01 11:14:51 +0700187 correct. This could also automatically size some of the data
Laurence Lundblade241705e2018-12-30 18:56:14 -0800188 structures like array/map nesting resulting in some stack memory
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700189 savings.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800190
Laurence Lundblade241705e2018-12-30 18:56:14 -0800191 Errors returned here fall into two categories:
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800192
Laurence Lundblade067035b2018-11-28 17:35:25 -0800193 Sizes
Laurence Lundblade241705e2018-12-30 18:56:14 -0800194 QCBOR_ERR_BUFFER_TOO_LARGE -- Encoded output exceeded UINT32_MAX
Laurence Lundblade067035b2018-11-28 17:35:25 -0800195 QCBOR_ERR_BUFFER_TOO_SMALL -- output buffer too small
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800196
Laurence Lundblade241705e2018-12-30 18:56:14 -0800197 QCBOR_ERR_ARRAY_NESTING_TOO_DEEP -- Array/map nesting > QCBOR_MAX_ARRAY_NESTING1
Laurence Lundblade067035b2018-11-28 17:35:25 -0800198 QCBOR_ERR_ARRAY_TOO_LONG -- Too many things added to an array/map
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800199
Laurence Lundblade067035b2018-11-28 17:35:25 -0800200 Nesting constructed incorrectly
201 QCBOR_ERR_TOO_MANY_CLOSES -- more close calls than opens
202 QCBOR_ERR_CLOSE_MISMATCH -- Type of close does not match open
203 QCBOR_ERR_ARRAY_OR_MAP_STILL_OPEN -- Finish called without enough closes
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700204 */
205
206
207
208
209/*
210 Public function for initialization. See header qcbor.h
211 */
Laurence Lundblade2296db52018-09-14 18:08:39 -0700212void QCBOREncode_Init(QCBOREncodeContext *me, UsefulBuf Storage)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700213{
214 memset(me, 0, sizeof(QCBOREncodeContext));
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800215 UsefulOutBuf_Init(&(me->OutBuf), Storage);
216 Nesting_Init(&(me->nesting));
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700217}
218
219
220
221
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800222/*
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800223 All CBOR data items have a type and an "argument". The argument is
224 either the value of the item for integer types, the length of the
225 content for string, byte, array and map types, a tag for major type
226 6, and has several uses for major type 7.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800227
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800228 This function encodes the type and the argument. There are several
229 encodings for the argument depending on how large it is and how it is
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700230 used.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800231
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800232 Every encoding of the type and argument has at least one byte, the
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700233 "initial byte".
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800234
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700235 The top three bits of the initial byte are the major type for the
236 CBOR data item. The eight major types defined by the standard are
237 defined as CBOR_MAJOR_TYPE_xxxx in qcbor.h.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800238
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700239 The remaining five bits, known as "additional information", and
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800240 possibly more bytes encode the argument. If the argument is less than
241 24, then it is encoded entirely in the five bits. This is neat
242 because it allows you to encode an entire CBOR data item in 1 byte
243 for many values and types (integers 0-23, true, false, and tags).
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800244
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800245 If the argument is larger than 24, then it is encoded in 1,2,4 or 8
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700246 additional bytes, with the number of these bytes indicated by the
247 values of the 5 bits 24, 25, 25 and 27.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800248
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800249 It is possible to encode a particular argument in many ways with this
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700250 representation. This implementation always uses the smallest
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800251 possible representation. This conforms with CBOR preferred encoding.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800252
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700253 This function inserts them into the output buffer at the specified
Laurence Lundblade067035b2018-11-28 17:35:25 -0800254 position. AppendEncodedTypeAndNumber() appends to the end.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800255
256 This function takes care of converting to network byte order.
257
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700258 This function is also used to insert floats and doubles. Before this
259 function is called the float or double must be copied into a
260 uint64_t. That is how they are passed in. They are then converted to
261 network byte order correctly. The uMinLen param makes sure that even
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800262
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800263 if all the digits of a half, float or double are 0 it is still
264 correctly encoded in 2, 4 or 8 bytes.
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700265 */
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800266
267static void InsertEncodedTypeAndNumber(QCBOREncodeContext *me,
268 uint8_t uMajorType,
269 int nMinLen,
270 uint64_t uNumber,
271 size_t uPos)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700272{
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800273 /*
274 This code does endian conversion without hton or knowing the
Laurence Lundblade241705e2018-12-30 18:56:14 -0800275 endianness of the machine using masks and shifts. This avoids the
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800276 dependency on hton and the mess of figuring out how to find the
277 machine's endianness.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800278
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800279 This is a good efficient implementation on little-endian machines.
280 A faster and small implementation is possible on big-endian
281 machines because CBOR/network byte order is big endian. However
282 big endian machines are uncommon.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800283
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800284 On x86, it is about 200 bytes instead of 500 bytes for the more
285 formal unoptimized code.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800286
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800287 This also does the CBOR preferred shortest encoding for integers
288 and is called to do endian conversion for floats.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800289
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800290 It works backwards from the LSB to the MSB as needed.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800291
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800292 Code Reviewers: THIS FUNCTION DOES POINTER MATH
293 */
294 // Holds up to 9 bytes of type and argument
295 // plus one extra so pointer always points to
296 // valid bytes.
Laurence Lundblade04a859b2018-12-11 12:13:02 -0800297 uint8_t bytes[sizeof(uint64_t)+2];
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800298 // Point to the last bytes and work backwards
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800299 uint8_t *pByte = &bytes[sizeof(bytes)-1];
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800300 // This is the 5 bits in the initial byte that is not the major type
301 uint8_t uAdditionalInfo;
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800302
Laurence Lundblade04a859b2018-12-11 12:13:02 -0800303 if(uNumber < CBOR_TWENTY_FOUR && nMinLen == 0) {
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800304 // Simple case where argument is < 24
305 uAdditionalInfo = uNumber;
Laurence Lundblade04a859b2018-12-11 12:13:02 -0800306 } else {
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800307 /*
308 Encode argument in 1,2,4 or 8 bytes. Outer loop
309 runs once for 1 byte and 4 times for 8 bytes.
310 Inner loop runs 1, 2 or 4 times depending on
311 outer loop counter. This works backwards taking
312 8 bits off the argument being encoded at a time
313 until all bits from uNumber have been encoded
314 and the minimum encoding size is reached.
315 Minimum encoding size is for floating point
Laurence Lundblade241705e2018-12-30 18:56:14 -0800316 numbers with zero bytes.
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800317 */
Laurence Lundblade04a859b2018-12-11 12:13:02 -0800318 static const uint8_t aIterate[] = {1,1,2,4};
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800319 uint8_t i;
320 for(i = 0; uNumber || nMinLen > 0; i++) {
321 const uint8_t uIterations = aIterate[i];
322 for(int j = 0; j < uIterations; j++) {
Laurence Lundblade04a859b2018-12-11 12:13:02 -0800323 *--pByte = uNumber & 0xff;
324 uNumber = uNumber >> 8;
325 }
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800326 nMinLen -= uIterations;
Laurence Lundblade04a859b2018-12-11 12:13:02 -0800327 }
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800328 // Additional info is the encoding of the
329 // number of additional bytes to encode
330 // argument.
331 uAdditionalInfo = LEN_IS_ONE_BYTE-1 + i;
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700332 }
Laurence Lundbladee9b00322018-12-30 10:33:26 -0800333 *--pByte = (uMajorType << 5) + uAdditionalInfo;
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800334
335 UsefulOutBuf_InsertData(&(me->OutBuf), pByte, &bytes[sizeof(bytes)-1] - pByte, uPos);
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700336}
337
338
339/*
340 Append the type and number info to the end of the buffer.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800341
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700342 See InsertEncodedTypeAndNumber() function above for details
343*/
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800344inline static void AppendEncodedTypeAndNumber(QCBOREncodeContext *me,
345 uint8_t uMajorType,
346 uint64_t uNumber)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700347{
348 // An append is an insert at the end.
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800349 InsertEncodedTypeAndNumber(me,
350 uMajorType,
351 0,
352 uNumber,
353 UsefulOutBuf_GetEndPosition(&(me->OutBuf)));
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700354}
355
356
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700357
Laurence Lundblade241705e2018-12-30 18:56:14 -0800358
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700359/*
Laurence Lundblade067035b2018-11-28 17:35:25 -0800360 Public functions for closing arrays and maps. See header qcbor.h
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700361 */
Laurence Lundblade067035b2018-11-28 17:35:25 -0800362void QCBOREncode_AddUInt64(QCBOREncodeContext *me, uint64_t uValue)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700363{
Laurence Lundblade067035b2018-11-28 17:35:25 -0800364 if(me->uError == QCBOR_SUCCESS) {
365 AppendEncodedTypeAndNumber(me, CBOR_MAJOR_TYPE_POSITIVE_INT, uValue);
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800366 me->uError = Nesting_Increment(&(me->nesting));
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700367 }
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700368}
369
Laurence Lundblade56230d12018-11-01 11:14:51 +0700370
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700371/*
Laurence Lundblade067035b2018-11-28 17:35:25 -0800372 Public functions for closing arrays and maps. See header qcbor.h
373 */
374void QCBOREncode_AddInt64(QCBOREncodeContext *me, int64_t nNum)
375{
376 if(me->uError == QCBOR_SUCCESS) {
377 uint8_t uMajorType;
378 uint64_t uValue;
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800379
Laurence Lundblade067035b2018-11-28 17:35:25 -0800380 if(nNum < 0) {
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800381 // In CBOR -1 encodes as 0x00 with major type negative int.
382 uValue = (uint64_t)(-nNum - 1);
Laurence Lundblade067035b2018-11-28 17:35:25 -0800383 uMajorType = CBOR_MAJOR_TYPE_NEGATIVE_INT;
384 } else {
385 uValue = (uint64_t)nNum;
386 uMajorType = CBOR_MAJOR_TYPE_POSITIVE_INT;
387 }
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800388
Laurence Lundblade067035b2018-11-28 17:35:25 -0800389 AppendEncodedTypeAndNumber(me, uMajorType, uValue);
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800390 me->uError = Nesting_Increment(&(me->nesting));
Laurence Lundblade067035b2018-11-28 17:35:25 -0800391 }
392}
393
394
395/*
Laurence Lundbladeda532272019-04-07 11:40:17 -0700396 Semi-private function. It is exposed to user of the interface, but
397 they will usually call one of the inline wrappers rather than this.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800398
Laurence Lundblade067035b2018-11-28 17:35:25 -0800399 See header qcbor.h
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800400
Laurence Lundbladeda532272019-04-07 11:40:17 -0700401 Does the work of adding actual strings bytes to the CBOR output (as
402 opposed to numbers and opening / closing aggregate types).
403
404 There are four use cases:
405 CBOR_MAJOR_TYPE_BYTE_STRING -- Byte strings
406 CBOR_MAJOR_TYPE_TEXT_STRING -- Text strings
407 CBOR_MAJOR_NONE_TYPE_RAW -- Already-encoded CBOR
408 CBOR_MAJOR_NONE_TYPE_BSTR_LEN_ONLY -- Special case
409
410 The first two add the type and length plus the actual bytes. The
411 third just adds the bytes as the type and length are presumed to be
412 in the bytes. The fourth just adds the type and length for the very
413 special case of QCBOREncode_AddBytesLenOnly().
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700414 */
Laurence Lundblade067035b2018-11-28 17:35:25 -0800415void QCBOREncode_AddBuffer(QCBOREncodeContext *me, uint8_t uMajorType, UsefulBufC Bytes)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700416{
Laurence Lundblade241705e2018-12-30 18:56:14 -0800417 if(me->uError == QCBOR_SUCCESS) {
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800418 // If it is not Raw CBOR, add the type and the length
419 if(uMajorType != CBOR_MAJOR_NONE_TYPE_RAW) {
Laurence Lundbladeda532272019-04-07 11:40:17 -0700420 uint8_t uRealMajorType = uMajorType;
421 if(uRealMajorType == CBOR_MAJOR_NONE_TYPE_BSTR_LEN_ONLY) {
422 uRealMajorType = CBOR_MAJOR_TYPE_BYTE_STRING;
423 }
424 AppendEncodedTypeAndNumber(me, uRealMajorType, Bytes.len);
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700425 }
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800426
Laurence Lundbladeda532272019-04-07 11:40:17 -0700427 if(uMajorType != CBOR_MAJOR_NONE_TYPE_BSTR_LEN_ONLY) {
428 // Actually add the bytes
429 UsefulOutBuf_AppendUsefulBuf(&(me->OutBuf), Bytes);
430 }
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800431
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800432 // Update the array counting if there is any nesting at all
433 me->uError = Nesting_Increment(&(me->nesting));
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700434 }
435}
436
Laurence Lundbladecafcfe12018-10-31 21:59:50 +0700437
Laurence Lundblade55a24832018-10-30 04:35:08 +0700438/*
Laurence Lundblade067035b2018-11-28 17:35:25 -0800439 Public functions for closing arrays and maps. See header qcbor.h
Laurence Lundblade55a24832018-10-30 04:35:08 +0700440 */
441void QCBOREncode_AddTag(QCBOREncodeContext *me, uint64_t uTag)
442{
Laurence Lundblade55a24832018-10-30 04:35:08 +0700443 AppendEncodedTypeAndNumber(me, CBOR_MAJOR_TYPE_OPTIONAL, uTag);
444}
445
446
Laurence Lundblade56230d12018-11-01 11:14:51 +0700447/*
Laurence Lundblade487930f2018-11-30 11:01:45 -0800448 Semi-private function. It is exposed to user of the interface,
449 but they will usually call one of the inline wrappers rather than this.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800450
Laurence Lundblade487930f2018-11-30 11:01:45 -0800451 See header qcbor.h
Laurence Lundblade56230d12018-11-01 11:14:51 +0700452 */
Laurence Lundblade487930f2018-11-30 11:01:45 -0800453void QCBOREncode_AddType7(QCBOREncodeContext *me, size_t uSize, uint64_t uNum)
Laurence Lundblade55a24832018-10-30 04:35:08 +0700454{
Laurence Lundblade487930f2018-11-30 11:01:45 -0800455 if(me->uError == QCBOR_SUCCESS) {
456 // This function call takes care of endian swapping for the float / double
457 InsertEncodedTypeAndNumber(me,
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800458 // The major type for floats and doubles
459 CBOR_MAJOR_TYPE_SIMPLE,
460 // size makes sure floats with zeros encode correctly
461 (int)uSize,
462 // Bytes of the floating point number as a uint
463 uNum,
464 // end position because this is append
465 UsefulOutBuf_GetEndPosition(&(me->OutBuf)));
466
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800467 me->uError = Nesting_Increment(&(me->nesting));
Laurence Lundblade487930f2018-11-30 11:01:45 -0800468 }
Laurence Lundblade55a24832018-10-30 04:35:08 +0700469}
470
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700471
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700472/*
Laurence Lundblade067035b2018-11-28 17:35:25 -0800473 Public functions for closing arrays and maps. See header qcbor.h
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700474 */
Laurence Lundblade067035b2018-11-28 17:35:25 -0800475void QCBOREncode_AddDouble(QCBOREncodeContext *me, double dNum)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700476{
Laurence Lundblade067035b2018-11-28 17:35:25 -0800477 const IEEE754_union uNum = IEEE754_DoubleToSmallest(dNum);
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800478
Laurence Lundblade487930f2018-11-30 11:01:45 -0800479 QCBOREncode_AddType7(me, uNum.uSize, uNum.uValue);
Laurence Lundblade067035b2018-11-28 17:35:25 -0800480}
481
482
483/*
484 Semi-public function. It is exposed to user of the interface,
485 but they will usually call one of the inline wrappers rather than this.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800486
Laurence Lundblade067035b2018-11-28 17:35:25 -0800487 See header qcbor.h
488*/
489void QCBOREncode_OpenMapOrArray(QCBOREncodeContext *me, uint8_t uMajorType)
490{
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800491 // Add one item to the nesting level we are in for the new map or array
492 me->uError = Nesting_Increment(&(me->nesting));
Laurence Lundblade241705e2018-12-30 18:56:14 -0800493 if(me->uError == QCBOR_SUCCESS) {
Laurence Lundbladed39cd392019-01-11 18:17:38 -0800494 // The offset where the length of an array or map will get written
495 // is stored in a uint32_t, not a size_t to keep stack usage smaller. This
496 // checks to be sure there is no wrap around when recording the offset.
497 // Note that on 64-bit machines CBOR larger than 4GB can be encoded as long as no
498 // array / map offsets occur past the 4GB mark, but the public interface
499 // says that the maximum is 4GB to keep the discussion simpler.
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800500 size_t uEndPosition = UsefulOutBuf_GetEndPosition(&(me->OutBuf));
Laurence Lundbladed39cd392019-01-11 18:17:38 -0800501
502 // QCBOR_MAX_ARRAY_OFFSET is slightly less than UINT32_MAX so this
503 // code can run on a 32-bit machine and tests can pass on a 32-bit
504 // machine. If it was exactly UINT32_MAX, then this code would
505 // not compile or run on a 32-bit machine and an #ifdef or some
506 // machine size detection would be needed reducing portability.
507 if(uEndPosition >= QCBOR_MAX_ARRAY_OFFSET) {
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800508 me->uError = QCBOR_ERR_BUFFER_TOO_LARGE;
Laurence Lundbladed39cd392019-01-11 18:17:38 -0800509
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800510 } else {
Laurence Lundbladed39cd392019-01-11 18:17:38 -0800511 // Increase nesting level because this is a map or array.
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800512 // Cast from size_t to uin32_t is safe because of check above
513 me->uError = Nesting_Increase(&(me->nesting), uMajorType, (uint32_t)uEndPosition);
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700514 }
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800515 }
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700516}
517
518
519/*
Laurence Lundbladecafcfe12018-10-31 21:59:50 +0700520 Public functions for closing arrays and maps. See header qcbor.h
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700521 */
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800522void QCBOREncode_CloseMapOrArray(QCBOREncodeContext *me,
523 uint8_t uMajorType,
524 UsefulBufC *pWrappedCBOR)
Laurence Lundbladea954db92018-09-28 19:27:31 -0700525{
Laurence Lundblade241705e2018-12-30 18:56:14 -0800526 if(me->uError == QCBOR_SUCCESS) {
Laurence Lundbladea954db92018-09-28 19:27:31 -0700527 if(!Nesting_IsInNest(&(me->nesting))) {
528 me->uError = QCBOR_ERR_TOO_MANY_CLOSES;
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800529 } else if(Nesting_GetMajorType(&(me->nesting)) != uMajorType) {
Laurence Lundblade067035b2018-11-28 17:35:25 -0800530 me->uError = QCBOR_ERR_CLOSE_MISMATCH;
Laurence Lundbladea954db92018-09-28 19:27:31 -0700531 } else {
Laurence Lundblade56230d12018-11-01 11:14:51 +0700532 // When the array, map or bstr wrap was started, nothing was done
533 // except note the position of the start of it. This code goes back
534 // and inserts the actual CBOR array, map or bstr and its length.
535 // That means all the data that is in the array, map or wrapped
536 // needs to be slid to the right. This is done by UsefulOutBuf's
537 // insert function that is called from inside
538 // InsertEncodedTypeAndNumber()
539 const size_t uInsertPosition = Nesting_GetStartPos(&(me->nesting));
540 const size_t uEndPosition = UsefulOutBuf_GetEndPosition(&(me->OutBuf));
541 // This can't go negative because the UsefulOutBuf always only grows
542 // and never shrinks. UsefulOutBut itself also has defenses such that
543 // it won't write were it should not even if given hostile input lengths
544 const size_t uLenOfEncodedMapOrArray = uEndPosition - uInsertPosition;
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800545
Laurence Lundblade56230d12018-11-01 11:14:51 +0700546 // Length is number of bytes for a bstr and number of items a for map & array
547 const size_t uLength = uMajorType == CBOR_MAJOR_TYPE_BYTE_STRING ?
Laurence Lundbladea954db92018-09-28 19:27:31 -0700548 uLenOfEncodedMapOrArray : Nesting_GetCount(&(me->nesting));
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800549
Laurence Lundbladea954db92018-09-28 19:27:31 -0700550 // Actually insert
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700551 InsertEncodedTypeAndNumber(me,
Laurence Lundbladea954db92018-09-28 19:27:31 -0700552 uMajorType, // major type bstr, array or map
553 0, // no minimum length for encoding
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800554 uLength, // either len of bstr or num map / array items
Laurence Lundbladea954db92018-09-28 19:27:31 -0700555 uInsertPosition); // position in out buffer
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800556
Laurence Lundbladea954db92018-09-28 19:27:31 -0700557 // Return pointer and length to the enclosed encoded CBOR. The intended
558 // use is for it to be hashed (e.g., SHA-256) in a COSE implementation.
559 // This must be used right away, as the pointer and length go invalid
Laurence Lundblade83f5b7f2019-04-06 11:22:37 -0700560 // on any subsequent calls to this function because there might be calls to
561 // InsertEncodedTypeAndNumber() that slides data to the right.
Laurence Lundbladea954db92018-09-28 19:27:31 -0700562 if(pWrappedCBOR) {
Laurence Lundblade25c6c0a2018-12-17 13:21:59 -0800563 const UsefulBufC PartialResult = UsefulOutBuf_OutUBuf(&(me->OutBuf));
Laurence Lundblade83f5b7f2019-04-06 11:22:37 -0700564 *pWrappedCBOR = UsefulBuf_Tail(PartialResult, uInsertPosition);
Laurence Lundbladea954db92018-09-28 19:27:31 -0700565 }
566 Nesting_Decrease(&(me->nesting));
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700567 }
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700568 }
569}
570
571
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700572/*
573 Public functions to finish and get the encoded result. See header qcbor.h
574 */
Laurence Lundblade30816f22018-11-10 13:40:22 +0700575QCBORError QCBOREncode_Finish(QCBOREncodeContext *me, UsefulBufC *pEncodedCBOR)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700576{
Laurence Lundbladef607a2a2019-07-05 21:25:25 -0700577 QCBORError uReturn = QCBOREncode_GetErrorState(me);
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800578
Laurence Lundblade067035b2018-11-28 17:35:25 -0800579 if(uReturn != QCBOR_SUCCESS) {
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700580 goto Done;
Laurence Lundblade067035b2018-11-28 17:35:25 -0800581 }
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800582
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700583 if (Nesting_IsInNest(&(me->nesting))) {
Laurence Lundblade067035b2018-11-28 17:35:25 -0800584 uReturn = QCBOR_ERR_ARRAY_OR_MAP_STILL_OPEN;
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700585 goto Done;
586 }
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800587
Laurence Lundbladeda3f0822018-09-18 19:49:02 -0700588 *pEncodedCBOR = UsefulOutBuf_OutUBuf(&(me->OutBuf));
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800589
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700590Done:
Laurence Lundblade067035b2018-11-28 17:35:25 -0800591 return uReturn;
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700592}
593
Laurence Lundblade0595e932018-11-02 22:22:47 +0700594
Laurence Lundbladef607a2a2019-07-05 21:25:25 -0700595
Laurence Lundblade067035b2018-11-28 17:35:25 -0800596/*
597 Public functions to finish and get the encoded result. See header qcbor.h
598 */
Laurence Lundblade30816f22018-11-10 13:40:22 +0700599QCBORError QCBOREncode_FinishGetSize(QCBOREncodeContext *me, size_t *puEncodedLen)
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700600{
Laurence Lundbladeda3f0822018-09-18 19:49:02 -0700601 UsefulBufC Enc;
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800602
Laurence Lundblade30816f22018-11-10 13:40:22 +0700603 QCBORError nReturn = QCBOREncode_Finish(me, &Enc);
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800604
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700605 if(nReturn == QCBOR_SUCCESS) {
Laurence Lundbladeda3f0822018-09-18 19:49:02 -0700606 *puEncodedLen = Enc.len;
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700607 }
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800608
Laurence Lundbladeb69cad72018-09-13 11:09:01 -0700609 return nReturn;
610}
611
612
Laurence Lundblade067035b2018-11-28 17:35:25 -0800613
614
615/*
616 Notes on the code
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800617
Laurence Lundblade067035b2018-11-28 17:35:25 -0800618 CBOR Major Type Public Function
619 0 QCBOREncode_AddUInt64
620 0, 1 QCBOREncode_AddUInt64, QCBOREncode_AddInt64
621 2, 3 QCBOREncode_AddBuffer, Also QCBOREncode_OpenMapOrArray
622 4, 5 QCBOREncode_OpenMapOrArray
623 6 QCBOREncode_AddTag
Laurence Lundblade4e7bc682018-12-14 23:21:04 -0800624 7 QCBOREncode_AddDouble, QCBOREncode_AddType7
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800625
Laurence Lundblade241705e2018-12-30 18:56:14 -0800626 Object code sizes on X86 with LLVM compiler and -Os (Dec 30, 2018)
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800627
Laurence Lundblade9c097392018-12-30 13:52:24 -0800628 _QCBOREncode_Init 69
Laurence Lundblade067035b2018-11-28 17:35:25 -0800629 _QCBOREncode_AddUInt64 76
630 _QCBOREncode_AddInt64 87
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800631 _QCBOREncode_AddBuffer 113
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800632 _QCBOREncode_AddTag 27
Laurence Lundblade9c097392018-12-30 13:52:24 -0800633 _QCBOREncode_AddType7 87
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800634 _QCBOREncode_AddDouble 36
Laurence Lundblade1ef8b2d2018-12-14 23:13:34 -0800635 _QCBOREncode_OpenMapOrArray 103
Laurence Lundblade067035b2018-11-28 17:35:25 -0800636 _QCBOREncode_CloseMapOrArray 181
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800637 _InsertEncodedTypeAndNumber 190
Laurence Lundblade067035b2018-11-28 17:35:25 -0800638 _QCBOREncode_Finish 72
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800639 _QCBOREncode_FinishGetSize 70
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800640
Laurence Lundbladef970f1d2018-12-14 01:44:23 -0800641 Total is about 1.1KB
Laurence Lundblade2c40ab82018-12-30 14:20:29 -0800642
Laurence Lundblade067035b2018-11-28 17:35:25 -0800643 _QCBOREncode_CloseMapOrArray is larger because it has a lot
644 of nesting tracking to do and much of Nesting_ inlines
645 into it. It probably can't be reduced much.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800646
Laurence Lundblade067035b2018-11-28 17:35:25 -0800647 If the error returned by Nesting_Increment() can be ignored
648 because the limit is so high and the consequence of exceeding
649 is proved to be inconsequential, then a lot of if(me->uError)
650 instance can be removed, saving some code.
Laurence Lundblade3aee3a32018-12-17 16:17:45 -0800651
Laurence Lundblade067035b2018-11-28 17:35:25 -0800652 */
653