src/utils.c

   1
   2 #include <string.h>
   3 #include <stdint.h>
   4 #include <errno.h>
   5 #include <stdio.h>
   6
   7 #include <osmocom/core/utils.h>
   8
   9 static char namebuf[255];
  10 const char *get_value_string(const struct value_string *vs, uint32_t val)
  11 {
  12         int i;
  13
  14         for (i = 0;; i++) {
  15                 if (vs[i].value == 0 && vs[i].str == NULL)
  16                         break;
  17                 if (vs[i].value == val)
  18                         return vs[i].str;
  19         }
  20
  21         snprintf(namebuf, sizeof(namebuf), "unknown 0x%x", val);
  22         return namebuf;
  23 }
  24
  25 int get_string_value(const struct value_string *vs, const char *str)
  26 {
  27         int i;
  28
  29         for (i = 0;; i++) {
  30                 if (vs[i].value == 0 && vs[i].str == NULL)
  31                         break;
  32                 if (!strcasecmp(vs[i].str, str))
  33                         return vs[i].value;
  34         }
  35         return -EINVAL;
  36 }
  37
  38 char osmo_bcd2char(uint8_t bcd)
  39 {
  40         if (bcd < 0xa)
  41                 return '0' + bcd;
  42         else
  43                 return 'A' + (bcd - 0xa);
  44 }
  45
  46 /* only works for numbers in ascii */
  47 uint8_t osmo_char2bcd(char c)
  48 {
  49         return c - 0x30;
  50 }
  51
  52 int osmo_hexparse(const char *str, uint8_t *b, int max_len)
  53
  54 {
  55         int i, l, v;
  56
  57         l = strlen(str);
  58         if ((l&1) || ((l>>1) > max_len))
  59                 return -1;
  60
  61         memset(b, 0x00, max_len);
  62
  63         for (i=0; i<l; i++) {
  64                 char c = str[i];
  65                 if (c >= '0' && c <= '9')
  66                         v = c - '0';
  67                 else if (c >= 'a' && c <= 'f')
  68                         v = 10 + (c - 'a');
  69                 else if (c >= 'A' && c <= 'F')
  70                         v = 10 + (c - 'A');
  71                 else
  72                         return -1;
  73                 b[i>>1] |= v << (i&1 ? 0 : 4);
  74         }
  75
  76         return i>>1;
  77 }
  78
  79 static char hexd_buff[4096];
  80
  81 static char *_osmo_hexdump(const unsigned char *buf, int len, char *delim)
  82 {
  83         int i;
  84         char *cur = hexd_buff;
  85
  86         hexd_buff[0] = 0;
  87         for (i = 0; i < len; i++) {
  88                 int len_remain = sizeof(hexd_buff) - (cur - hexd_buff);
  89                 int rc = snprintf(cur, len_remain, "%02x%s", buf[i], delim);
  90                 if (rc <= 0)
  91                         break;
  92                 cur += rc;
  93         }
  94         hexd_buff[sizeof(hexd_buff)-1] = 0;
  95         return hexd_buff;
  96 }
  97
  98 char *osmo_ubit_dump(const uint8_t *bits, unsigned int len)
  99 {
 100         int i;
 101
 102         if (len > sizeof(hexd_buff)-1)
 103                 len = sizeof(hexd_buff)-1;
 104         memset(hexd_buff, 0, sizeof(hexd_buff));
 105
 106         for (i = 0; i < len; i++) {
 107                 char outch;
 108                 switch (bits[i]) {
 109                 case 0:
 110                         outch = '0';
 111                         break;
 112                 case 0xff:
 113                         outch = '?';
 114                         break;
 115                 case 1:
 116                         outch = '1';
 117                         break;
 118                 default:
 119                         outch = 'E';
 120                         break;
 121                 }
 122                 hexd_buff[i] = outch;
 123         }
 124         hexd_buff[sizeof(hexd_buff)-1] = 0;
 125         return hexd_buff;
 126 }
 127
 128 char *osmo_hexdump(const unsigned char *buf, int len)
 129 {
 130         return _osmo_hexdump(buf, len, " ");
 131 }
 132
 133 char *osmo_osmo_hexdump_nospc(const unsigned char *buf, int len)
 134 {
 135         return _osmo_hexdump(buf, len, "");
 136 }
 137
 138 #include "../config.h"
 139 #ifdef HAVE_CTYPE_H
 140 #include <ctype.h>
 141 void osmo_str2lower(char *out, const char *in)
 142 {
 143         unsigned int i;
 144
 145         for (i = 0; i < strlen(in); i++)
 146                 out[i] = tolower(in[i]);
 147         out[strlen(in)] = '\0';
 148 }
 149
 150 void osmo_str2upper(char *out, const char *in)
 151 {
 152         unsigned int i;
 153
 154         for (i = 0; i < strlen(in); i++)
 155                 out[i] = toupper(in[i]);
 156         out[strlen(in)] = '\0';
 157 }
 158 #endif /* HAVE_CTYPE_H */