tfc_misc.c

   1 /*
   2  * tfcrypt -- high security Threefish encryption tool.
   3  *
   4  * tfcrypt is copyrighted:
   5  * Copyright (C) 2012-2019 Andrey Rys. All rights reserved.
   6  *
   7  * tfcrypt is licensed to you under the terms of std. MIT/X11 license:
   8  *
   9  * Permission is hereby granted, free of charge, to any person obtaining
  10  * a copy of this software and associated documentation files (the
  11  * "Software"), to deal in the Software without restriction, including
  12  * without limitation the rights to use, copy, modify, merge, publish,
  13  * distribute, sublicense, and/or sell copies of the Software, and to
  14  * permit persons to whom the Software is furnished to do so, subject to
  15  * the following conditions:
  16  *
  17  * The above copyright notice and this permission notice shall be
  18  * included in all copies or substantial portions of the Software.
  19  *
  20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  21  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  22  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
  23  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
  24  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
  25  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
  26  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  27  */
  28
  29 #include "tfcrypt.h"
  30
  31 size_t blk_len_adj(tfc_fsize filelen, tfc_fsize read_already, size_t blklen)
  32 {
  33         if (filelen == NOFSIZE) return blklen;
  34         return ((filelen - read_already) >= blklen) ? blklen : (filelen - read_already);
  35 }
  36
  37 tfc_yesno xor_shrink(void *dst, size_t szdst, const void *src, size_t szsrc)
  38 {
  39         unsigned char *udst = dst;
  40         const unsigned char *usrc = src;
  41         size_t x, y;
  42
  43         if ((szsrc % szdst) != 0) return NO;
  44         if (szdst >= szsrc) {
  45                 if (szdst == szsrc) {
  46                         memmove(dst, src, szsrc);
  47                         return YES;
  48                 }
  49                 return NO;
  50         }
  51
  52         memset(dst, 0, szdst);
  53         for (x = 0; x < (szsrc / szdst); x++) {
  54                 for (y = 0; y < szdst; y++) udst[y] ^= usrc[(x*szdst)+y];
  55         }
  56
  57         return YES;
  58 }
  59
  60 tfc_yesno str_empty(const char *str)
  61 {
  62         if (!*str) return YES;
  63         return NO;
  64 }
  65
  66 int xxopen(tfc_yesno noerr, const char *pathname, int flags)
  67 {
  68         int r;
  69
  70         if ((flags & O_WRONLY || flags & O_RDWR)) {
  71                 if (read_only == YES) flags = O_RDONLY;
  72                 else flags |= write_flags;
  73         }
  74
  75         flags |= O_LARGEFILE;
  76         r = open(pathname, flags, 0666);
  77         if (noerr == NO && r == -1) xerror(NO, NO, YES, "%s", pathname);
  78         return r;
  79 }
  80
  81 int xopen(const char *pathname, int flags)
  82 {
  83         return xxopen(NO, pathname, flags);
  84 }
  85
  86 void xclose(int fd)
  87 {
  88         if (fd < 3) return;
  89         if (close(fd) == -1) xerror(YES, NO, NO, "close(%d)", fd);
  90 }
  91
  92 const char *tfc_modename(int mode)
  93 {
  94         switch (mode) {
  95                 case TFC_MODE_CTR: return "CTR";
  96                 case TFC_MODE_STREAM: return "STREAM";
  97                 case TFC_MODE_XTS: return "XTS";
  98                 case TFC_MODE_ECB: return "ECB";
  99                 case TFC_MODE_CBC: return "CBC";
 100                 case TFC_MODE_PCBC: return "PCBC";
 101         }
 102
 103         return NULL;
 104 }
 105
 106 tfc_yesno tfc_is_freestream(int mode)
 107 {
 108         switch (mode) {
 109                 case TFC_MODE_PLAIN:
 110                 case TFC_MODE_STREAM: return YES;
 111         }
 112
 113         return NO;
 114 }
 115
 116 void tfc_getcurtime(tfc_useconds *tx)
 117 {
 118         struct timespec t;
 119         memset(&t, 0, sizeof(t));
 120
 121         clock_gettime(CLOCK_MONOTONIC, &t);
 122         *tx = (tfc_useconds)t.tv_sec * 1000000 + (t.tv_nsec / 1000);
 123
 124         memset(&t, 0, sizeof(t));
 125 }
 126
 127 char *tfc_format_time(tfc_useconds t)
 128 {
 129         tfc_useconds secs, dsecs;
 130         unsigned days, hours, minutes, seconds;
 131         static char r[128];
 132
 133         secs = (tfc_useconds)TFC_UTODSECS(t);
 134         dsecs = (tfc_useconds)(t - (secs * 1000000));
 135
 136         days = secs / 86400;
 137         hours = (secs / 3600) % 24;
 138         minutes = (secs / 60) % 60;
 139         seconds = secs % 60;
 140
 141         if (days > 0) sprintf(r, "%ud,%02u:%02u:%02u.%04u", days, hours, minutes, seconds, (unsigned)(dsecs / 100));
 142         else if (hours > 0) sprintf(r, "%02u:%02u:%02u.%04u", hours, minutes, seconds, (unsigned)(dsecs / 100));
 143         else if (minutes > 0) sprintf(r, "%02u:%02u.%04u", minutes, seconds, (unsigned)(dsecs / 100));
 144         else sprintf(r, "%02u.%04u", seconds, (unsigned)(dsecs / 100));
 145
 146         return r;
 147 }
 148
 149 char *tfc_format_pid(const char *str)
 150 {
 151         static char r[128];
 152         size_t n;
 153
 154         n = xstrlcpy(r, str, sizeof(r));
 155         if (show_pid == YES && sizeof(r)-n >= 22) sprintf(r+n, "[%lu]", (unsigned long)progpid);
 156
 157         return r;
 158 }
 159
 160 tfc_fsize tfc_fdsize(int fd)
 161 {
 162         off_t l, cur;
 163
 164         cur = lseek(fd, 0L, SEEK_CUR);
 165         l = lseek(fd, 0L, SEEK_SET);
 166         if (l == -1) return NOFSIZE;
 167         l = lseek(fd, 0L, SEEK_END);
 168         if (l == -1) return NOFSIZE;
 169         lseek(fd, cur, SEEK_SET);
 170
 171         return (tfc_fsize)l;
 172 }
 173
 174 tfc_fsize tfc_fdgetpos(int fd)
 175 {
 176         off_t t;
 177
 178         t = lseek(fd, 0L, SEEK_CUR);
 179         if (t == (off_t)-1) return NOFSIZE;
 180         return (tfc_fsize)t;
 181 }
 182
 183 tfc_fsize tfc_fnamesize(char *fname, tfc_yesno noexit)
 184 {
 185         int fnmfd;
 186         tfc_fsize ret;
 187         char *s, T[2];
 188
 189         if (!fname) return 0;
 190
 191         s = strchr(fname, ':');
 192         if (s && s[1] && (s[1] == '+' || s[1] == '-' || s[1] == '*' || s[1] == '/')) {
 193                 memcpy(T, s, 2);
 194                 memset(s, 0, 2);
 195         }
 196
 197         fnmfd = xxopen(YES, fname, O_RDONLY);
 198         if (s) memcpy(s, T, 2);
 199         if (fnmfd == -1) {
 200                 xerror(noexit, NO, YES, "%s", fname);
 201                 return NOFSIZE;
 202         }
 203         ret = tfc_fdsize(fnmfd);
 204         if (ret == NOFSIZE) {
 205                 xerror(noexit, NO, YES, "%s: not a seekable file", fname);
 206                 return ret;
 207         }
 208         xclose(fnmfd);
 209
 210         return ret;
 211 }
 212
 213 tfc_fsize tfc_modifysize(tfc_fsize szmodify, const char *szspec)
 214 {
 215         tfc_fsize t;
 216         const char *s;
 217         char *stoi, c;
 218
 219         if (szmodify == NOFSIZE) return NOFSIZE;
 220         if (!szspec) return szmodify;
 221         s = szspec;
 222
 223         if (*s != ':') return szmodify;
 224         s++;
 225         if (!(*s == '+' || *s == '-' || *s == '*' || *s == '/')) return szmodify;
 226         c = *s;
 227         s++;
 228         if (strchr(s, '/') || strchr(s, '.')) return szmodify;
 229
 230         t = tfc_humanfsize(s, &stoi);
 231         if (!str_empty(stoi)) return szmodify;
 232
 233         switch (c) {
 234                 case '+': szmodify += t; break;
 235                 case '-': szmodify -= t; break;
 236                 case '*': szmodify *= t; break;
 237                 case '/': szmodify /= t; break;
 238                 default: break;
 239         }
 240
 241         return szmodify;
 242 }
 243
 244 void fcopy_matime(int fd, const struct stat *st)
 245 {
 246         struct timeval times[2];
 247
 248         times[1].tv_sec = times[0].tv_sec = st->st_mtime;
 249         times[1].tv_usec = times[0].tv_usec = 0;
 250         if (futimes(fd, times) == -1) xerror(YES, NO, YES, "futimes(%d)", fd);
 251 }
 252
 253 static void char_to_nul(char *s, size_t l, int c)
 254 {
 255         while (*s && l) { if (*s == c) { *s = 0; break; } s++; l--; }
 256 }
 257
 258 tfc_yesno xfgets(char *s, size_t n, FILE *f)
 259 {
 260         memset(s, 0, n);
 261
 262         if (fgets(s, (int)n, f) == s) {
 263                 char_to_nul(s, n, '\n');
 264                 return YES;
 265         }
 266
 267         return NO;
 268 }
 269
 270 tfc_yesno isbase64(const char *s)
 271 {
 272         while (*s) {
 273                 if (*s >= 'g' && *s <= 'z') return YES;
 274                 if (*s >= 'G' && *s <= 'Z') return YES;
 275                 if (*s == '+' || *s == '/' || *s == '=') return YES;
 276                 s++;
 277         }
 278         return NO;
 279 }
 280
 281 static int chrbin(char x)
 282 {
 283         if (x >= '0' && x <= '9')
 284                 return x - '0';
 285         if (x >= 'A' && x <= 'F')
 286                 return x - 'A' + 10;
 287         if (x >= 'a' && x <= 'f')
 288                 return x - 'a' + 10;
 289         return 0;
 290 }
 291
 292 void hex2bin(void *d, const char *s)
 293 {
 294         const char *S = s;
 295         char *D = d;
 296         int x = 0;
 297
 298         while (*s) {
 299                 if ((s-S) % 2) {
 300                         x = (x << 4) ^ chrbin(*s);
 301                         *D = x; D++;
 302                 }
 303                 else x = chrbin(*s);
 304                 s++;
 305         }
 306 }