FRDM K64F Metronome

Committer:
ram54288
Date:
Sun May 14 18:37:05 2017 +0000
Revision:
0:dbad57390bd1
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ram54288 0:dbad57390bd1 1 /*
ram54288 0:dbad57390bd1 2 * Copyright (c) 2015 ARM Limited. All rights reserved.
ram54288 0:dbad57390bd1 3 * SPDX-License-Identifier: Apache-2.0
ram54288 0:dbad57390bd1 4 * Licensed under the Apache License, Version 2.0 (the License); you may
ram54288 0:dbad57390bd1 5 * not use this file except in compliance with the License.
ram54288 0:dbad57390bd1 6 * You may obtain a copy of the License at
ram54288 0:dbad57390bd1 7 *
ram54288 0:dbad57390bd1 8 * http://www.apache.org/licenses/LICENSE-2.0
ram54288 0:dbad57390bd1 9 *
ram54288 0:dbad57390bd1 10 * Unless required by applicable law or agreed to in writing, software
ram54288 0:dbad57390bd1 11 * distributed under the License is distributed on an AS IS BASIS, WITHOUT
ram54288 0:dbad57390bd1 12 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
ram54288 0:dbad57390bd1 13 * See the License for the specific language governing permissions and
ram54288 0:dbad57390bd1 14 * limitations under the License.
ram54288 0:dbad57390bd1 15 */
ram54288 0:dbad57390bd1 16 #include "m2mstring.h"
ram54288 0:dbad57390bd1 17 #include <string.h> // strlen
ram54288 0:dbad57390bd1 18 #include <stdlib.h> // malloc, realloc
ram54288 0:dbad57390bd1 19 #include <assert.h>
ram54288 0:dbad57390bd1 20 #include <algorithm> // min
ram54288 0:dbad57390bd1 21
ram54288 0:dbad57390bd1 22 namespace m2m {
ram54288 0:dbad57390bd1 23
ram54288 0:dbad57390bd1 24 const String::size_type String::npos = static_cast<size_t>(-1);
ram54288 0:dbad57390bd1 25
ram54288 0:dbad57390bd1 26 char* String::strdup(const char* s)
ram54288 0:dbad57390bd1 27 {
ram54288 0:dbad57390bd1 28 const size_t len = strlen(s)+1;
ram54288 0:dbad57390bd1 29 char *p2 = static_cast<char*>(malloc(len));
ram54288 0:dbad57390bd1 30 memcpy(p2, s, len);
ram54288 0:dbad57390bd1 31 allocated_ = len;
ram54288 0:dbad57390bd1 32 size_ = len-1;
ram54288 0:dbad57390bd1 33 return p2;
ram54288 0:dbad57390bd1 34 }
ram54288 0:dbad57390bd1 35
ram54288 0:dbad57390bd1 36 String::String()
ram54288 0:dbad57390bd1 37 : p( strdup("") )
ram54288 0:dbad57390bd1 38 {
ram54288 0:dbad57390bd1 39 }
ram54288 0:dbad57390bd1 40
ram54288 0:dbad57390bd1 41 String::~String()
ram54288 0:dbad57390bd1 42 {
ram54288 0:dbad57390bd1 43 free(p);
ram54288 0:dbad57390bd1 44 p = 0;
ram54288 0:dbad57390bd1 45 }
ram54288 0:dbad57390bd1 46
ram54288 0:dbad57390bd1 47 String::String(const String& s)
ram54288 0:dbad57390bd1 48 : p(0)
ram54288 0:dbad57390bd1 49 {
ram54288 0:dbad57390bd1 50 if( &s != NULL ) {
ram54288 0:dbad57390bd1 51 p = static_cast<char*>(malloc(s.size_ + 1));
ram54288 0:dbad57390bd1 52
ram54288 0:dbad57390bd1 53 allocated_ = s.size_ + 1;
ram54288 0:dbad57390bd1 54 size_ = s.size_;
ram54288 0:dbad57390bd1 55 memcpy(p, s.p, size_ + 1);
ram54288 0:dbad57390bd1 56 }
ram54288 0:dbad57390bd1 57 }
ram54288 0:dbad57390bd1 58
ram54288 0:dbad57390bd1 59 String::String(const char* s)
ram54288 0:dbad57390bd1 60 : p(strdup(s))
ram54288 0:dbad57390bd1 61 {
ram54288 0:dbad57390bd1 62 }
ram54288 0:dbad57390bd1 63
ram54288 0:dbad57390bd1 64 String::String(const char* str, size_t n)
ram54288 0:dbad57390bd1 65 {
ram54288 0:dbad57390bd1 66 p = static_cast<char*>(malloc(n + 1));
ram54288 0:dbad57390bd1 67
ram54288 0:dbad57390bd1 68 allocated_ = n + 1;
ram54288 0:dbad57390bd1 69 size_ = n;
ram54288 0:dbad57390bd1 70 memcpy(p, str, n);
ram54288 0:dbad57390bd1 71 p[n] = 0;
ram54288 0:dbad57390bd1 72 }
ram54288 0:dbad57390bd1 73
ram54288 0:dbad57390bd1 74 String& String::operator=(const char* s)
ram54288 0:dbad57390bd1 75 {
ram54288 0:dbad57390bd1 76 if ( p != s ) {
ram54288 0:dbad57390bd1 77 // s could point into our own string, so we have to allocate a new string
ram54288 0:dbad57390bd1 78 const size_t len = strlen(s);
ram54288 0:dbad57390bd1 79 char* copy = (char*) malloc( len + 1);
ram54288 0:dbad57390bd1 80 memmove(copy, s, len+1); // trailing 0
ram54288 0:dbad57390bd1 81 free( p );
ram54288 0:dbad57390bd1 82 p = copy;
ram54288 0:dbad57390bd1 83 size_ = len;
ram54288 0:dbad57390bd1 84 allocated_ = len+1;
ram54288 0:dbad57390bd1 85 }
ram54288 0:dbad57390bd1 86 return *this;
ram54288 0:dbad57390bd1 87 }
ram54288 0:dbad57390bd1 88
ram54288 0:dbad57390bd1 89 String& String::operator=(const String& s)
ram54288 0:dbad57390bd1 90 {
ram54288 0:dbad57390bd1 91 return operator=(s.p);
ram54288 0:dbad57390bd1 92 }
ram54288 0:dbad57390bd1 93
ram54288 0:dbad57390bd1 94 String& String::operator+=(const String& s)
ram54288 0:dbad57390bd1 95 {
ram54288 0:dbad57390bd1 96 if (s.size_ > 0) {
ram54288 0:dbad57390bd1 97 this->reserve(size_ + s.size_);
ram54288 0:dbad57390bd1 98 memmove(p+size_, s.p, s.size_+1); // trailing 0
ram54288 0:dbad57390bd1 99 size_ += s.size_;
ram54288 0:dbad57390bd1 100 }
ram54288 0:dbad57390bd1 101 return *this;
ram54288 0:dbad57390bd1 102 }
ram54288 0:dbad57390bd1 103
ram54288 0:dbad57390bd1 104 // since p and s may overlap, we have to copy our own string first
ram54288 0:dbad57390bd1 105 String& String::operator+=(const char* s)
ram54288 0:dbad57390bd1 106 {
ram54288 0:dbad57390bd1 107 const size_type lens = strlen(s);
ram54288 0:dbad57390bd1 108 if (lens > 0) {
ram54288 0:dbad57390bd1 109 if (size_ + lens + 1 <= allocated_) {
ram54288 0:dbad57390bd1 110 memmove(p+size_, s, lens+1); // trailing 0
ram54288 0:dbad57390bd1 111 size_ += lens;
ram54288 0:dbad57390bd1 112 } else {
ram54288 0:dbad57390bd1 113 String s2( *this ); // copy own data
ram54288 0:dbad57390bd1 114 s2.reserve(size_ + lens);
ram54288 0:dbad57390bd1 115 memmove(s2.p+size_, s, lens+1); // trailing 0
ram54288 0:dbad57390bd1 116 s2.size_ = size_ + lens;
ram54288 0:dbad57390bd1 117 this->swap( s2 );
ram54288 0:dbad57390bd1 118 }
ram54288 0:dbad57390bd1 119 }
ram54288 0:dbad57390bd1 120 return *this;
ram54288 0:dbad57390bd1 121 }
ram54288 0:dbad57390bd1 122
ram54288 0:dbad57390bd1 123 String& String::operator+=(const char c)
ram54288 0:dbad57390bd1 124 {
ram54288 0:dbad57390bd1 125 push_back(c);
ram54288 0:dbad57390bd1 126 return *this;
ram54288 0:dbad57390bd1 127 }
ram54288 0:dbad57390bd1 128
ram54288 0:dbad57390bd1 129 void String::push_back(const char c) {
ram54288 0:dbad57390bd1 130
ram54288 0:dbad57390bd1 131 if (size_ == allocated_ - 1) {
ram54288 0:dbad57390bd1 132 size_t more = (allocated_* 3) / 2; // factor 1.5
ram54288 0:dbad57390bd1 133 if ( more < 4 ) more = 4;
ram54288 0:dbad57390bd1 134 reserve( size_ + more );
ram54288 0:dbad57390bd1 135 }
ram54288 0:dbad57390bd1 136
ram54288 0:dbad57390bd1 137 p[size_] = c;
ram54288 0:dbad57390bd1 138 size_++;
ram54288 0:dbad57390bd1 139 p[size_] = 0;
ram54288 0:dbad57390bd1 140 }
ram54288 0:dbad57390bd1 141
ram54288 0:dbad57390bd1 142 bool String::operator==(const char* s) const
ram54288 0:dbad57390bd1 143 {
ram54288 0:dbad57390bd1 144 if( s == NULL ) {
ram54288 0:dbad57390bd1 145 if( p == NULL ) {
ram54288 0:dbad57390bd1 146 return true;
ram54288 0:dbad57390bd1 147 }
ram54288 0:dbad57390bd1 148 return false;
ram54288 0:dbad57390bd1 149 }
ram54288 0:dbad57390bd1 150 bool ret = strcmp(p, s);
ram54288 0:dbad57390bd1 151 return !ret;
ram54288 0:dbad57390bd1 152 }
ram54288 0:dbad57390bd1 153
ram54288 0:dbad57390bd1 154 bool String::operator==(const String& s) const
ram54288 0:dbad57390bd1 155 {
ram54288 0:dbad57390bd1 156 bool ret = strcmp(p, s.p);
ram54288 0:dbad57390bd1 157 return !ret;
ram54288 0:dbad57390bd1 158 }
ram54288 0:dbad57390bd1 159
ram54288 0:dbad57390bd1 160 void String::clear()
ram54288 0:dbad57390bd1 161 {
ram54288 0:dbad57390bd1 162 size_ = 0;
ram54288 0:dbad57390bd1 163 p[0] = 0;
ram54288 0:dbad57390bd1 164 }
ram54288 0:dbad57390bd1 165
ram54288 0:dbad57390bd1 166 String String::substr(const size_type pos, size_type length) const
ram54288 0:dbad57390bd1 167 {
ram54288 0:dbad57390bd1 168 String s;
ram54288 0:dbad57390bd1 169 const size_type len = size_;
ram54288 0:dbad57390bd1 170
ram54288 0:dbad57390bd1 171 if ( pos <= len ) {
ram54288 0:dbad57390bd1 172
ram54288 0:dbad57390bd1 173 size_type remain = len - pos;
ram54288 0:dbad57390bd1 174
ram54288 0:dbad57390bd1 175 if ( length > remain )
ram54288 0:dbad57390bd1 176 length = remain;
ram54288 0:dbad57390bd1 177
ram54288 0:dbad57390bd1 178 s.reserve( length );
ram54288 0:dbad57390bd1 179
ram54288 0:dbad57390bd1 180 memcpy(s.p, p + pos, length);
ram54288 0:dbad57390bd1 181 s.p[length] = '\0';
ram54288 0:dbad57390bd1 182 s.size_ = length;
ram54288 0:dbad57390bd1 183 }
ram54288 0:dbad57390bd1 184 return s;
ram54288 0:dbad57390bd1 185 }
ram54288 0:dbad57390bd1 186
ram54288 0:dbad57390bd1 187
ram54288 0:dbad57390bd1 188 // checked access, accessing the NUL at end is allowed
ram54288 0:dbad57390bd1 189 char String::at(const size_type i) const
ram54288 0:dbad57390bd1 190 {
ram54288 0:dbad57390bd1 191 if ( i <= strlen(p) ) {
ram54288 0:dbad57390bd1 192 return p[i];
ram54288 0:dbad57390bd1 193 } else {
ram54288 0:dbad57390bd1 194 return '\0';
ram54288 0:dbad57390bd1 195 }
ram54288 0:dbad57390bd1 196 }
ram54288 0:dbad57390bd1 197
ram54288 0:dbad57390bd1 198 String& String::erase(size_type pos, size_type len)
ram54288 0:dbad57390bd1 199 {
ram54288 0:dbad57390bd1 200 if (len > 0) {
ram54288 0:dbad57390bd1 201
ram54288 0:dbad57390bd1 202 if ( pos < size_ ) { // user must not remove trailing 0
ram54288 0:dbad57390bd1 203
ram54288 0:dbad57390bd1 204 size_type s2 = size_;
ram54288 0:dbad57390bd1 205 size_type remain = s2 - pos - len;
ram54288 0:dbad57390bd1 206
ram54288 0:dbad57390bd1 207 if (remain > 0) {
ram54288 0:dbad57390bd1 208 // erase by overwriting
ram54288 0:dbad57390bd1 209 memmove(p + pos, p + pos + len, remain);
ram54288 0:dbad57390bd1 210 }
ram54288 0:dbad57390bd1 211
ram54288 0:dbad57390bd1 212 //if ( remain < 0 ) remain = 0;
ram54288 0:dbad57390bd1 213
ram54288 0:dbad57390bd1 214 // remove unused space
ram54288 0:dbad57390bd1 215 this->resize( pos+remain );
ram54288 0:dbad57390bd1 216
ram54288 0:dbad57390bd1 217 }
ram54288 0:dbad57390bd1 218 }
ram54288 0:dbad57390bd1 219 return *this;
ram54288 0:dbad57390bd1 220 }
ram54288 0:dbad57390bd1 221
ram54288 0:dbad57390bd1 222 String& String::append( const char* str, size_type n) {
ram54288 0:dbad57390bd1 223 if (str && n > 0) {
ram54288 0:dbad57390bd1 224 size_t lens = strlen(str);
ram54288 0:dbad57390bd1 225 if (n > lens)
ram54288 0:dbad57390bd1 226 n = lens;
ram54288 0:dbad57390bd1 227 size_t newlen = size_ + n;
ram54288 0:dbad57390bd1 228 this->reserve( newlen );
ram54288 0:dbad57390bd1 229 memmove(p+size_, str, n); // p and s.p MAY overlap
ram54288 0:dbad57390bd1 230 p[newlen] = 0; // add NUL termination
ram54288 0:dbad57390bd1 231 size_ = newlen;
ram54288 0:dbad57390bd1 232 }
ram54288 0:dbad57390bd1 233 return *this;
ram54288 0:dbad57390bd1 234 }
ram54288 0:dbad57390bd1 235
ram54288 0:dbad57390bd1 236 String& String::append_raw( const char* str, size_type n) {
ram54288 0:dbad57390bd1 237 if (str && n > 0) {
ram54288 0:dbad57390bd1 238 size_t newlen = size_ + n;
ram54288 0:dbad57390bd1 239 this->reserve( newlen );
ram54288 0:dbad57390bd1 240 memmove(p+size_, str, n); // p and s.p MAY overlap
ram54288 0:dbad57390bd1 241 p[newlen] = 0; // add NUL termination
ram54288 0:dbad57390bd1 242 size_ = newlen;
ram54288 0:dbad57390bd1 243 }
ram54288 0:dbad57390bd1 244 return *this;
ram54288 0:dbad57390bd1 245 }
ram54288 0:dbad57390bd1 246
ram54288 0:dbad57390bd1 247 void String::append_int(int param) {
ram54288 0:dbad57390bd1 248
ram54288 0:dbad57390bd1 249 // max len of "-9223372036854775808" plus zero termination
ram54288 0:dbad57390bd1 250 char conv_buff[20+1];
ram54288 0:dbad57390bd1 251
ram54288 0:dbad57390bd1 252 int len = itoa_c(param, conv_buff);
ram54288 0:dbad57390bd1 253 append_raw(conv_buff, len);
ram54288 0:dbad57390bd1 254 }
ram54288 0:dbad57390bd1 255
ram54288 0:dbad57390bd1 256 int String::compare( size_type pos, size_type len, const String& str ) const {
ram54288 0:dbad57390bd1 257 int r = -1;
ram54288 0:dbad57390bd1 258 if (pos <= size_) {
ram54288 0:dbad57390bd1 259 if ( len > size_ - pos)
ram54288 0:dbad57390bd1 260 len = size_ - pos; // limit len to available length
ram54288 0:dbad57390bd1 261
ram54288 0:dbad57390bd1 262 const size_type osize = str.size();
ram54288 0:dbad57390bd1 263 const size_type len2 = std::min(len, osize);
ram54288 0:dbad57390bd1 264 r = strncmp( p + pos, str.p, len2);
ram54288 0:dbad57390bd1 265 if (r==0) // equal so far, now compare sizes
ram54288 0:dbad57390bd1 266 r = len < osize ? -1 : ( len == osize ? 0 : +1 );
ram54288 0:dbad57390bd1 267 }
ram54288 0:dbad57390bd1 268 return r;
ram54288 0:dbad57390bd1 269 }
ram54288 0:dbad57390bd1 270
ram54288 0:dbad57390bd1 271 int String::compare( size_type pos, size_type len, const char* str ) const {
ram54288 0:dbad57390bd1 272 int r = -1;
ram54288 0:dbad57390bd1 273 if (pos <= size_) {
ram54288 0:dbad57390bd1 274
ram54288 0:dbad57390bd1 275 if ( len > size_ - pos)
ram54288 0:dbad57390bd1 276 len = size_ - pos; // limit len to available length
ram54288 0:dbad57390bd1 277
ram54288 0:dbad57390bd1 278 const size_type osize = strlen(str);
ram54288 0:dbad57390bd1 279 const size_type len2 = std::min(len, osize);
ram54288 0:dbad57390bd1 280 r = strncmp( p + pos, str, len2);
ram54288 0:dbad57390bd1 281 if (r==0) // equal so far, now compare sizes
ram54288 0:dbad57390bd1 282 r = len < osize ? -1 : ( len == osize ? 0 : +1 );
ram54288 0:dbad57390bd1 283 }
ram54288 0:dbad57390bd1 284 return r;
ram54288 0:dbad57390bd1 285 }
ram54288 0:dbad57390bd1 286
ram54288 0:dbad57390bd1 287 int String::find_last_of(char c) const {
ram54288 0:dbad57390bd1 288 int r = -1;
ram54288 0:dbad57390bd1 289 char *v;
ram54288 0:dbad57390bd1 290 v = strrchr(p,c);
ram54288 0:dbad57390bd1 291 if (v != NULL) {
ram54288 0:dbad57390bd1 292 r = 0;
ram54288 0:dbad57390bd1 293 char* i = p;
ram54288 0:dbad57390bd1 294 while (v != i) {
ram54288 0:dbad57390bd1 295 i++;
ram54288 0:dbad57390bd1 296 r++;
ram54288 0:dbad57390bd1 297 }
ram54288 0:dbad57390bd1 298 }
ram54288 0:dbad57390bd1 299 return r;
ram54288 0:dbad57390bd1 300 }
ram54288 0:dbad57390bd1 301
ram54288 0:dbad57390bd1 302 void String::new_realloc( size_type n) {
ram54288 0:dbad57390bd1 303 if (n > 0 ) {
ram54288 0:dbad57390bd1 304 char* pnew = static_cast<char*>(realloc(p, n)); // could return NULL
ram54288 0:dbad57390bd1 305 if (pnew)
ram54288 0:dbad57390bd1 306 p = pnew;
ram54288 0:dbad57390bd1 307 }
ram54288 0:dbad57390bd1 308 }
ram54288 0:dbad57390bd1 309
ram54288 0:dbad57390bd1 310 void String::reserve( const size_type n) {
ram54288 0:dbad57390bd1 311 if (n >= allocated_ ) {
ram54288 0:dbad57390bd1 312 this->new_realloc(n + 1);
ram54288 0:dbad57390bd1 313 allocated_ = n + 1;
ram54288 0:dbad57390bd1 314 }
ram54288 0:dbad57390bd1 315 }
ram54288 0:dbad57390bd1 316
ram54288 0:dbad57390bd1 317 void String::resize( const size_type n) {
ram54288 0:dbad57390bd1 318 this->resize( n, 0 );
ram54288 0:dbad57390bd1 319 }
ram54288 0:dbad57390bd1 320
ram54288 0:dbad57390bd1 321 void String::resize( const size_type n, const char c) {
ram54288 0:dbad57390bd1 322 if (n < size_ ) {
ram54288 0:dbad57390bd1 323 p[n] = 0;
ram54288 0:dbad57390bd1 324 size_ = n;
ram54288 0:dbad57390bd1 325 }
ram54288 0:dbad57390bd1 326 else if (n > size_ ) {
ram54288 0:dbad57390bd1 327 this->reserve( n );
ram54288 0:dbad57390bd1 328 for (size_type i=size_; i < n; ++i )
ram54288 0:dbad57390bd1 329 p[i] = c;
ram54288 0:dbad57390bd1 330 p[n] = 0;
ram54288 0:dbad57390bd1 331 size_ = n;
ram54288 0:dbad57390bd1 332 }
ram54288 0:dbad57390bd1 333 }
ram54288 0:dbad57390bd1 334
ram54288 0:dbad57390bd1 335 void String::swap( String& s ) {
ram54288 0:dbad57390bd1 336 std::swap( allocated_, s.allocated_ );
ram54288 0:dbad57390bd1 337 std::swap( size_, s.size_ );
ram54288 0:dbad57390bd1 338 std::swap( p, s.p );
ram54288 0:dbad57390bd1 339 }
ram54288 0:dbad57390bd1 340
ram54288 0:dbad57390bd1 341
ram54288 0:dbad57390bd1 342 // Comparison
ram54288 0:dbad57390bd1 343 bool operator<( const String& s1, const String& s2 ) {
ram54288 0:dbad57390bd1 344 return strcmp( s1.c_str(), s2.c_str() ) < 0;
ram54288 0:dbad57390bd1 345 }
ram54288 0:dbad57390bd1 346
ram54288 0:dbad57390bd1 347 void reverse(char s[], uint32_t length)
ram54288 0:dbad57390bd1 348 {
ram54288 0:dbad57390bd1 349 uint32_t i, j;
ram54288 0:dbad57390bd1 350 char c;
ram54288 0:dbad57390bd1 351
ram54288 0:dbad57390bd1 352 for (i = 0, j = length-1; i<j; i++, j--) {
ram54288 0:dbad57390bd1 353 c = s[i];
ram54288 0:dbad57390bd1 354 s[i] = s[j];
ram54288 0:dbad57390bd1 355 s[j] = c;
ram54288 0:dbad57390bd1 356 }
ram54288 0:dbad57390bd1 357 }
ram54288 0:dbad57390bd1 358
ram54288 0:dbad57390bd1 359 uint32_t itoa_c (int64_t n, char s[])
ram54288 0:dbad57390bd1 360 {
ram54288 0:dbad57390bd1 361 int64_t sign;
ram54288 0:dbad57390bd1 362 uint32_t i;
ram54288 0:dbad57390bd1 363
ram54288 0:dbad57390bd1 364 if ((sign = n) < 0)
ram54288 0:dbad57390bd1 365 n = -n;
ram54288 0:dbad57390bd1 366
ram54288 0:dbad57390bd1 367 i = 0;
ram54288 0:dbad57390bd1 368
ram54288 0:dbad57390bd1 369 do {
ram54288 0:dbad57390bd1 370 s[i++] = n % 10 + '0';
ram54288 0:dbad57390bd1 371 }
ram54288 0:dbad57390bd1 372 while ((n /= 10) > 0);
ram54288 0:dbad57390bd1 373
ram54288 0:dbad57390bd1 374 if (sign < 0)
ram54288 0:dbad57390bd1 375 s[i++] = '-';
ram54288 0:dbad57390bd1 376
ram54288 0:dbad57390bd1 377 s[i] = '\0';
ram54288 0:dbad57390bd1 378
ram54288 0:dbad57390bd1 379 m2m::reverse(s, i);
ram54288 0:dbad57390bd1 380 return i;
ram54288 0:dbad57390bd1 381 }
ram54288 0:dbad57390bd1 382
ram54288 0:dbad57390bd1 383 uint8_t* String::convert_integer_to_array(int64_t value, uint8_t &size, uint8_t *array, uint32_t array_size)
ram54288 0:dbad57390bd1 384 {
ram54288 0:dbad57390bd1 385 uint8_t* buffer = NULL;
ram54288 0:dbad57390bd1 386 size = 0;
ram54288 0:dbad57390bd1 387 if (array) {
ram54288 0:dbad57390bd1 388 value = String::convert_array_to_integer(array, array_size);
ram54288 0:dbad57390bd1 389 }
ram54288 0:dbad57390bd1 390
ram54288 0:dbad57390bd1 391 if(value < 0xFF) {
ram54288 0:dbad57390bd1 392 size = 1;
ram54288 0:dbad57390bd1 393 } else if(value < 0xFFFF) {
ram54288 0:dbad57390bd1 394 size = 2;
ram54288 0:dbad57390bd1 395 } else if(value < 0xFFFFFF) {
ram54288 0:dbad57390bd1 396 size = 3;
ram54288 0:dbad57390bd1 397 } else if(value < 0xFFFFFFFF) {
ram54288 0:dbad57390bd1 398 size = 4;
ram54288 0:dbad57390bd1 399 } else if(value < 0xFFFFFFFFFF) {
ram54288 0:dbad57390bd1 400 size = 5;
ram54288 0:dbad57390bd1 401 } else if(value < 0xFFFFFFFFFFFF) {
ram54288 0:dbad57390bd1 402 size = 6;
ram54288 0:dbad57390bd1 403 } else if(value < 0xFFFFFFFFFFFFFF) {
ram54288 0:dbad57390bd1 404 size = 7;
ram54288 0:dbad57390bd1 405 } else {
ram54288 0:dbad57390bd1 406 size = 8;
ram54288 0:dbad57390bd1 407 }
ram54288 0:dbad57390bd1 408
ram54288 0:dbad57390bd1 409 buffer = (uint8_t*)malloc(size);
ram54288 0:dbad57390bd1 410 if (buffer) {
ram54288 0:dbad57390bd1 411 for (int i = 0; i < size; i++) {
ram54288 0:dbad57390bd1 412 buffer[i] = (value >> ((size - i - 1) * 8));
ram54288 0:dbad57390bd1 413 }
ram54288 0:dbad57390bd1 414 } else {
ram54288 0:dbad57390bd1 415 size = 0;
ram54288 0:dbad57390bd1 416 }
ram54288 0:dbad57390bd1 417 return buffer;
ram54288 0:dbad57390bd1 418 }
ram54288 0:dbad57390bd1 419
ram54288 0:dbad57390bd1 420 int64_t String::convert_array_to_integer(uint8_t *value, uint32_t size)
ram54288 0:dbad57390bd1 421 {
ram54288 0:dbad57390bd1 422 int64_t temp_64 = 0;
ram54288 0:dbad57390bd1 423 for (int i = size - 1; i >= 0; i--) {
ram54288 0:dbad57390bd1 424 temp_64 += (uint64_t)(*value++) << i * 8;
ram54288 0:dbad57390bd1 425 }
ram54288 0:dbad57390bd1 426 return temp_64;
ram54288 0:dbad57390bd1 427 }
ram54288 0:dbad57390bd1 428
ram54288 0:dbad57390bd1 429 } // namespace