terence zhang / wakaama-core

pick up wakaama files from https://github.com/eclipse/wakaama

core/utils.c@0:1fa43ab66921, 2017-04-19 (annotated)

Committer:
terencez
Date:
Wed Apr 19 11:30:02 2017 +0000
Revision:
0:1fa43ab66921
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
terencez 0:1fa43ab66921 1 /*******************************************************************************
terencez 0:1fa43ab66921 2 *
terencez 0:1fa43ab66921 3 * Copyright (c) 2013, 2014 Intel Corporation and others.
terencez 0:1fa43ab66921 4 * All rights reserved. This program and the accompanying materials
terencez 0:1fa43ab66921 5 * are made available under the terms of the Eclipse Public License v1.0
terencez 0:1fa43ab66921 6 * and Eclipse Distribution License v1.0 which accompany this distribution.
terencez 0:1fa43ab66921 7 *
terencez 0:1fa43ab66921 8 * The Eclipse Public License is available at
terencez 0:1fa43ab66921 9 * http://www.eclipse.org/legal/epl-v10.html
terencez 0:1fa43ab66921 10 * The Eclipse Distribution License is available at
terencez 0:1fa43ab66921 11 * http://www.eclipse.org/org/documents/edl-v10.php.
terencez 0:1fa43ab66921 12 *
terencez 0:1fa43ab66921 13 * Contributors:
terencez 0:1fa43ab66921 14 * David Navarro, Intel Corporation - initial API and implementation
terencez 0:1fa43ab66921 15 * Toby Jaffey - Please refer to git log
terencez 0:1fa43ab66921 16 *
terencez 0:1fa43ab66921 17 *******************************************************************************/
terencez 0:1fa43ab66921 18
terencez 0:1fa43ab66921 19 /*
terencez 0:1fa43ab66921 20 Copyright (c) 2013, 2014 Intel Corporation
terencez 0:1fa43ab66921 21
terencez 0:1fa43ab66921 22 Redistribution and use in source and binary forms, with or without modification,
terencez 0:1fa43ab66921 23 are permitted provided that the following conditions are met:
terencez 0:1fa43ab66921 24
terencez 0:1fa43ab66921 25 * Redistributions of source code must retain the above copyright notice,
terencez 0:1fa43ab66921 26 this list of conditions and the following disclaimer.
terencez 0:1fa43ab66921 27 * Redistributions in binary form must reproduce the above copyright notice,
terencez 0:1fa43ab66921 28 this list of conditions and the following disclaimer in the documentation
terencez 0:1fa43ab66921 29 and/or other materials provided with the distribution.
terencez 0:1fa43ab66921 30 * Neither the name of Intel Corporation nor the names of its contributors
terencez 0:1fa43ab66921 31 may be used to endorse or promote products derived from this software
terencez 0:1fa43ab66921 32 without specific prior written permission.
terencez 0:1fa43ab66921 33
terencez 0:1fa43ab66921 34 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
terencez 0:1fa43ab66921 35 ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
terencez 0:1fa43ab66921 36 WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
terencez 0:1fa43ab66921 37 IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
terencez 0:1fa43ab66921 38 INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
terencez 0:1fa43ab66921 39 BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
terencez 0:1fa43ab66921 40 DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
terencez 0:1fa43ab66921 41 LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
terencez 0:1fa43ab66921 42 OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
terencez 0:1fa43ab66921 43 THE POSSIBILITY OF SUCH DAMAGE.
terencez 0:1fa43ab66921 44
terencez 0:1fa43ab66921 45 David Navarro <david.navarro@intel.com>
terencez 0:1fa43ab66921 46
terencez 0:1fa43ab66921 47 */
terencez 0:1fa43ab66921 48
terencez 0:1fa43ab66921 49 #include "internals.h"
terencez 0:1fa43ab66921 50 #include <stdlib.h>
terencez 0:1fa43ab66921 51 #include <string.h>
terencez 0:1fa43ab66921 52 #include <stdio.h>
terencez 0:1fa43ab66921 53 #include <float.h>
terencez 0:1fa43ab66921 54
terencez 0:1fa43ab66921 55
terencez 0:1fa43ab66921 56 int utils_plainTextToInt64(uint8_t * buffer,
terencez 0:1fa43ab66921 57 int length,
terencez 0:1fa43ab66921 58 int64_t * dataP)
terencez 0:1fa43ab66921 59 {
terencez 0:1fa43ab66921 60 uint64_t result = 0;
terencez 0:1fa43ab66921 61 int sign = 1;
terencez 0:1fa43ab66921 62 int i = 0;
terencez 0:1fa43ab66921 63
terencez 0:1fa43ab66921 64 if (0 == length) return 0;
terencez 0:1fa43ab66921 65
terencez 0:1fa43ab66921 66 if (buffer[0] == '-')
terencez 0:1fa43ab66921 67 {
terencez 0:1fa43ab66921 68 sign = -1;
terencez 0:1fa43ab66921 69 i = 1;
terencez 0:1fa43ab66921 70 }
terencez 0:1fa43ab66921 71
terencez 0:1fa43ab66921 72 while (i < length)
terencez 0:1fa43ab66921 73 {
terencez 0:1fa43ab66921 74 if ('0' <= buffer[i] && buffer[i] <= '9')
terencez 0:1fa43ab66921 75 {
terencez 0:1fa43ab66921 76 if (result > (UINT64_MAX / 10)) return 0;
terencez 0:1fa43ab66921 77 result *= 10;
terencez 0:1fa43ab66921 78 result += buffer[i] - '0';
terencez 0:1fa43ab66921 79 }
terencez 0:1fa43ab66921 80 else
terencez 0:1fa43ab66921 81 {
terencez 0:1fa43ab66921 82 return 0;
terencez 0:1fa43ab66921 83 }
terencez 0:1fa43ab66921 84 i++;
terencez 0:1fa43ab66921 85 }
terencez 0:1fa43ab66921 86
terencez 0:1fa43ab66921 87 if (result > INT64_MAX) return 0;
terencez 0:1fa43ab66921 88
terencez 0:1fa43ab66921 89 if (sign == -1)
terencez 0:1fa43ab66921 90 {
terencez 0:1fa43ab66921 91 *dataP = 0 - result;
terencez 0:1fa43ab66921 92 }
terencez 0:1fa43ab66921 93 else
terencez 0:1fa43ab66921 94 {
terencez 0:1fa43ab66921 95 *dataP = result;
terencez 0:1fa43ab66921 96 }
terencez 0:1fa43ab66921 97
terencez 0:1fa43ab66921 98 return 1;
terencez 0:1fa43ab66921 99 }
terencez 0:1fa43ab66921 100
terencez 0:1fa43ab66921 101 int utils_plainTextToFloat64(uint8_t * buffer,
terencez 0:1fa43ab66921 102 int length,
terencez 0:1fa43ab66921 103 double * dataP)
terencez 0:1fa43ab66921 104 {
terencez 0:1fa43ab66921 105 double result;
terencez 0:1fa43ab66921 106 int sign;
terencez 0:1fa43ab66921 107 int i;
terencez 0:1fa43ab66921 108
terencez 0:1fa43ab66921 109 if (0 == length) return 0;
terencez 0:1fa43ab66921 110
terencez 0:1fa43ab66921 111 if (buffer[0] == '-')
terencez 0:1fa43ab66921 112 {
terencez 0:1fa43ab66921 113 sign = -1;
terencez 0:1fa43ab66921 114 i = 1;
terencez 0:1fa43ab66921 115 }
terencez 0:1fa43ab66921 116 else
terencez 0:1fa43ab66921 117 {
terencez 0:1fa43ab66921 118 sign = 1;
terencez 0:1fa43ab66921 119 i = 0;
terencez 0:1fa43ab66921 120 }
terencez 0:1fa43ab66921 121
terencez 0:1fa43ab66921 122 result = 0;
terencez 0:1fa43ab66921 123 while (i < length && buffer[i] != '.')
terencez 0:1fa43ab66921 124 {
terencez 0:1fa43ab66921 125 if ('0' <= buffer[i] && buffer[i] <= '9')
terencez 0:1fa43ab66921 126 {
terencez 0:1fa43ab66921 127 if (result > (DBL_MAX / 10)) return 0;
terencez 0:1fa43ab66921 128 result *= 10;
terencez 0:1fa43ab66921 129 result += (buffer[i] - '0');
terencez 0:1fa43ab66921 130 }
terencez 0:1fa43ab66921 131 else
terencez 0:1fa43ab66921 132 {
terencez 0:1fa43ab66921 133 return 0;
terencez 0:1fa43ab66921 134 }
terencez 0:1fa43ab66921 135 i++;
terencez 0:1fa43ab66921 136 }
terencez 0:1fa43ab66921 137 if (buffer[i] == '.')
terencez 0:1fa43ab66921 138 {
terencez 0:1fa43ab66921 139 double dec;
terencez 0:1fa43ab66921 140
terencez 0:1fa43ab66921 141 i++;
terencez 0:1fa43ab66921 142 if (i == length) return 0;
terencez 0:1fa43ab66921 143
terencez 0:1fa43ab66921 144 dec = 0.1;
terencez 0:1fa43ab66921 145 while (i < length)
terencez 0:1fa43ab66921 146 {
terencez 0:1fa43ab66921 147 if ('0' <= buffer[i] && buffer[i] <= '9')
terencez 0:1fa43ab66921 148 {
terencez 0:1fa43ab66921 149 if (result > (DBL_MAX - 1)) return 0;
terencez 0:1fa43ab66921 150 result += (buffer[i] - '0') * dec;
terencez 0:1fa43ab66921 151 dec /= 10;
terencez 0:1fa43ab66921 152 }
terencez 0:1fa43ab66921 153 else
terencez 0:1fa43ab66921 154 {
terencez 0:1fa43ab66921 155 return 0;
terencez 0:1fa43ab66921 156 }
terencez 0:1fa43ab66921 157 i++;
terencez 0:1fa43ab66921 158 }
terencez 0:1fa43ab66921 159 }
terencez 0:1fa43ab66921 160
terencez 0:1fa43ab66921 161 *dataP = result * sign;
terencez 0:1fa43ab66921 162 return 1;
terencez 0:1fa43ab66921 163 }
terencez 0:1fa43ab66921 164
terencez 0:1fa43ab66921 165 size_t utils_intToText(int64_t data,
terencez 0:1fa43ab66921 166 uint8_t * string,
terencez 0:1fa43ab66921 167 size_t length)
terencez 0:1fa43ab66921 168 {
terencez 0:1fa43ab66921 169 int index;
terencez 0:1fa43ab66921 170 bool minus;
terencez 0:1fa43ab66921 171 size_t result;
terencez 0:1fa43ab66921 172
terencez 0:1fa43ab66921 173 if (data < 0)
terencez 0:1fa43ab66921 174 {
terencez 0:1fa43ab66921 175 minus = true;
terencez 0:1fa43ab66921 176 data = 0 - data;
terencez 0:1fa43ab66921 177 }
terencez 0:1fa43ab66921 178 else
terencez 0:1fa43ab66921 179 {
terencez 0:1fa43ab66921 180 minus = false;
terencez 0:1fa43ab66921 181 }
terencez 0:1fa43ab66921 182
terencez 0:1fa43ab66921 183 index = length - 1;
terencez 0:1fa43ab66921 184 do
terencez 0:1fa43ab66921 185 {
terencez 0:1fa43ab66921 186 string[index] = '0' + data%10;
terencez 0:1fa43ab66921 187 data /= 10;
terencez 0:1fa43ab66921 188 index --;
terencez 0:1fa43ab66921 189 } while (index >= 0 && data > 0);
terencez 0:1fa43ab66921 190
terencez 0:1fa43ab66921 191 if (data > 0) return 0;
terencez 0:1fa43ab66921 192
terencez 0:1fa43ab66921 193 if (minus == true)
terencez 0:1fa43ab66921 194 {
terencez 0:1fa43ab66921 195 if (index == 0) return 0;
terencez 0:1fa43ab66921 196 string[index] = '-';
terencez 0:1fa43ab66921 197 }
terencez 0:1fa43ab66921 198 else
terencez 0:1fa43ab66921 199 {
terencez 0:1fa43ab66921 200 index++;
terencez 0:1fa43ab66921 201 }
terencez 0:1fa43ab66921 202
terencez 0:1fa43ab66921 203 result = length - index;
terencez 0:1fa43ab66921 204
terencez 0:1fa43ab66921 205 if (result < length)
terencez 0:1fa43ab66921 206 {
terencez 0:1fa43ab66921 207 memmove(string, string + index, result);
terencez 0:1fa43ab66921 208 }
terencez 0:1fa43ab66921 209
terencez 0:1fa43ab66921 210 return result;
terencez 0:1fa43ab66921 211 }
terencez 0:1fa43ab66921 212
terencez 0:1fa43ab66921 213 size_t utils_floatToText(double data,
terencez 0:1fa43ab66921 214 uint8_t * string,
terencez 0:1fa43ab66921 215 size_t length)
terencez 0:1fa43ab66921 216 {
terencez 0:1fa43ab66921 217 size_t intLength;
terencez 0:1fa43ab66921 218 size_t decLength;
terencez 0:1fa43ab66921 219 int64_t intPart;
terencez 0:1fa43ab66921 220 double decPart;
terencez 0:1fa43ab66921 221
terencez 0:1fa43ab66921 222 if (data <= (double)INT64_MIN || data >= (double)INT64_MAX) return 0;
terencez 0:1fa43ab66921 223
terencez 0:1fa43ab66921 224 intPart = (int64_t)data;
terencez 0:1fa43ab66921 225 decPart = data - intPart;
terencez 0:1fa43ab66921 226 if (decPart < 0)
terencez 0:1fa43ab66921 227 {
terencez 0:1fa43ab66921 228 decPart = 1 - decPart;
terencez 0:1fa43ab66921 229 }
terencez 0:1fa43ab66921 230 else
terencez 0:1fa43ab66921 231 {
terencez 0:1fa43ab66921 232 decPart = 1 + decPart;
terencez 0:1fa43ab66921 233 }
terencez 0:1fa43ab66921 234
terencez 0:1fa43ab66921 235 if (decPart <= 1 + FLT_EPSILON)
terencez 0:1fa43ab66921 236 {
terencez 0:1fa43ab66921 237 decPart = 0;
terencez 0:1fa43ab66921 238 }
terencez 0:1fa43ab66921 239
terencez 0:1fa43ab66921 240 if (intPart == 0 && data < 0)
terencez 0:1fa43ab66921 241 {
terencez 0:1fa43ab66921 242 // deal with numbers between -1 and 0
terencez 0:1fa43ab66921 243 if (length < 4) return 0; // "-0.n"
terencez 0:1fa43ab66921 244 string[0] = '-';
terencez 0:1fa43ab66921 245 string[1] = '0';
terencez 0:1fa43ab66921 246 intLength = 2;
terencez 0:1fa43ab66921 247 }
terencez 0:1fa43ab66921 248 else
terencez 0:1fa43ab66921 249 {
terencez 0:1fa43ab66921 250 intLength = utils_intToText(intPart, string, length);
terencez 0:1fa43ab66921 251 if (intLength == 0) return 0;
terencez 0:1fa43ab66921 252 }
terencez 0:1fa43ab66921 253 decLength = 0;
terencez 0:1fa43ab66921 254 if (decPart >= FLT_EPSILON)
terencez 0:1fa43ab66921 255 {
terencez 0:1fa43ab66921 256 double noiseFloor;
terencez 0:1fa43ab66921 257
terencez 0:1fa43ab66921 258 if (intLength >= length - 1) return 0;
terencez 0:1fa43ab66921 259
terencez 0:1fa43ab66921 260 noiseFloor = FLT_EPSILON;
terencez 0:1fa43ab66921 261 do
terencez 0:1fa43ab66921 262 {
terencez 0:1fa43ab66921 263 decPart *= 10;
terencez 0:1fa43ab66921 264 noiseFloor *= 10;
terencez 0:1fa43ab66921 265 } while (decPart - (int64_t)decPart > noiseFloor);
terencez 0:1fa43ab66921 266
terencez 0:1fa43ab66921 267 decLength = utils_intToText(decPart, string + intLength, length - intLength);
terencez 0:1fa43ab66921 268 if (decLength <= 1) return 0;
terencez 0:1fa43ab66921 269
terencez 0:1fa43ab66921 270 // replace the leading 1 with a dot
terencez 0:1fa43ab66921 271 string[intLength] = '.';
terencez 0:1fa43ab66921 272 }
terencez 0:1fa43ab66921 273
terencez 0:1fa43ab66921 274 return intLength + decLength;
terencez 0:1fa43ab66921 275 }
terencez 0:1fa43ab66921 276
terencez 0:1fa43ab66921 277 size_t utils_int64ToPlainText(int64_t data,
terencez 0:1fa43ab66921 278 uint8_t ** bufferP)
terencez 0:1fa43ab66921 279 {
terencez 0:1fa43ab66921 280 #define _PRV_STR_LENGTH 32
terencez 0:1fa43ab66921 281 uint8_t string[_PRV_STR_LENGTH];
terencez 0:1fa43ab66921 282 size_t length;
terencez 0:1fa43ab66921 283
terencez 0:1fa43ab66921 284 length = utils_intToText(data, string, _PRV_STR_LENGTH);
terencez 0:1fa43ab66921 285 if (length == 0) return 0;
terencez 0:1fa43ab66921 286
terencez 0:1fa43ab66921 287 *bufferP = (uint8_t *)lwm2m_malloc(length);
terencez 0:1fa43ab66921 288 if (NULL == *bufferP) return 0;
terencez 0:1fa43ab66921 289
terencez 0:1fa43ab66921 290 memcpy(*bufferP, string, length);
terencez 0:1fa43ab66921 291
terencez 0:1fa43ab66921 292 return length;
terencez 0:1fa43ab66921 293 }
terencez 0:1fa43ab66921 294
terencez 0:1fa43ab66921 295
terencez 0:1fa43ab66921 296 size_t utils_float64ToPlainText(double data,
terencez 0:1fa43ab66921 297 uint8_t ** bufferP)
terencez 0:1fa43ab66921 298 {
terencez 0:1fa43ab66921 299 uint8_t string[_PRV_STR_LENGTH * 2];
terencez 0:1fa43ab66921 300 size_t length;
terencez 0:1fa43ab66921 301
terencez 0:1fa43ab66921 302 length = utils_floatToText(data, string, _PRV_STR_LENGTH * 2);
terencez 0:1fa43ab66921 303 if (length == 0) return 0;
terencez 0:1fa43ab66921 304
terencez 0:1fa43ab66921 305 *bufferP = (uint8_t *)lwm2m_malloc(length);
terencez 0:1fa43ab66921 306 if (NULL == *bufferP) return 0;
terencez 0:1fa43ab66921 307
terencez 0:1fa43ab66921 308 memcpy(*bufferP, string, length);
terencez 0:1fa43ab66921 309
terencez 0:1fa43ab66921 310 return length;
terencez 0:1fa43ab66921 311 }
terencez 0:1fa43ab66921 312
terencez 0:1fa43ab66921 313
terencez 0:1fa43ab66921 314 size_t utils_boolToPlainText(bool data,
terencez 0:1fa43ab66921 315 uint8_t ** bufferP)
terencez 0:1fa43ab66921 316 {
terencez 0:1fa43ab66921 317 return utils_int64ToPlainText((int64_t)(data?1:0), bufferP);
terencez 0:1fa43ab66921 318 }
terencez 0:1fa43ab66921 319
terencez 0:1fa43ab66921 320 lwm2m_binding_t utils_stringToBinding(uint8_t * buffer,
terencez 0:1fa43ab66921 321 size_t length)
terencez 0:1fa43ab66921 322 {
terencez 0:1fa43ab66921 323 if (length == 0) return BINDING_UNKNOWN;
terencez 0:1fa43ab66921 324
terencez 0:1fa43ab66921 325 switch (buffer[0])
terencez 0:1fa43ab66921 326 {
terencez 0:1fa43ab66921 327 case 'U':
terencez 0:1fa43ab66921 328 switch (length)
terencez 0:1fa43ab66921 329 {
terencez 0:1fa43ab66921 330 case 1:
terencez 0:1fa43ab66921 331 return BINDING_U;
terencez 0:1fa43ab66921 332 case 2:
terencez 0:1fa43ab66921 333 switch (buffer[1])
terencez 0:1fa43ab66921 334 {
terencez 0:1fa43ab66921 335 case 'Q':
terencez 0:1fa43ab66921 336 return BINDING_UQ;
terencez 0:1fa43ab66921 337 case 'S':
terencez 0:1fa43ab66921 338 return BINDING_US;
terencez 0:1fa43ab66921 339 default:
terencez 0:1fa43ab66921 340 break;
terencez 0:1fa43ab66921 341 }
terencez 0:1fa43ab66921 342 break;
terencez 0:1fa43ab66921 343 case 3:
terencez 0:1fa43ab66921 344 if (buffer[1] == 'Q' && buffer[2] == 'S')
terencez 0:1fa43ab66921 345 {
terencez 0:1fa43ab66921 346 return BINDING_UQS;
terencez 0:1fa43ab66921 347 }
terencez 0:1fa43ab66921 348 break;
terencez 0:1fa43ab66921 349 default:
terencez 0:1fa43ab66921 350 break;
terencez 0:1fa43ab66921 351 }
terencez 0:1fa43ab66921 352 break;
terencez 0:1fa43ab66921 353
terencez 0:1fa43ab66921 354 case 'S':
terencez 0:1fa43ab66921 355 switch (length)
terencez 0:1fa43ab66921 356 {
terencez 0:1fa43ab66921 357 case 1:
terencez 0:1fa43ab66921 358 return BINDING_S;
terencez 0:1fa43ab66921 359 case 2:
terencez 0:1fa43ab66921 360 if (buffer[1] == 'Q')
terencez 0:1fa43ab66921 361 {
terencez 0:1fa43ab66921 362 return BINDING_SQ;
terencez 0:1fa43ab66921 363 }
terencez 0:1fa43ab66921 364 break;
terencez 0:1fa43ab66921 365 default:
terencez 0:1fa43ab66921 366 break;
terencez 0:1fa43ab66921 367 }
terencez 0:1fa43ab66921 368 break;
terencez 0:1fa43ab66921 369
terencez 0:1fa43ab66921 370 default:
terencez 0:1fa43ab66921 371 break;
terencez 0:1fa43ab66921 372 }
terencez 0:1fa43ab66921 373
terencez 0:1fa43ab66921 374 return BINDING_UNKNOWN;
terencez 0:1fa43ab66921 375 }
terencez 0:1fa43ab66921 376
terencez 0:1fa43ab66921 377 lwm2m_media_type_t utils_convertMediaType(coap_content_type_t type)
terencez 0:1fa43ab66921 378 {
terencez 0:1fa43ab66921 379 // Here we just check the content type is a valid value for LWM2M
terencez 0:1fa43ab66921 380 switch((uint16_t)type)
terencez 0:1fa43ab66921 381 {
terencez 0:1fa43ab66921 382 case TEXT_PLAIN:
terencez 0:1fa43ab66921 383 return LWM2M_CONTENT_TEXT;
terencez 0:1fa43ab66921 384 case APPLICATION_OCTET_STREAM:
terencez 0:1fa43ab66921 385 return LWM2M_CONTENT_OPAQUE;
terencez 0:1fa43ab66921 386 case LWM2M_CONTENT_TLV_OLD:
terencez 0:1fa43ab66921 387 return LWM2M_CONTENT_TLV_OLD;
terencez 0:1fa43ab66921 388 case LWM2M_CONTENT_TLV:
terencez 0:1fa43ab66921 389 return LWM2M_CONTENT_TLV;
terencez 0:1fa43ab66921 390 case LWM2M_CONTENT_JSON_OLD:
terencez 0:1fa43ab66921 391 return LWM2M_CONTENT_JSON_OLD;
terencez 0:1fa43ab66921 392 case LWM2M_CONTENT_JSON:
terencez 0:1fa43ab66921 393 return LWM2M_CONTENT_JSON;
terencez 0:1fa43ab66921 394 case APPLICATION_LINK_FORMAT:
terencez 0:1fa43ab66921 395 return LWM2M_CONTENT_LINK;
terencez 0:1fa43ab66921 396
terencez 0:1fa43ab66921 397 default:
terencez 0:1fa43ab66921 398 return LWM2M_CONTENT_TEXT;
terencez 0:1fa43ab66921 399 }
terencez 0:1fa43ab66921 400 }
terencez 0:1fa43ab66921 401
terencez 0:1fa43ab66921 402 #ifdef LWM2M_CLIENT_MODE
terencez 0:1fa43ab66921 403 lwm2m_server_t * utils_findServer(lwm2m_context_t * contextP,
terencez 0:1fa43ab66921 404 void * fromSessionH)
terencez 0:1fa43ab66921 405 {
terencez 0:1fa43ab66921 406 lwm2m_server_t * targetP;
terencez 0:1fa43ab66921 407
terencez 0:1fa43ab66921 408 targetP = contextP->serverList;
terencez 0:1fa43ab66921 409 while (targetP != NULL
terencez 0:1fa43ab66921 410 && false == lwm2m_session_is_equal(targetP->sessionH, fromSessionH, contextP->userData))
terencez 0:1fa43ab66921 411 {
terencez 0:1fa43ab66921 412 targetP = targetP->next;
terencez 0:1fa43ab66921 413 }
terencez 0:1fa43ab66921 414
terencez 0:1fa43ab66921 415 return targetP;
terencez 0:1fa43ab66921 416 }
terencez 0:1fa43ab66921 417 #endif
terencez 0:1fa43ab66921 418
terencez 0:1fa43ab66921 419 lwm2m_server_t * utils_findBootstrapServer(lwm2m_context_t * contextP,
terencez 0:1fa43ab66921 420 void * fromSessionH)
terencez 0:1fa43ab66921 421 {
terencez 0:1fa43ab66921 422 #ifdef LWM2M_CLIENT_MODE
terencez 0:1fa43ab66921 423
terencez 0:1fa43ab66921 424 lwm2m_server_t * targetP;
terencez 0:1fa43ab66921 425
terencez 0:1fa43ab66921 426 targetP = contextP->bootstrapServerList;
terencez 0:1fa43ab66921 427 while (targetP != NULL
terencez 0:1fa43ab66921 428 && false == lwm2m_session_is_equal(targetP->sessionH, fromSessionH, contextP->userData))
terencez 0:1fa43ab66921 429 {
terencez 0:1fa43ab66921 430 targetP = targetP->next;
terencez 0:1fa43ab66921 431 }
terencez 0:1fa43ab66921 432
terencez 0:1fa43ab66921 433 return targetP;
terencez 0:1fa43ab66921 434
terencez 0:1fa43ab66921 435 #else
terencez 0:1fa43ab66921 436
terencez 0:1fa43ab66921 437 return NULL;
terencez 0:1fa43ab66921 438
terencez 0:1fa43ab66921 439 #endif
terencez 0:1fa43ab66921 440 }
terencez 0:1fa43ab66921 441
terencez 0:1fa43ab66921 442 int utils_isAltPathValid(const char * altPath)
terencez 0:1fa43ab66921 443 {
terencez 0:1fa43ab66921 444 int i;
terencez 0:1fa43ab66921 445
terencez 0:1fa43ab66921 446 if (altPath == NULL) return 0;
terencez 0:1fa43ab66921 447
terencez 0:1fa43ab66921 448 if (altPath[0] != '/') return 0;
terencez 0:1fa43ab66921 449
terencez 0:1fa43ab66921 450 for (i = 1 ; altPath[i] != 0 ; i++)
terencez 0:1fa43ab66921 451 {
terencez 0:1fa43ab66921 452 // TODO: Support multi-segment alternative path
terencez 0:1fa43ab66921 453 if (altPath[i] == '/') return 0;
terencez 0:1fa43ab66921 454 // TODO: Check needs for sub-delims, ':' and '@'
terencez 0:1fa43ab66921 455 if ((altPath[i] < 'A' || altPath[i] > 'Z') // ALPHA
terencez 0:1fa43ab66921 456 && (altPath[i] < 'a' || altPath[i] > 'z')
terencez 0:1fa43ab66921 457 && (altPath[i] < '0' || altPath[i] > '9') // DIGIT
terencez 0:1fa43ab66921 458 && (altPath[i] != '-') // Other unreserved
terencez 0:1fa43ab66921 459 && (altPath[i] != '.')
terencez 0:1fa43ab66921 460 && (altPath[i] != '_')
terencez 0:1fa43ab66921 461 && (altPath[i] != '~')
terencez 0:1fa43ab66921 462 && (altPath[i] != '%')) // pct_encoded
terencez 0:1fa43ab66921 463 {
terencez 0:1fa43ab66921 464 return 0;
terencez 0:1fa43ab66921 465 }
terencez 0:1fa43ab66921 466
terencez 0:1fa43ab66921 467 }
terencez 0:1fa43ab66921 468 return 1;
terencez 0:1fa43ab66921 469 }
terencez 0:1fa43ab66921 470
terencez 0:1fa43ab66921 471 // copy a string in a buffer.
terencez 0:1fa43ab66921 472 // return the number of copied bytes or -1 if the buffer is not large enough
terencez 0:1fa43ab66921 473 int utils_stringCopy(char * buffer,
terencez 0:1fa43ab66921 474 size_t length,
terencez 0:1fa43ab66921 475 const char * str)
terencez 0:1fa43ab66921 476 {
terencez 0:1fa43ab66921 477 size_t i;
terencez 0:1fa43ab66921 478
terencez 0:1fa43ab66921 479 for (i = 0 ; i < length && str[i] != 0 ; i++)
terencez 0:1fa43ab66921 480 {
terencez 0:1fa43ab66921 481 buffer[i] = str[i];
terencez 0:1fa43ab66921 482 }
terencez 0:1fa43ab66921 483
terencez 0:1fa43ab66921 484 if (i == length) return -1;
terencez 0:1fa43ab66921 485
terencez 0:1fa43ab66921 486 buffer[i] = 0;
terencez 0:1fa43ab66921 487
terencez 0:1fa43ab66921 488 return (int)i;
terencez 0:1fa43ab66921 489 }
terencez 0:1fa43ab66921 490
terencez 0:1fa43ab66921 491 int utils_intCopy(char * buffer,
terencez 0:1fa43ab66921 492 size_t length,
terencez 0:1fa43ab66921 493 int32_t value)
terencez 0:1fa43ab66921 494 {
terencez 0:1fa43ab66921 495 #define _PRV_INT32_MAX_STR_LEN 11
terencez 0:1fa43ab66921 496 uint8_t str[_PRV_INT32_MAX_STR_LEN];
terencez 0:1fa43ab66921 497 size_t len;
terencez 0:1fa43ab66921 498
terencez 0:1fa43ab66921 499 len = utils_intToText(value, str, _PRV_INT32_MAX_STR_LEN);
terencez 0:1fa43ab66921 500 if (len == 0) return -1;
terencez 0:1fa43ab66921 501 if (len > length + 1) return -1;
terencez 0:1fa43ab66921 502
terencez 0:1fa43ab66921 503 memcpy(buffer, str, len);
terencez 0:1fa43ab66921 504 buffer[len] = 0;
terencez 0:1fa43ab66921 505
terencez 0:1fa43ab66921 506 return len;
terencez 0:1fa43ab66921 507 }
terencez 0:1fa43ab66921 508
terencez 0:1fa43ab66921 509 void utils_copyValue(void * dst,
terencez 0:1fa43ab66921 510 const void * src,
terencez 0:1fa43ab66921 511 size_t len)
terencez 0:1fa43ab66921 512 {
terencez 0:1fa43ab66921 513 #ifdef LWM2M_BIG_ENDIAN
terencez 0:1fa43ab66921 514 memcpy(dst, src, len);
terencez 0:1fa43ab66921 515 #else
terencez 0:1fa43ab66921 516 #ifdef LWM2M_LITTLE_ENDIAN
terencez 0:1fa43ab66921 517 size_t i;
terencez 0:1fa43ab66921 518
terencez 0:1fa43ab66921 519 for (i = 0; i < len; i++)
terencez 0:1fa43ab66921 520 {
terencez 0:1fa43ab66921 521 ((uint8_t *)dst)[i] = ((uint8_t *)src)[len - 1 - i];
terencez 0:1fa43ab66921 522 }
terencez 0:1fa43ab66921 523 #endif
terencez 0:1fa43ab66921 524 #endif
terencez 0:1fa43ab66921 525 }
terencez 0:1fa43ab66921 526
terencez 0:1fa43ab66921 527 int utils_opaqueToInt(const uint8_t * buffer,
terencez 0:1fa43ab66921 528 size_t buffer_len,
terencez 0:1fa43ab66921 529 int64_t * dataP)
terencez 0:1fa43ab66921 530 {
terencez 0:1fa43ab66921 531 *dataP = 0;
terencez 0:1fa43ab66921 532
terencez 0:1fa43ab66921 533 switch (buffer_len)
terencez 0:1fa43ab66921 534 {
terencez 0:1fa43ab66921 535 case 1:
terencez 0:1fa43ab66921 536 {
terencez 0:1fa43ab66921 537 *dataP = (int8_t)buffer[0];
terencez 0:1fa43ab66921 538
terencez 0:1fa43ab66921 539 break;
terencez 0:1fa43ab66921 540 }
terencez 0:1fa43ab66921 541
terencez 0:1fa43ab66921 542 case 2:
terencez 0:1fa43ab66921 543 {
terencez 0:1fa43ab66921 544 int16_t value;
terencez 0:1fa43ab66921 545
terencez 0:1fa43ab66921 546 utils_copyValue(&value, buffer, buffer_len);
terencez 0:1fa43ab66921 547
terencez 0:1fa43ab66921 548 *dataP = value;
terencez 0:1fa43ab66921 549 break;
terencez 0:1fa43ab66921 550 }
terencez 0:1fa43ab66921 551
terencez 0:1fa43ab66921 552 case 4:
terencez 0:1fa43ab66921 553 {
terencez 0:1fa43ab66921 554 int32_t value;
terencez 0:1fa43ab66921 555
terencez 0:1fa43ab66921 556 utils_copyValue(&value, buffer, buffer_len);
terencez 0:1fa43ab66921 557
terencez 0:1fa43ab66921 558 *dataP = value;
terencez 0:1fa43ab66921 559 break;
terencez 0:1fa43ab66921 560 }
terencez 0:1fa43ab66921 561
terencez 0:1fa43ab66921 562 case 8:
terencez 0:1fa43ab66921 563 utils_copyValue(dataP, buffer, buffer_len);
terencez 0:1fa43ab66921 564 return buffer_len;
terencez 0:1fa43ab66921 565
terencez 0:1fa43ab66921 566 default:
terencez 0:1fa43ab66921 567 return 0;
terencez 0:1fa43ab66921 568 }
terencez 0:1fa43ab66921 569
terencez 0:1fa43ab66921 570 return buffer_len;
terencez 0:1fa43ab66921 571 }
terencez 0:1fa43ab66921 572
terencez 0:1fa43ab66921 573 int utils_opaqueToFloat(const uint8_t * buffer,
terencez 0:1fa43ab66921 574 size_t buffer_len,
terencez 0:1fa43ab66921 575 double * dataP)
terencez 0:1fa43ab66921 576 {
terencez 0:1fa43ab66921 577 switch (buffer_len)
terencez 0:1fa43ab66921 578 {
terencez 0:1fa43ab66921 579 case 4:
terencez 0:1fa43ab66921 580 {
terencez 0:1fa43ab66921 581 float temp;
terencez 0:1fa43ab66921 582
terencez 0:1fa43ab66921 583 utils_copyValue(&temp, buffer, buffer_len);
terencez 0:1fa43ab66921 584
terencez 0:1fa43ab66921 585 *dataP = temp;
terencez 0:1fa43ab66921 586 }
terencez 0:1fa43ab66921 587 return 4;
terencez 0:1fa43ab66921 588
terencez 0:1fa43ab66921 589 case 8:
terencez 0:1fa43ab66921 590 utils_copyValue(dataP, buffer, buffer_len);
terencez 0:1fa43ab66921 591 return 8;
terencez 0:1fa43ab66921 592
terencez 0:1fa43ab66921 593 default:
terencez 0:1fa43ab66921 594 return 0;
terencez 0:1fa43ab66921 595 }
terencez 0:1fa43ab66921 596 }
terencez 0:1fa43ab66921 597
terencez 0:1fa43ab66921 598 /**
terencez 0:1fa43ab66921 599 * Encode an integer value to a byte representation.
terencez 0:1fa43ab66921 600 * Returns the length of the result. For values < 0xff length is 1,
terencez 0:1fa43ab66921 601 * for values < 0xffff length is 2 and so on.
terencez 0:1fa43ab66921 602 * @param data Input value
terencez 0:1fa43ab66921 603 * @param data_buffer Result in data_buffer is in big endian encoding
terencez 0:1fa43ab66921 604 * Negative values are represented in two's complement as of
terencez 0:1fa43ab66921 605 * OMA-TS-LightweightM2M-V1_0-20160308-D, Appendix C
terencez 0:1fa43ab66921 606 */
terencez 0:1fa43ab66921 607 size_t utils_encodeInt(int64_t data,
terencez 0:1fa43ab66921 608 uint8_t data_buffer[_PRV_64BIT_BUFFER_SIZE])
terencez 0:1fa43ab66921 609 {
terencez 0:1fa43ab66921 610 size_t length = 0;
terencez 0:1fa43ab66921 611
terencez 0:1fa43ab66921 612 memset(data_buffer, 0, _PRV_64BIT_BUFFER_SIZE);
terencez 0:1fa43ab66921 613
terencez 0:1fa43ab66921 614 if (data >= INT8_MIN && data <= INT8_MAX)
terencez 0:1fa43ab66921 615 {
terencez 0:1fa43ab66921 616 length = 1;
terencez 0:1fa43ab66921 617 data_buffer[0] = data;
terencez 0:1fa43ab66921 618 }
terencez 0:1fa43ab66921 619 else if (data >= INT16_MIN && data <= INT16_MAX)
terencez 0:1fa43ab66921 620 {
terencez 0:1fa43ab66921 621 int16_t value;
terencez 0:1fa43ab66921 622
terencez 0:1fa43ab66921 623 value = data;
terencez 0:1fa43ab66921 624 length = 2;
terencez 0:1fa43ab66921 625 data_buffer[0] = (value >> 8) & 0xFF;
terencez 0:1fa43ab66921 626 data_buffer[1] = value & 0xFF;
terencez 0:1fa43ab66921 627 }
terencez 0:1fa43ab66921 628 else if (data >= INT32_MIN && data <= INT32_MAX)
terencez 0:1fa43ab66921 629 {
terencez 0:1fa43ab66921 630 int32_t value;
terencez 0:1fa43ab66921 631
terencez 0:1fa43ab66921 632 value = data;
terencez 0:1fa43ab66921 633 length = 4;
terencez 0:1fa43ab66921 634 utils_copyValue(data_buffer, &value, length);
terencez 0:1fa43ab66921 635 }
terencez 0:1fa43ab66921 636 else if (data >= INT64_MIN && data <= INT64_MAX)
terencez 0:1fa43ab66921 637 {
terencez 0:1fa43ab66921 638 length = 8;
terencez 0:1fa43ab66921 639 utils_copyValue(data_buffer, &data, length);
terencez 0:1fa43ab66921 640 }
terencez 0:1fa43ab66921 641
terencez 0:1fa43ab66921 642 return length;
terencez 0:1fa43ab66921 643 }
terencez 0:1fa43ab66921 644
terencez 0:1fa43ab66921 645 size_t utils_encodeFloat(double data,
terencez 0:1fa43ab66921 646 uint8_t data_buffer[_PRV_64BIT_BUFFER_SIZE])
terencez 0:1fa43ab66921 647 {
terencez 0:1fa43ab66921 648 size_t length = 0;
terencez 0:1fa43ab66921 649
terencez 0:1fa43ab66921 650 memset(data_buffer, 0, _PRV_64BIT_BUFFER_SIZE);
terencez 0:1fa43ab66921 651
terencez 0:1fa43ab66921 652 if ((data < 0.0 - (double)FLT_MAX) || (data >(double)FLT_MAX))
terencez 0:1fa43ab66921 653 {
terencez 0:1fa43ab66921 654 length = 8;
terencez 0:1fa43ab66921 655 utils_copyValue(data_buffer, &data, 8);
terencez 0:1fa43ab66921 656 }
terencez 0:1fa43ab66921 657 else
terencez 0:1fa43ab66921 658 {
terencez 0:1fa43ab66921 659 float value;
terencez 0:1fa43ab66921 660
terencez 0:1fa43ab66921 661 length = 4;
terencez 0:1fa43ab66921 662 value = (float)data;
terencez 0:1fa43ab66921 663 utils_copyValue(data_buffer, &value, 4);
terencez 0:1fa43ab66921 664 }
terencez 0:1fa43ab66921 665
terencez 0:1fa43ab66921 666 return length;
terencez 0:1fa43ab66921 667 }
terencez 0:1fa43ab66921 668
terencez 0:1fa43ab66921 669 #define PRV_B64_PADDING '='
terencez 0:1fa43ab66921 670
terencez 0:1fa43ab66921 671 static char b64Alphabet[64] =
terencez 0:1fa43ab66921 672 {
terencez 0:1fa43ab66921 673 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', 'K', 'L', 'M', 'N', 'O', 'P',
terencez 0:1fa43ab66921 674 'Q', 'R', 'S', 'T', 'U', 'V', 'W', 'X', 'Y', 'Z', 'a', 'b', 'c', 'd', 'e', 'f',
terencez 0:1fa43ab66921 675 'g', 'h', 'i', 'j', 'k', 'l', 'm', 'n', 'o', 'p', 'q', 'r', 's', 't', 'u', 'v',
terencez 0:1fa43ab66921 676 'w', 'x', 'y', 'z', '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '+', '/'
terencez 0:1fa43ab66921 677 };
terencez 0:1fa43ab66921 678
terencez 0:1fa43ab66921 679 static void prv_encodeBlock(uint8_t input[3],
terencez 0:1fa43ab66921 680 uint8_t output[4])
terencez 0:1fa43ab66921 681 {
terencez 0:1fa43ab66921 682 output[0] = b64Alphabet[input[0] >> 2];
terencez 0:1fa43ab66921 683 output[1] = b64Alphabet[((input[0] & 0x03) << 4) | (input[1] >> 4)];
terencez 0:1fa43ab66921 684 output[2] = b64Alphabet[((input[1] & 0x0F) << 2) | (input[2] >> 6)];
terencez 0:1fa43ab66921 685 output[3] = b64Alphabet[input[2] & 0x3F];
terencez 0:1fa43ab66921 686 }
terencez 0:1fa43ab66921 687
terencez 0:1fa43ab66921 688 static uint8_t prv_b64Revert(uint8_t value)
terencez 0:1fa43ab66921 689 {
terencez 0:1fa43ab66921 690 if (value >= 'A' && value <= 'Z')
terencez 0:1fa43ab66921 691 {
terencez 0:1fa43ab66921 692 return (value - 'A');
terencez 0:1fa43ab66921 693 }
terencez 0:1fa43ab66921 694 if (value >= 'a' && value <= 'z')
terencez 0:1fa43ab66921 695 {
terencez 0:1fa43ab66921 696 return (26 + value - 'a');
terencez 0:1fa43ab66921 697 }
terencez 0:1fa43ab66921 698 if (value >= '0' && value <= '9')
terencez 0:1fa43ab66921 699 {
terencez 0:1fa43ab66921 700 return (52 + value - '0');
terencez 0:1fa43ab66921 701 }
terencez 0:1fa43ab66921 702 switch (value)
terencez 0:1fa43ab66921 703 {
terencez 0:1fa43ab66921 704 case '+':
terencez 0:1fa43ab66921 705 return 62;
terencez 0:1fa43ab66921 706 case '/':
terencez 0:1fa43ab66921 707 return 63;
terencez 0:1fa43ab66921 708 default:
terencez 0:1fa43ab66921 709 return 0;
terencez 0:1fa43ab66921 710 }
terencez 0:1fa43ab66921 711 }
terencez 0:1fa43ab66921 712
terencez 0:1fa43ab66921 713 static void prv_decodeBlock(uint8_t input[4],
terencez 0:1fa43ab66921 714 uint8_t output[3])
terencez 0:1fa43ab66921 715 {
terencez 0:1fa43ab66921 716 uint8_t tmp[4];
terencez 0:1fa43ab66921 717 int i;
terencez 0:1fa43ab66921 718
terencez 0:1fa43ab66921 719 memset(output, 0, 3);
terencez 0:1fa43ab66921 720
terencez 0:1fa43ab66921 721 for (i = 0; i < 4; i++)
terencez 0:1fa43ab66921 722 {
terencez 0:1fa43ab66921 723 tmp[i] = prv_b64Revert(input[i]);
terencez 0:1fa43ab66921 724 }
terencez 0:1fa43ab66921 725
terencez 0:1fa43ab66921 726 output[0] = (tmp[0] << 2) | (tmp[1] >> 4);
terencez 0:1fa43ab66921 727 output[1] = (tmp[1] << 4) | (tmp[2] >> 2);
terencez 0:1fa43ab66921 728 output[2] = (tmp[2] << 6) | tmp[3];
terencez 0:1fa43ab66921 729 }
terencez 0:1fa43ab66921 730
terencez 0:1fa43ab66921 731 static size_t prv_getBase64Size(size_t dataLen)
terencez 0:1fa43ab66921 732 {
terencez 0:1fa43ab66921 733 size_t result_len;
terencez 0:1fa43ab66921 734
terencez 0:1fa43ab66921 735 result_len = 4 * (dataLen / 3);
terencez 0:1fa43ab66921 736 if (dataLen % 3) result_len += 4;
terencez 0:1fa43ab66921 737
terencez 0:1fa43ab66921 738 return result_len;
terencez 0:1fa43ab66921 739 }
terencez 0:1fa43ab66921 740
terencez 0:1fa43ab66921 741 size_t utils_base64Encode(uint8_t * dataP,
terencez 0:1fa43ab66921 742 size_t dataLen,
terencez 0:1fa43ab66921 743 uint8_t * bufferP,
terencez 0:1fa43ab66921 744 size_t bufferLen)
terencez 0:1fa43ab66921 745 {
terencez 0:1fa43ab66921 746 unsigned int data_index;
terencez 0:1fa43ab66921 747 unsigned int result_index;
terencez 0:1fa43ab66921 748 size_t result_len;
terencez 0:1fa43ab66921 749
terencez 0:1fa43ab66921 750 result_len = prv_getBase64Size(dataLen);
terencez 0:1fa43ab66921 751
terencez 0:1fa43ab66921 752 if (result_len > bufferLen) return 0;
terencez 0:1fa43ab66921 753
terencez 0:1fa43ab66921 754 data_index = 0;
terencez 0:1fa43ab66921 755 result_index = 0;
terencez 0:1fa43ab66921 756 while (data_index < dataLen)
terencez 0:1fa43ab66921 757 {
terencez 0:1fa43ab66921 758 switch (dataLen - data_index)
terencez 0:1fa43ab66921 759 {
terencez 0:1fa43ab66921 760 case 0:
terencez 0:1fa43ab66921 761 // should never happen
terencez 0:1fa43ab66921 762 break;
terencez 0:1fa43ab66921 763 case 1:
terencez 0:1fa43ab66921 764 bufferP[result_index] = b64Alphabet[dataP[data_index] >> 2];
terencez 0:1fa43ab66921 765 bufferP[result_index + 1] = b64Alphabet[(dataP[data_index] & 0x03) << 4];
terencez 0:1fa43ab66921 766 bufferP[result_index + 2] = PRV_B64_PADDING;
terencez 0:1fa43ab66921 767 bufferP[result_index + 3] = PRV_B64_PADDING;
terencez 0:1fa43ab66921 768 break;
terencez 0:1fa43ab66921 769 case 2:
terencez 0:1fa43ab66921 770 bufferP[result_index] = b64Alphabet[dataP[data_index] >> 2];
terencez 0:1fa43ab66921 771 bufferP[result_index + 1] = b64Alphabet[(dataP[data_index] & 0x03) << 4 | (dataP[data_index + 1] >> 4)];
terencez 0:1fa43ab66921 772 bufferP[result_index + 2] = b64Alphabet[(dataP[data_index + 1] & 0x0F) << 2];
terencez 0:1fa43ab66921 773 bufferP[result_index + 3] = PRV_B64_PADDING;
terencez 0:1fa43ab66921 774 break;
terencez 0:1fa43ab66921 775 default:
terencez 0:1fa43ab66921 776 prv_encodeBlock(dataP + data_index, bufferP + result_index);
terencez 0:1fa43ab66921 777 break;
terencez 0:1fa43ab66921 778 }
terencez 0:1fa43ab66921 779 data_index += 3;
terencez 0:1fa43ab66921 780 result_index += 4;
terencez 0:1fa43ab66921 781 }
terencez 0:1fa43ab66921 782
terencez 0:1fa43ab66921 783 return result_len;
terencez 0:1fa43ab66921 784 }
terencez 0:1fa43ab66921 785
terencez 0:1fa43ab66921 786 size_t utils_opaqueToBase64(uint8_t * dataP,
terencez 0:1fa43ab66921 787 size_t dataLen,
terencez 0:1fa43ab66921 788 uint8_t ** bufferP)
terencez 0:1fa43ab66921 789 {
terencez 0:1fa43ab66921 790 size_t buffer_len;
terencez 0:1fa43ab66921 791 size_t result_len;
terencez 0:1fa43ab66921 792
terencez 0:1fa43ab66921 793 buffer_len = prv_getBase64Size(dataLen);
terencez 0:1fa43ab66921 794
terencez 0:1fa43ab66921 795 *bufferP = (uint8_t *)lwm2m_malloc(buffer_len);
terencez 0:1fa43ab66921 796 if (!*bufferP) return 0;
terencez 0:1fa43ab66921 797 memset(*bufferP, 0, buffer_len);
terencez 0:1fa43ab66921 798
terencez 0:1fa43ab66921 799 result_len = utils_base64Encode(dataP, dataLen, *bufferP, buffer_len);
terencez 0:1fa43ab66921 800
terencez 0:1fa43ab66921 801 if (result_len == 0)
terencez 0:1fa43ab66921 802 {
terencez 0:1fa43ab66921 803 lwm2m_free(*bufferP);
terencez 0:1fa43ab66921 804 *bufferP = NULL;
terencez 0:1fa43ab66921 805 }
terencez 0:1fa43ab66921 806
terencez 0:1fa43ab66921 807 return result_len;
terencez 0:1fa43ab66921 808 }
terencez 0:1fa43ab66921 809
terencez 0:1fa43ab66921 810 size_t utils_base64ToOpaque(uint8_t * dataP,
terencez 0:1fa43ab66921 811 size_t dataLen,
terencez 0:1fa43ab66921 812 uint8_t ** bufferP)
terencez 0:1fa43ab66921 813 {
terencez 0:1fa43ab66921 814 size_t data_index;
terencez 0:1fa43ab66921 815 size_t result_index;
terencez 0:1fa43ab66921 816 size_t result_len;
terencez 0:1fa43ab66921 817
terencez 0:1fa43ab66921 818 if (dataLen % 4) return 0;
terencez 0:1fa43ab66921 819
terencez 0:1fa43ab66921 820 result_len = (dataLen >> 2) * 3;
terencez 0:1fa43ab66921 821 *bufferP = (uint8_t *)lwm2m_malloc(result_len);
terencez 0:1fa43ab66921 822 if (NULL == *bufferP) return 0;
terencez 0:1fa43ab66921 823 memset(*bufferP, 0, result_len);
terencez 0:1fa43ab66921 824
terencez 0:1fa43ab66921 825 // remove padding
terencez 0:1fa43ab66921 826 while (dataP[dataLen - 1] == PRV_B64_PADDING)
terencez 0:1fa43ab66921 827 {
terencez 0:1fa43ab66921 828 dataLen--;
terencez 0:1fa43ab66921 829 }
terencez 0:1fa43ab66921 830
terencez 0:1fa43ab66921 831 data_index = 0;
terencez 0:1fa43ab66921 832 result_index = 0;
terencez 0:1fa43ab66921 833 while (data_index < dataLen)
terencez 0:1fa43ab66921 834 {
terencez 0:1fa43ab66921 835 prv_decodeBlock(dataP + data_index, *bufferP + result_index);
terencez 0:1fa43ab66921 836 data_index += 4;
terencez 0:1fa43ab66921 837 result_index += 3;
terencez 0:1fa43ab66921 838 }
terencez 0:1fa43ab66921 839 switch (data_index - dataLen)
terencez 0:1fa43ab66921 840 {
terencez 0:1fa43ab66921 841 case 0:
terencez 0:1fa43ab66921 842 break;
terencez 0:1fa43ab66921 843 case 2:
terencez 0:1fa43ab66921 844 {
terencez 0:1fa43ab66921 845 uint8_t tmp[2];
terencez 0:1fa43ab66921 846
terencez 0:1fa43ab66921 847 tmp[0] = prv_b64Revert(dataP[dataLen - 2]);
terencez 0:1fa43ab66921 848 tmp[1] = prv_b64Revert(dataP[dataLen - 1]);
terencez 0:1fa43ab66921 849
terencez 0:1fa43ab66921 850 *bufferP[result_index - 3] = (tmp[0] << 2) | (tmp[1] >> 4);
terencez 0:1fa43ab66921 851 *bufferP[result_index - 2] = (tmp[1] << 4);
terencez 0:1fa43ab66921 852 result_len -= 2;
terencez 0:1fa43ab66921 853 }
terencez 0:1fa43ab66921 854 break;
terencez 0:1fa43ab66921 855 case 3:
terencez 0:1fa43ab66921 856 {
terencez 0:1fa43ab66921 857 uint8_t tmp[3];
terencez 0:1fa43ab66921 858
terencez 0:1fa43ab66921 859 tmp[0] = prv_b64Revert(dataP[dataLen - 3]);
terencez 0:1fa43ab66921 860 tmp[1] = prv_b64Revert(dataP[dataLen - 2]);
terencez 0:1fa43ab66921 861 tmp[2] = prv_b64Revert(dataP[dataLen - 1]);
terencez 0:1fa43ab66921 862
terencez 0:1fa43ab66921 863 *bufferP[result_index - 3] = (tmp[0] << 2) | (tmp[1] >> 4);
terencez 0:1fa43ab66921 864 *bufferP[result_index - 2] = (tmp[1] << 4) | (tmp[2] >> 2);
terencez 0:1fa43ab66921 865 *bufferP[result_index - 1] = (tmp[2] << 6);
terencez 0:1fa43ab66921 866 result_len -= 1;
terencez 0:1fa43ab66921 867 }
terencez 0:1fa43ab66921 868 break;
terencez 0:1fa43ab66921 869 default:
terencez 0:1fa43ab66921 870 // error
terencez 0:1fa43ab66921 871 lwm2m_free(*bufferP);
terencez 0:1fa43ab66921 872 *bufferP = NULL;
terencez 0:1fa43ab66921 873 result_len = 0;
terencez 0:1fa43ab66921 874 break;
terencez 0:1fa43ab66921 875 }
terencez 0:1fa43ab66921 876
terencez 0:1fa43ab66921 877 return result_len;
terencez 0:1fa43ab66921 878 }
terencez 0:1fa43ab66921 879
terencez 0:1fa43ab66921 880 lwm2m_data_type_t utils_depthToDatatype(uri_depth_t depth)
terencez 0:1fa43ab66921 881 {
terencez 0:1fa43ab66921 882 switch (depth)
terencez 0:1fa43ab66921 883 {
terencez 0:1fa43ab66921 884 case URI_DEPTH_OBJECT:
terencez 0:1fa43ab66921 885 return LWM2M_TYPE_OBJECT;
terencez 0:1fa43ab66921 886 case URI_DEPTH_OBJECT_INSTANCE:
terencez 0:1fa43ab66921 887 return LWM2M_TYPE_OBJECT_INSTANCE;
terencez 0:1fa43ab66921 888 default:
terencez 0:1fa43ab66921 889 break;
terencez 0:1fa43ab66921 890 }
terencez 0:1fa43ab66921 891
terencez 0:1fa43ab66921 892 return LWM2M_TYPE_UNDEFINED;
terencez 0:1fa43ab66921 893 }