#include <sys/param.h>
#if defined(__DragonFly__)
#include <sys/diskslice.h>
#elif defined(__linux__)
#include <linux/fs.h>
#include <sys/ioctl.h>
#endif
#include <sys/stat.h>
#include <sys/uio.h>
#include <sys/select.h>
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <termios.h>
#include <unistd.h>
#include <signal.h>
#include "tcplay.h"
void *
read_to_safe_mem(const char *file, off_t offset, size_t *sz)
{
void *mem = NULL;
ssize_t r = 0;
int fd;
if ((fd = open(file, O_RDONLY)) < 0) {
tc_log(1, "Error opening file %s\n", file);
return NULL;
}
if ((mem = alloc_safe_mem(*sz)) == NULL) {
tc_log(1, "Error allocating memory\n");
goto out;
}
if ((lseek(fd, offset, (offset >= 0) ? SEEK_SET : SEEK_END) < 0)) {
tc_log(1, "Error seeking on file %s\n", file);
goto m_err;
}
if ((r = read(fd, mem, *sz)) <= 0) {
tc_log(1, "Error reading from file %s\n", file);
goto m_err;
}
out:
*sz = r;
close(fd);
return mem;
m_err:
free_safe_mem(mem);
close(fd);
return NULL;
}
static size_t get_random_total_bytes = 0;
static size_t get_random_read_bytes = 0;
float
get_random_read_progress(void)
{
return (get_random_total_bytes == 0) ? 0.0 :
(1.0 * get_random_read_bytes) /
(1.0 * get_random_total_bytes) * 100.0;
}
static
void
get_random_summary(void)
{
float pct_done = get_random_read_progress();
tc_log(0, "Gathering true randomness, %.0f%% done.\n", pct_done);
}
int
get_random(unsigned char *buf, size_t len, int weak)
{
int fd;
ssize_t r;
size_t rd = 0;
size_t sz;
struct timespec ts = { .tv_sec = 0, .tv_nsec = 10000000 };
if ((fd = open((weak) ? "/dev/urandom" : "/dev/random", O_RDONLY)) < 0) {
tc_log(1, "Error opening /dev/random\n");
return -1;
}
summary_fn = get_random_summary;
get_random_total_bytes = len;
tc_internal_state = STATE_GET_RANDOM;
sz = 16;
while (rd < len) {
get_random_read_bytes = rd;
if ((len - rd) < sz)
sz = (len - rd);
if ((r = read(fd, buf+rd, sz)) < 0) {
tc_log(1, "Error reading from /dev/random(%d): %s\n",
fd, strerror(errno));
close(fd);
summary_fn = NULL;
tc_internal_state = STATE_UNKNOWN;
return -1;
}
rd += r;
nanosleep(&ts, NULL);
}
close(fd);
summary_fn = NULL;
tc_internal_state = STATE_UNKNOWN;
return 0;
}
static disksz_t secure_erase_total_bytes = 0;
static disksz_t secure_erase_erased_bytes = 0;
float
get_secure_erase_progress(void)
{
return (secure_erase_total_bytes == 0) ? 0.0 :
(1.0 * secure_erase_erased_bytes) /
(1.0 * secure_erase_total_bytes) * 100.0;
}
static
void
secure_erase_summary(void)
{
float pct_done = get_secure_erase_progress();
tc_log(0, "Securely erasing, %.0f%% done.\n", pct_done);
}
int
secure_erase(const char *dev, disksz_t bytes, size_t blksz)
{
size_t erased = 0;
int fd_rand, fd;
char buf[ERASE_BUFFER_SIZE];
ssize_t r, w;
size_t sz;
if (blksz > MAX_BLKSZ) {
tc_log(1, "blksz > MAX_BLKSZ\n");
return -1;
}
if ((fd_rand = open("/dev/urandom", O_RDONLY)) < 0) {
tc_log(1, "Error opening /dev/urandom\n");
return -1;
}
if ((fd = open(dev, O_WRONLY)) < 0) {
close(fd_rand);
tc_log(1, "Error opening %s\n", dev);
return -1;
}
summary_fn = secure_erase_summary;
secure_erase_total_bytes = bytes;
tc_internal_state = STATE_ERASE;
sz = ERASE_BUFFER_SIZE;
while (erased < bytes) {
secure_erase_erased_bytes = erased;
if ((bytes - erased) <= ERASE_BUFFER_SIZE)
sz = blksz;
if ((r = read(fd_rand, buf, sz)) < 0) {
tc_log(1, "Error reading from /dev/urandom\n");
close(fd);
close(fd_rand);
summary_fn = NULL;
tc_internal_state = STATE_UNKNOWN;
return -1;
}
if (r < (ssize_t)blksz)
continue;
if ((w = write(fd, buf, r)) < 0) {
tc_log(1, "Error writing to %s\n", dev);
close(fd);
close(fd_rand);
summary_fn = NULL;
tc_internal_state = STATE_UNKNOWN;
return -1;
}
erased += (size_t)w;
}
close(fd);
close(fd_rand);
summary_fn = NULL;
tc_internal_state = STATE_UNKNOWN;
return 0;
}
#if defined(__DragonFly__)
int
get_disk_info(const char *dev, disksz_t *blocks, size_t *bsize)
{
struct partinfo pinfo;
int fd;
if ((fd = open(dev, O_RDONLY)) < 0) {
tc_log(1, "Error opening %s\n", dev);
return -1;
}
memset(&pinfo, 0, sizeof(struct partinfo));
if (ioctl(fd, DIOCGPART, &pinfo) < 0) {
close(fd);
return -1;
}
*blocks = (disksz_t)pinfo.media_blocks;
*bsize = pinfo.media_blksize;
close(fd);
return 0;
}
#elif defined(__linux__)
int
get_disk_info(const char *dev, disksz_t *blocks, size_t *bsize)
{
uint64_t nbytes;
int blocksz;
int fd;
if ((fd = open(dev, O_RDONLY)) < 0) {
tc_log(1, "Error opening %s\n", dev);
return -1;
}
if ((ioctl(fd, BLKSSZGET, &blocksz)) < 0) {
close(fd);
return -1;
}
if ((ioctl(fd, BLKGETSIZE64, &nbytes)) < 0) {
close(fd);
return -1;
}
*blocks = (disksz_t)(nbytes / blocksz);
*bsize = (size_t)(blocksz);
close(fd);
return 0;
}
#endif
int
write_to_disk(const char *dev, off_t offset, size_t blksz, void *mem,
size_t bytes)
{
unsigned char *mem_buf = NULL;
ssize_t w;
size_t sz;
off_t internal_off;
int fd;
internal_off = offset % blksz;
#ifdef DEBUG
printf("offset: %"PRIu64", internal offset: %"PRIu64"\n",
(uint64_t)offset, (uint64_t)internal_off);
#endif
offset = rounddown(offset, blksz);
if ((internal_off + bytes) > blksz) {
tc_log(1, "This should never happen: internal_off + bytes > "
"blksz (write_to_disk)\n");
return -1;
}
if ((bytes < blksz) || (internal_off != 0)) {
sz = blksz;
if ((mem_buf = read_to_safe_mem(dev, offset, &sz)) == NULL) {
tc_log(1, "Error buffering data on "
"write_to_disk(%s)\n", dev);
return -1;
}
memcpy(mem_buf + internal_off, mem, bytes);
}
if ((fd = open(dev, O_WRONLY)) < 0) {
tc_log(1, "Error opening device %s\n", dev);
return -1;
}
if ((lseek(fd, offset, (offset >= 0) ? SEEK_SET : SEEK_END) < 0)) {
tc_log(1, "Error seeking on device %s\n", dev);
close(fd);
return -1;
}
if ((w = write(fd, (mem_buf != NULL) ? mem_buf : mem, bytes)) <= 0) {
tc_log(1, "Error writing to device %s\n", dev);
close(fd);
return -1;
}
close(fd);
if (mem_buf != NULL)
free_safe_mem(mem_buf);
return 0;
}
int
write_to_file(const char *file, void *mem, size_t bytes)
{
int fd;
ssize_t w;
if ((fd = open(file, O_WRONLY | O_CREAT, S_IRUSR | S_IWUSR)) < 0) {
tc_log(1, "Error opening file %s\n", file);
return -1;
}
if ((w = write(fd, mem, bytes)) < 0) {
tc_log(1, "Error writing to file %s\n", file);
close(fd);
return -1;
}
close(fd);
return 0;
}
static struct termios termios_old;
static int tty_fd;
static void sigint_termios(int sa)
{
tcsetattr(tty_fd, TCSAFLUSH, &termios_old);
exit(sa);
}
int
read_passphrase(const char *prompt, char *pass, size_t passlen, size_t bufsz, time_t timeout)
{
struct termios termios_new;
struct timeval to;
fd_set fds;
ssize_t n;
int fd = STDIN_FILENO, r = 0, nready;
struct sigaction act, old_act;
int is_tty = isatty(fd);
if (is_tty == 0)
errno = 0;
memset(pass, 0, bufsz);
printf("%s", prompt);
fflush(stdout);
if (is_tty) {
tcgetattr(fd, &termios_old);
memcpy(&termios_new, &termios_old, sizeof(termios_new));
termios_new.c_lflag &= ~ECHO;
act.sa_handler = sigint_termios;
act.sa_flags = SA_RESETHAND;
sigemptyset(&act.sa_mask);
tty_fd = fd;
sigaction(SIGINT, &act, &old_act);
tcsetattr(fd, TCSAFLUSH, &termios_new);
}
if (timeout > 0) {
memset(&to, 0, sizeof(to));
to.tv_sec = timeout;
FD_ZERO(&fds);
FD_SET(fd, &fds);
nready = select(fd + 1, &fds, NULL, NULL, &to);
if (nready <= 0) {
r = EINTR;
goto out;
}
}
n = read(fd, pass, bufsz-1);
if (n > 0) {
pass[n-1] = '\0';
} else {
r = EIO;
}
if (strlen(pass) > MAX_PASSSZ)
tc_log(0, "WARNING: Passphrase is being trimmed to %zu "
"characters, discarding rest.\n", passlen);
pass[passlen] = '\0';
out:
if (is_tty) {
tcsetattr(fd, TCSAFLUSH, &termios_old);
putchar('\n');
sigaction(SIGINT, &old_act, NULL);
}
return r;
}