actube/src/cw/vendorstr_create_from_str.c

38 lines
687 B
C

#include "bstr.h"
#include "format.h"
uint8_t * bstrv_create_from_str(uint32_t vendor_id,const char *s)
{
int l = strlen(s);
if (s[0]!='.')
return bstrv_create(vendor_id,(uint8_t*)s,l);
if (l<=2)
return bstrv_create(vendor_id,(uint8_t*)s,l);
if (s[1]=='.')
return bstrv_create(vendor_id,(uint8_t*)s+1,l-1);
if (s[1]!='x')
return bstrv_create(vendor_id,(uint8_t*)s,l);
/* the string starts with ".x" - read hexbytes */
l-=2;
int msize=l/2;
if(l&1)
msize++;
uint8_t * mem = malloc(bstrv_size(msize));
if(!mem)
return NULL;
bstrv_set_vendor_id(mem,vendor_id);
bstrv_set_len(mem,msize);
cw_format_scan_hex_bytes(bstrv_data(mem),s+2,l);
return mem;
}