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