| | |
| | | case 8: |
| | | x = 0x8000000000000000ULL; |
| | | break; |
| | | default: |
| | | default: |
| | | case 10: |
| | | x = 10000000000000000000ULL; |
| | | base = 10; |
| | |
| | | #endif |
| | | |
| | | #if USE_DEVICE_DEPENDENT_ERROR_INFORMATION && !USE_MEMORY_ALLOCATION_FREE |
| | | |
| | | /** |
| | | * Duplicate string if "strdup" ("malloc/free") not supported on system. |
| | | * Allocate space in heap if it possible |
| | |
| | | * @return - pointer of duplicated string or NULL, if duplicate is not possible. |
| | | */ |
| | | char * OUR_strdup(scpi_error_info_heap_t * heap, const char *s) { |
| | | if(!s || !heap) { |
| | | return NULL; |
| | | } |
| | | if (!s || !heap) { |
| | | return NULL; |
| | | } |
| | | |
| | | if(heap->data[heap->wr]!='\0'){ |
| | | return NULL; |
| | | } |
| | | |
| | | if( *s == '\0' ){ |
| | | return NULL; |
| | | } |
| | | |
| | | size_t len=strlen(s) + 1; // additional '\0' at end |
| | | if( len > heap->count ) { |
| | | return NULL; |
| | | } |
| | | char * ptrs = s; |
| | | char * head = &heap->data[heap->wr]; |
| | | size_t rem = heap->size - (&heap->data[heap->wr]-heap->data); |
| | | size_t sstp = 0; |
| | | |
| | | if(len >= rem){ |
| | | memcpy(&heap->data[heap->wr],s,rem); |
| | | len = len - rem; |
| | | ptrs += rem; |
| | | heap->wr = 0; |
| | | heap->count -= rem; |
| | | } |
| | | |
| | | memcpy(&heap->data[heap->wr],ptrs,len); |
| | | heap->wr += len; |
| | | heap->count -= len; |
| | | |
| | | return head; |
| | | if (heap->data[heap->wr] != '\0') { |
| | | return NULL; |
| | | } |
| | | |
| | | if (*s == '\0') { |
| | | return NULL; |
| | | } |
| | | |
| | | size_t len = strlen(s) + 1; // additional '\0' at end |
| | | if (len > heap->count) { |
| | | return NULL; |
| | | } |
| | | char * ptrs = s; |
| | | char * head = &heap->data[heap->wr]; |
| | | size_t rem = heap->size - (&heap->data[heap->wr] - heap->data); |
| | | size_t sstp = 0; |
| | | |
| | | if (len >= rem) { |
| | | memcpy(&heap->data[heap->wr], s, rem); |
| | | len = len - rem; |
| | | ptrs += rem; |
| | | heap->wr = 0; |
| | | heap->count -= rem; |
| | | } |
| | | |
| | | memcpy(&heap->data[heap->wr], ptrs, len); |
| | | heap->wr += len; |
| | | heap->count -= len; |
| | | |
| | | return head; |
| | | } |
| | | |
| | | /** |
| | |
| | | * @return len2 - lenght of second part of string. |
| | | */ |
| | | scpi_bool_t OUR_get_parts(scpi_error_info_heap_t * heap, const char * s, size_t * len1, const char ** s2, size_t * len2) { |
| | | if(!heap || !s || !len1 || !s2 || !len2) { |
| | | return FALSE; |
| | | } |
| | | |
| | | if(*s == '\0') { |
| | | return FALSE; |
| | | } |
| | | |
| | | *len1 = 0; |
| | | size_t rem = heap->size - (s - heap->data); |
| | | *len1 = strnlen(s, rem); |
| | | if (!heap || !s || !len1 || !s2 || !len2) { |
| | | return FALSE; |
| | | } |
| | | |
| | | if(&s[*len1-1] == &heap->data[heap->size-1]){ |
| | | *s2 = heap->data; |
| | | *len2 = strnlen(*s2, heap->size); |
| | | }else{ |
| | | *s2 = NULL; |
| | | *len2 = 0; |
| | | } |
| | | return TRUE; |
| | | if (*s == '\0') { |
| | | return FALSE; |
| | | } |
| | | |
| | | *len1 = 0; |
| | | size_t rem = heap->size - (s - heap->data); |
| | | *len1 = strnlen(s, rem); |
| | | |
| | | if (&s[*len1 - 1] == &heap->data[heap->size - 1]) { |
| | | *s2 = heap->data; |
| | | *len2 = strnlen(*s2, heap->size); |
| | | } else { |
| | | *s2 = NULL; |
| | | *len2 = 0; |
| | | } |
| | | return TRUE; |
| | | } |
| | | |
| | | /** |
| | |
| | | * @param rollback - backward write pointer in heap |
| | | */ |
| | | void OUR_free(scpi_error_info_heap_t * heap, const char * s, scpi_bool_t rollback) { |
| | | |
| | | if(!s) return; |
| | | |
| | | char * data_add; |
| | | size_t len[2]; |
| | | |
| | | if( !OUR_get_parts( heap, s, &len[0], &data_add, &len[1] ) ) return; |
| | | |
| | | if(data_add) { |
| | | len[1]++; |
| | | memset(data_add,0,len[1]); |
| | | heap->count += len[1]; |
| | | } else { |
| | | len[0]++; |
| | | } |
| | | memset(s,0,len[0]); |
| | | heap->count += len[0]; |
| | | if( heap->count == heap->size){ |
| | | heap->wr = 0; |
| | | return; |
| | | } |
| | | if(rollback){ |
| | | size_t rb = len[0] + len[1]; |
| | | if( rb > heap->wr){ |
| | | heap->wr += heap->size; |
| | | } |
| | | heap->wr -= rb; |
| | | } |
| | | |
| | | if (!s) return; |
| | | |
| | | char * data_add; |
| | | size_t len[2]; |
| | | |
| | | if (!OUR_get_parts(heap, s, &len[0], &data_add, &len[1])) return; |
| | | |
| | | if (data_add) { |
| | | len[1]++; |
| | | memset(data_add, 0, len[1]); |
| | | heap->count += len[1]; |
| | | } else { |
| | | len[0]++; |
| | | } |
| | | memset(s, 0, len[0]); |
| | | heap->count += len[0]; |
| | | if (heap->count == heap->size) { |
| | | heap->wr = 0; |
| | | return; |
| | | } |
| | | if (rollback) { |
| | | size_t rb = len[0] + len[1]; |
| | | if (rb > heap->wr) { |
| | | heap->wr += heap->size; |
| | | } |
| | | heap->wr -= rb; |
| | | } |
| | | } |
| | | |
| | | #endif |
| | |
| | | buf[--w2] = (int) ((fj + .03) * 10) + '0'; |
| | | r2++; |
| | | } |
| | | while (w2 < (int)bufsize) buf[w1++] = buf[w2++]; |
| | | while (w2 < (int) bufsize) buf[w1++] = buf[w2++]; |
| | | } else if (arg > 0) { |
| | | while ((fj = arg * 10) < 1) { |
| | | arg = fj; |
| | |
| | | buf[0] = '\0'; |
| | | return buf; |
| | | } |
| | | while (w1 <= w2 && w1 < (int)bufsize) { |
| | | while (w1 <= w2 && w1 < (int) bufsize) { |
| | | arg *= 10; |
| | | arg = modf(arg, &fj); |
| | | buf[w1++] = (int) fj + '0'; |
| | | } |
| | | if (w2 >= (int)bufsize) { |
| | | if (w2 >= (int) bufsize) { |
| | | buf[bufsize - 1] = '\0'; |
| | | return buf; |
| | | } |
| | |
| | | |
| | | /** |
| | | * Get native CPU endiannes |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_array_format_t SCPI_GetNativeFormat(void) { |
| | | |
| | | union { |
| | | uint32_t i; |
| | | char c[4]; |
| | |
| | | /** |
| | | * Swap 16bit number |
| | | * @param val |
| | | * @return |
| | | * @return |
| | | */ |
| | | uint16_t SCPI_Swap16(uint16_t val) { |
| | | return ((val & 0x00FF) << 8) | |
| | | return ((val & 0x00FF) << 8) | |
| | | ((val & 0xFF00) >> 8); |
| | | } |
| | | |
| | | /** |
| | | * Swap 32bit number |
| | | * @param val |
| | | * @return |
| | | * @return |
| | | */ |
| | | uint32_t SCPI_Swap32(uint32_t val) { |
| | | return ((val & 0x000000FF) << 24) | |
| | |
| | | /** |
| | | * Swap 64bit number |
| | | * @param val |
| | | * @return |
| | | * @return |
| | | */ |
| | | uint64_t SCPI_Swap64(uint64_t val) { |
| | | return ((val & 0x00000000000000FFul) << 56) | |