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_OCB: return "OCB";
 101         }
 102
 103         return NULL;
 104 }
 105
 106 void tfc_getcurtime(tfc_useconds *tx)
 107 {
 108         struct timespec t;
 109         memset(&t, 0, sizeof(t));
 110
 111         clock_gettime(CLOCK_MONOTONIC, &t);
 112         *tx = (tfc_useconds)t.tv_sec * 1000000 + (t.tv_nsec / 1000);
 113
 114         memset(&t, 0, sizeof(t));
 115 }
 116
 117 char *tfc_format_time(tfc_useconds t)
 118 {
 119         tfc_useconds secs, dsecs;
 120         unsigned days, hours, minutes, seconds;
 121         static char r[128];
 122
 123         secs = (tfc_useconds)TFC_UTODSECS(t);
 124         dsecs = (tfc_useconds)(t - (secs * 1000000));
 125
 126         days = secs / 86400;
 127         hours = (secs / 3600) % 24;
 128         minutes = (secs / 60) % 60;
 129         seconds = secs % 60;
 130
 131         if (days > 0) sprintf(r, "%ud,%02u:%02u:%02u.%04u", days, hours, minutes, seconds, (unsigned)(dsecs / 100));
 132         else if (hours > 0) sprintf(r, "%02u:%02u:%02u.%04u", hours, minutes, seconds, (unsigned)(dsecs / 100));
 133         else if (minutes > 0) sprintf(r, "%02u:%02u.%04u", minutes, seconds, (unsigned)(dsecs / 100));
 134         else sprintf(r, "%02u.%04u", seconds, (unsigned)(dsecs / 100));
 135
 136         return r;
 137 }
 138
 139 char *tfc_format_pid(const char *str)
 140 {
 141         static char r[128];
 142         size_t n;
 143
 144         n = xstrlcpy(r, str, sizeof(r));
 145         if (show_pid == YES && sizeof(r)-n >= 22) sprintf(r+n, "[%lu]", (unsigned long)progpid);
 146
 147         return r;
 148 }
 149
 150 tfc_fsize tfc_fdsize(int fd)
 151 {
 152         off_t l, cur;
 153
 154         cur = lseek(fd, 0L, SEEK_CUR);
 155         l = lseek(fd, 0L, SEEK_SET);
 156         if (l == -1) return NOFSIZE;
 157         l = lseek(fd, 0L, SEEK_END);
 158         if (l == -1) return NOFSIZE;
 159         lseek(fd, cur, SEEK_SET);
 160
 161         return (tfc_fsize)l;
 162 }
 163
 164 tfc_fsize tfc_fdgetpos(int fd)
 165 {
 166         off_t t;
 167
 168         t = lseek(fd, 0L, SEEK_CUR);
 169         if (t == (off_t)-1) return NOFSIZE;
 170         return (tfc_fsize)t;
 171 }
 172
 173 tfc_fsize tfc_fnamesize(char *fname, tfc_yesno noexit)
 174 {
 175         int fnmfd;
 176         tfc_fsize ret;
 177         char *s, T[2];
 178
 179         if (!fname) return 0;
 180
 181         s = strchr(fname, ':');
 182         if (s && s[1] && (s[1] == '+' || s[1] == '-' || s[1] == '*' || s[1] == '/')) {
 183                 memcpy(T, s, 2);
 184                 memset(s, 0, 2);
 185         }
 186
 187         fnmfd = xxopen(YES, fname, O_RDONLY);
 188         if (s) memcpy(s, T, 2);
 189         if (fnmfd == -1) {
 190                 xerror(noexit, NO, YES, "%s", fname);
 191                 return NOFSIZE;
 192         }
 193         ret = tfc_fdsize(fnmfd);
 194         if (ret == NOFSIZE) {
 195                 xerror(noexit, NO, YES, "%s: not a seekable file", fname);
 196                 return ret;
 197         }
 198         xclose(fnmfd);
 199
 200         return ret;
 201 }
 202
 203 tfc_fsize tfc_modifysize(tfc_fsize szmodify, const char *szspec)
 204 {
 205         tfc_fsize t;
 206         const char *s;
 207         char *stoi, c;
 208
 209         if (szmodify == NOFSIZE) return NOFSIZE;
 210         if (!szspec) return szmodify;
 211         s = szspec;
 212
 213         if (*s != ':') return szmodify;
 214         s++;
 215         if (!(*s == '+' || *s == '-' || *s == '*' || *s == '/')) return szmodify;
 216         c = *s;
 217         s++;
 218         if (strchr(s, '/') || strchr(s, '.')) return szmodify;
 219
 220         t = tfc_humanfsize(s, &stoi);
 221         if (!str_empty(stoi)) return szmodify;
 222
 223         switch (c) {
 224                 case '+': szmodify += t; break;
 225                 case '-': szmodify -= t; break;
 226                 case '*': szmodify *= t; break;
 227                 case '/': szmodify /= t; break;
 228                 default: break;
 229         }
 230
 231         return szmodify;
 232 }
 233
 234 void fcopy_matime(int fd, const struct stat *st)
 235 {
 236         struct timeval times[2];
 237
 238         times[1].tv_sec = times[0].tv_sec = st->st_mtime;
 239         times[1].tv_usec = times[0].tv_usec = 0;
 240         if (futimes(fd, times) == -1) xerror(YES, NO, YES, "futimes(%d)", fd);
 241 }
 242
 243 static void char_to_nul(char *s, size_t l, int c)
 244 {
 245         while (*s && l) { if (*s == c) { *s = 0; break; } s++; l--; }
 246 }
 247
 248 tfc_yesno xfgets(char *s, size_t n, FILE *f)
 249 {
 250         memset(s, 0, n);
 251
 252         if (fgets(s, (int)n, f) == s) {
 253                 char_to_nul(s, n, '\n');
 254                 return YES;
 255         }
 256
 257         return NO;
 258 }
 259
 260 tfc_yesno isbase64(const char *s)
 261 {
 262         while (*s) {
 263                 if (*s >= 'g' && *s <= 'z') return YES;
 264                 if (*s >= 'G' && *s <= 'Z') return YES;
 265                 if (*s == '+' || *s == '/' || *s == '=') return YES;
 266                 s++;
 267         }
 268         return NO;
 269 }
 270
 271 static int chrbin(char x)
 272 {
 273         if (x >= '0' && x <= '9')
 274                 return x - '0';
 275         if (x >= 'A' && x <= 'F')
 276                 return x - 'A' + 10;
 277         if (x >= 'a' && x <= 'f')
 278                 return x - 'a' + 10;
 279         return 0;
 280 }
 281
 282 void hex2bin(void *d, const char *s)
 283 {
 284         const char *S = s;
 285         char *D = d;
 286         int x = 0;
 287
 288         while (*s) {
 289                 if ((s-S) % 2) {
 290                         x = (x << 4) ^ chrbin(*s);
 291                         *D = x; D++;
 292                 }
 293                 else x = chrbin(*s);
 294                 s++;
 295         }
 296 }