You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
114 lines
2.7 KiB
114 lines
2.7 KiB
/**
|
|
* @file stringbuilder.c
|
|
*
|
|
* ADAPTED FROM:
|
|
*
|
|
* DAPLink Interface Firmware
|
|
* Copyright (c) 2009-2016, ARM Limited, All Rights Reserved
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License"); you may
|
|
* not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include "stringbuilder.h"
|
|
#include <string.h>
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
|
|
uint32_t strb_write_hex8(char *str, uint8_t value)
|
|
{
|
|
static const char nybble_chars[] = "0123456789abcdef";
|
|
*(str + 0) = nybble_chars[(value >> 4) & 0x0F ];
|
|
*(str + 1) = nybble_chars[(value >> 0) & 0x0F ];
|
|
return 2;
|
|
}
|
|
|
|
uint32_t strb_write_hex16(char *str, uint16_t value)
|
|
{
|
|
uint32_t pos = 0;
|
|
pos += strb_write_hex8(str + pos, (uint8_t) ((value >> 8) & 0xFF));
|
|
pos += strb_write_hex8(str + pos, (uint8_t) ((value >> 0) & 0xFF));
|
|
return pos;
|
|
}
|
|
|
|
uint32_t strb_write_hex32(char *str, uint32_t value)
|
|
{
|
|
uint32_t pos = 0;
|
|
pos += strb_write_hex8(str + pos, (uint8_t) ((value >> 0x18) & 0xFF));
|
|
pos += strb_write_hex8(str + pos, (uint8_t) ((value >> 0x10) & 0xFF));
|
|
pos += strb_write_hex8(str + pos, (uint8_t) ((value >> 0x08) & 0xFF));
|
|
pos += strb_write_hex8(str + pos, (uint8_t) ((value >> 0x00) & 0xFF));
|
|
return pos;
|
|
}
|
|
|
|
uint32_t strb_write_uint32(char *str, uint32_t value)
|
|
{
|
|
uint32_t temp_val;
|
|
uint32_t digits;
|
|
uint32_t i;
|
|
// Count the number of digits
|
|
digits = 0;
|
|
temp_val = value;
|
|
|
|
while (temp_val > 0) {
|
|
temp_val /= 10;
|
|
digits += 1;
|
|
}
|
|
|
|
if (digits <= 0) {
|
|
digits = 1;
|
|
}
|
|
|
|
// Write the number
|
|
for (i = 0; i < digits; i++) {
|
|
str[digits - i - 1] = (char) ('0' + (value % 10));
|
|
value /= 10;
|
|
}
|
|
|
|
return digits;
|
|
}
|
|
|
|
uint32_t strb_write_uint32_zp(char *str, uint32_t value, uint16_t total_size)
|
|
{
|
|
uint32_t size;
|
|
// Get the size of value
|
|
size = strb_write_uint32(str, value);
|
|
|
|
if (size >= total_size) {
|
|
return size;
|
|
}
|
|
|
|
// Zero fill
|
|
memset(str, '0', total_size);
|
|
// Write value
|
|
strb_write_uint32(str + (total_size - size), value);
|
|
return total_size;
|
|
}
|
|
|
|
uint32_t strb_write_string(char *str, const char *data)
|
|
{
|
|
uint32_t pos = 0;
|
|
|
|
while (0 != data[pos]) {
|
|
str[pos] = data[pos];
|
|
pos++;
|
|
}
|
|
|
|
return pos;
|
|
}
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|
|
|