libs/luci-lib-nixio/src/binary.c

   1 /*
   2  * nixio - Linux I/O library for lua
   3  *
   4  *   Copyright (C) 2009 Steven Barth <steven@midlink.org>
   5  *
   6  *  Licensed under the Apache License, Version 2.0 (the "License");
   7  *  you may not use this file except in compliance with the License.
   8  *  You may obtain a copy of the License at
   9  *
  10  *      http://www.apache.org/licenses/LICENSE-2.0
  11  *
  12  *  Unless required by applicable law or agreed to in writing, software
  13  *  distributed under the License is distributed on an "AS IS" BASIS,
  14  *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  15  *  See the License for the specific language governing permissions and
  16  *  limitations under the License.
  17  */
  18
  19 #include "nixio.h"
  20 #include <stdlib.h>
  21
  22 static unsigned char nixio__b64encode_tbl[] =
  23         "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
  24
  25 static unsigned char nixio__b64decode_tbl[] = {
  26         0x3e, 0xff, 0xff, 0xff, 0x3f, 0x34, 0x35, 0x36,
  27         0x37, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0xff,
  28         0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00, 0x01,
  29         0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09,
  30         0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11,
  31         0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19,
  32         0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x1a, 0x1b,
  33         0x1c, 0x1d, 0x1e, 0x1f, 0x20, 0x21, 0x22, 0x23,
  34         0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b,
  35         0x2c, 0x2d, 0x2e, 0x2f, 0x30, 0x31, 0x32, 0x33
  36 };
  37
  38 static const uint32_t nixio__crc32_tbl[] = {
  39         0x00000000U, 0x77073096U, 0xee0e612cU, 0x990951baU, 0x076dc419U,
  40         0x706af48fU, 0xe963a535U, 0x9e6495a3U, 0x0edb8832U, 0x79dcb8a4U,
  41         0xe0d5e91eU, 0x97d2d988U, 0x09b64c2bU, 0x7eb17cbdU, 0xe7b82d07U,
  42         0x90bf1d91U, 0x1db71064U, 0x6ab020f2U, 0xf3b97148U, 0x84be41deU,
  43         0x1adad47dU, 0x6ddde4ebU, 0xf4d4b551U, 0x83d385c7U, 0x136c9856U,
  44         0x646ba8c0U, 0xfd62f97aU, 0x8a65c9ecU, 0x14015c4fU, 0x63066cd9U,
  45         0xfa0f3d63U, 0x8d080df5U, 0x3b6e20c8U, 0x4c69105eU, 0xd56041e4U,
  46         0xa2677172U, 0x3c03e4d1U, 0x4b04d447U, 0xd20d85fdU, 0xa50ab56bU,
  47         0x35b5a8faU, 0x42b2986cU, 0xdbbbc9d6U, 0xacbcf940U, 0x32d86ce3U,
  48         0x45df5c75U, 0xdcd60dcfU, 0xabd13d59U, 0x26d930acU, 0x51de003aU,
  49         0xc8d75180U, 0xbfd06116U, 0x21b4f4b5U, 0x56b3c423U, 0xcfba9599U,
  50         0xb8bda50fU, 0x2802b89eU, 0x5f058808U, 0xc60cd9b2U, 0xb10be924U,
  51         0x2f6f7c87U, 0x58684c11U, 0xc1611dabU, 0xb6662d3dU, 0x76dc4190U,
  52         0x01db7106U, 0x98d220bcU, 0xefd5102aU, 0x71b18589U, 0x06b6b51fU,
  53         0x9fbfe4a5U, 0xe8b8d433U, 0x7807c9a2U, 0x0f00f934U, 0x9609a88eU,
  54         0xe10e9818U, 0x7f6a0dbbU, 0x086d3d2dU, 0x91646c97U, 0xe6635c01U,
  55         0x6b6b51f4U, 0x1c6c6162U, 0x856530d8U, 0xf262004eU, 0x6c0695edU,
  56         0x1b01a57bU, 0x8208f4c1U, 0xf50fc457U, 0x65b0d9c6U, 0x12b7e950U,
  57         0x8bbeb8eaU, 0xfcb9887cU, 0x62dd1ddfU, 0x15da2d49U, 0x8cd37cf3U,
  58         0xfbd44c65U, 0x4db26158U, 0x3ab551ceU, 0xa3bc0074U, 0xd4bb30e2U,
  59         0x4adfa541U, 0x3dd895d7U, 0xa4d1c46dU, 0xd3d6f4fbU, 0x4369e96aU,
  60         0x346ed9fcU, 0xad678846U, 0xda60b8d0U, 0x44042d73U, 0x33031de5U,
  61         0xaa0a4c5fU, 0xdd0d7cc9U, 0x5005713cU, 0x270241aaU, 0xbe0b1010U,
  62         0xc90c2086U, 0x5768b525U, 0x206f85b3U, 0xb966d409U, 0xce61e49fU,
  63         0x5edef90eU, 0x29d9c998U, 0xb0d09822U, 0xc7d7a8b4U, 0x59b33d17U,
  64         0x2eb40d81U, 0xb7bd5c3bU, 0xc0ba6cadU, 0xedb88320U, 0x9abfb3b6U,
  65         0x03b6e20cU, 0x74b1d29aU, 0xead54739U, 0x9dd277afU, 0x04db2615U,
  66         0x73dc1683U, 0xe3630b12U, 0x94643b84U, 0x0d6d6a3eU, 0x7a6a5aa8U,
  67         0xe40ecf0bU, 0x9309ff9dU, 0x0a00ae27U, 0x7d079eb1U, 0xf00f9344U,
  68         0x8708a3d2U, 0x1e01f268U, 0x6906c2feU, 0xf762575dU, 0x806567cbU,
  69         0x196c3671U, 0x6e6b06e7U, 0xfed41b76U, 0x89d32be0U, 0x10da7a5aU,
  70         0x67dd4accU, 0xf9b9df6fU, 0x8ebeeff9U, 0x17b7be43U, 0x60b08ed5U,
  71         0xd6d6a3e8U, 0xa1d1937eU, 0x38d8c2c4U, 0x4fdff252U, 0xd1bb67f1U,
  72         0xa6bc5767U, 0x3fb506ddU, 0x48b2364bU, 0xd80d2bdaU, 0xaf0a1b4cU,
  73         0x36034af6U, 0x41047a60U, 0xdf60efc3U, 0xa867df55U, 0x316e8eefU,
  74         0x4669be79U, 0xcb61b38cU, 0xbc66831aU, 0x256fd2a0U, 0x5268e236U,
  75         0xcc0c7795U, 0xbb0b4703U, 0x220216b9U, 0x5505262fU, 0xc5ba3bbeU,
  76         0xb2bd0b28U, 0x2bb45a92U, 0x5cb36a04U, 0xc2d7ffa7U, 0xb5d0cf31U,
  77         0x2cd99e8bU, 0x5bdeae1dU, 0x9b64c2b0U, 0xec63f226U, 0x756aa39cU,
  78         0x026d930aU, 0x9c0906a9U, 0xeb0e363fU, 0x72076785U, 0x05005713U,
  79         0x95bf4a82U, 0xe2b87a14U, 0x7bb12baeU, 0x0cb61b38U, 0x92d28e9bU,
  80         0xe5d5be0dU, 0x7cdcefb7U, 0x0bdbdf21U, 0x86d3d2d4U, 0xf1d4e242U,
  81         0x68ddb3f8U, 0x1fda836eU, 0x81be16cdU, 0xf6b9265bU, 0x6fb077e1U,
  82         0x18b74777U, 0x88085ae6U, 0xff0f6a70U, 0x66063bcaU, 0x11010b5cU,
  83         0x8f659effU, 0xf862ae69U, 0x616bffd3U, 0x166ccf45U, 0xa00ae278U,
  84         0xd70dd2eeU, 0x4e048354U, 0x3903b3c2U, 0xa7672661U, 0xd06016f7U,
  85         0x4969474dU, 0x3e6e77dbU, 0xaed16a4aU, 0xd9d65adcU, 0x40df0b66U,
  86         0x37d83bf0U, 0xa9bcae53U, 0xdebb9ec5U, 0x47b2cf7fU, 0x30b5ffe9U,
  87         0xbdbdf21cU, 0xcabac28aU, 0x53b39330U, 0x24b4a3a6U, 0xbad03605U,
  88         0xcdd70693U, 0x54de5729U, 0x23d967bfU, 0xb3667a2eU, 0xc4614ab8U,
  89         0x5d681b02U, 0x2a6f2b94U, 0xb40bbe37U, 0xc30c8ea1U, 0x5a05df1bU,
  90         0x2d02ef8dU
  91 };
  92
  93 static int nixio_bin_crc32(lua_State *L) {
  94         size_t len;
  95         const char *buffer = luaL_checklstring(L, 1, &len);
  96         uint32_t value = luaL_optinteger(L, 2, 0);
  97
  98         value = ~value;
  99         for (size_t i=0; i<len; i++) {
 100                 value = nixio__crc32_tbl[(value ^ buffer[i]) & 0xffU ] ^ (value >> 8);
 101         }
 102
 103         lua_pushinteger(L, (int)(value ^ 0xffffffffU));
 104         return 1;
 105 }
 106
 107 static int nixio_bin_hexlify(lua_State *L) {
 108         size_t len, lenout;
 109         luaL_checktype(L, 1, LUA_TSTRING);
 110         const unsigned char *data = (unsigned char*)lua_tolstring(L, 1, &len);
 111
 112         if (len == 0) {
 113                 lua_pushvalue(L, 1);
 114                 return 1;
 115         }
 116
 117         lenout = len * 2;
 118         luaL_argcheck(L, lenout > len, 1, "size overflow");
 119
 120         char *out = malloc(lenout);
 121         if (!out) {
 122                 return luaL_error(L, NIXIO_OOM);
 123         }
 124
 125         for (size_t i=0; i < len; i++) {
 126                 out[2*i]   = nixio__bin2hex[(data[i] & 0xf0) >> 4];
 127                 out[2*i+1] = nixio__bin2hex[(data[i] & 0x0f)];
 128         }
 129
 130         lua_pushlstring(L, out, lenout);
 131         free(out);
 132
 133         return 1;
 134 }
 135
 136
 137 static int nixio_bin_unhexlify(lua_State *L) {
 138         size_t len, lenout;
 139         const char *data = luaL_checklstring(L, 1, &len);
 140
 141         if (len == 0) {
 142                 lua_pushvalue(L, 1);
 143                 return 1;
 144         } else if (len % 2) {
 145                 errno = EINVAL;
 146                 return nixio__perror(L);
 147         }
 148
 149         lenout = len / 2;
 150         char *out = malloc(lenout);
 151         if (!out) {
 152                 return luaL_error(L, NIXIO_OOM);
 153         }
 154
 155         for (size_t i=0; i < lenout; i++) {
 156                 char c = data[2*i];
 157                 if (c >= '0' && c <= '9') {
 158                         out[i] = (c - '0') << 4;
 159                 } else if (c >= 'a' && c <= 'f') {
 160                         out[i] = (c - 'a' + 10) << 4;
 161                 } else if (data[2*i] >= 'A' && c <= 'F') {
 162                         out[i] = (c - 'A' + 10) << 4;
 163                 } else {
 164                         free(out);
 165                         errno = EINVAL;
 166                         return nixio__perror(L);
 167                 }
 168
 169                 c = data[2*i+1];
 170                 if (c >= '0' && c <= '9') {
 171                         out[i] += c - '0';
 172                 } else if (c >= 'a' && c <= 'f') {
 173                         out[i] += c - 'a' + 10;
 174                 } else if (c >= 'A' && c <= 'F') {
 175                         out[i] += c - 'A' + 10;
 176                 } else {
 177                         free(out);
 178                         errno = EINVAL;
 179                         return nixio__perror(L);
 180                 }
 181         }
 182
 183         lua_pushlstring(L, out, lenout);
 184         free(out);
 185
 186         return 1;
 187 }
 188
 189 static int nixio_bin_b64encode(lua_State *L) {
 190         size_t len, lenout, pad, i;
 191         const uint8_t *data = (const uint8_t*)luaL_checklstring(L, 1, &len);
 192
 193         lenout = len / 3;
 194         lenout *= 4;
 195
 196         pad = len % 3;
 197
 198         if (len == 0) {
 199                 lua_pushvalue(L, 1);
 200                 return 1;
 201         } else if (pad) {
 202                 lenout += 4;
 203         }
 204
 205         luaL_argcheck(L, lenout > len, 1, "size overflow");
 206
 207         char *out = malloc(lenout);
 208         if (!out) {
 209                 return luaL_error(L, NIXIO_OOM);
 210         }
 211
 212         uint8_t *o = (uint8_t*)out;
 213         for (i = 0; i < len; i += 3) {
 214                 uint32_t cv = (data[i] << 16) | (data[i+1] << 8) | data[i+2];
 215                 *(o+3) = nixio__b64encode_tbl[ cv        & 0x3f];
 216                 *(o+2) = nixio__b64encode_tbl[(cv >> 6)  & 0x3f];
 217                 *(o+1) = nixio__b64encode_tbl[(cv >> 12) & 0x3f];
 218                 *o     = nixio__b64encode_tbl[(cv >> 18) & 0x3f];
 219                 o += 4;
 220         }
 221
 222         if (pad) {
 223                 uint32_t cv = data[len-pad] << 16;
 224                 *(o-1) = '=';
 225                 *(o-2) = '=';
 226                 if (pad == 2) {
 227                         cv |= data[len-pad+1] << 8;
 228                         *(o-2) = nixio__b64encode_tbl[(cv >> 6) & 0x3f];
 229                 }
 230                 *(o-3) = nixio__b64encode_tbl[(cv >> 12) & 0x3f];
 231                 *(o-4) = nixio__b64encode_tbl[(cv >> 18) & 0x3f];
 232         }
 233
 234         lua_pushlstring(L, out, lenout);
 235         free(out);
 236         return 1;
 237 }
 238
 239 static int nixio_bin_b64decode(lua_State *L) {
 240         size_t len, lenout, i;
 241         const char *dt = luaL_checklstring(L, 1, &len);
 242
 243         if (len == 0) {
 244                 lua_pushvalue(L, 1);
 245                 return 1;
 246         } else if (len % 4) {
 247                 errno = EINVAL;
 248                 return nixio__perror(L);
 249         }
 250
 251         lenout = len / 4 * 3;
 252
 253         unsigned char *out = malloc(lenout);
 254         if (!out) {
 255                 return luaL_error(L, NIXIO_OOM);
 256         }
 257
 258         unsigned char *o = out;
 259         for (i = 0; i < len; i += 4) {
 260                 uint32_t cv = 0;
 261                 for (int j = 0; j < 4; j++) {
 262                         unsigned char c = dt[i + j] - 43;
 263                         if (c > 79 || (c = nixio__b64decode_tbl[c]) == 0xff) {
 264                                 free(out);
 265                                 errno = EINVAL;
 266                                 return nixio__perror(L);
 267                         }
 268
 269                         cv |= c;
 270                         if (j != 3) {
 271                                 cv <<= 6;
 272                         }
 273                 }
 274
 275                 *(o+2) = (unsigned char)(cv & 0xff);
 276                 *(o+1) = (unsigned char)((cv >>  8) & 0xff);
 277                 *o     = (unsigned char)((cv >> 16) & 0xff);
 278                 o += 3;
 279         }
 280
 281         if (dt[len-1] == '=') {
 282                 lenout--;
 283         }
 284
 285         if (dt[len-2] == '=') {
 286                 lenout--;
 287         }
 288
 289         lua_pushlstring(L, (char*)out, lenout);
 290         free(out);
 291         return 1;
 292 }
 293
 294 /* module table */
 295 static const luaL_Reg R[] = {
 296         {"hexlify",             nixio_bin_hexlify},
 297         {"unhexlify",   nixio_bin_unhexlify},
 298         {"crc32",               nixio_bin_crc32},
 299         {"b64encode",   nixio_bin_b64encode},
 300         {"b64decode",   nixio_bin_b64decode},
 301         {NULL,                  NULL}
 302 };
 303
 304
 305 void nixio_open_bin(lua_State *L) {
 306         lua_newtable(L);
 307         luaL_register(L, NULL, R);
 308         lua_setfield(L, -2, "bin");
 309 }