mirror of
https://github.com/tio/tio.git
synced 2026-05-01 14:57:59 +02:00
132 lines
3.5 KiB
C
132 lines
3.5 KiB
C
/*
|
|
* tio - a simple serial terminal I/O tool
|
|
*
|
|
* Copyright (c) 2014-2022 Martin Lund
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
|
* 02110-1301, USA.
|
|
*/
|
|
|
|
#include "config.h"
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <time.h>
|
|
#include <sys/time.h>
|
|
#include <errno.h>
|
|
#include "error.h"
|
|
#include "print.h"
|
|
#include "options.h"
|
|
|
|
#define TIME_STRING_SIZE_MAX 24
|
|
|
|
char *current_time(void)
|
|
{
|
|
static char time_string[TIME_STRING_SIZE_MAX];
|
|
static struct timeval tv, tv_now, tv_start, tv_previous;
|
|
static bool first = true;
|
|
struct tm *tm;
|
|
size_t len;
|
|
|
|
// Get current time value
|
|
gettimeofday(&tv_now, NULL);
|
|
|
|
if (first)
|
|
{
|
|
tv_start = tv_now;
|
|
first = false;
|
|
}
|
|
|
|
// Add formatted timestap
|
|
switch (option.timestamp)
|
|
{
|
|
case TIMESTAMP_NONE:
|
|
case TIMESTAMP_24HOUR:
|
|
// "hh:mm:ss.sss" (24 hour format)
|
|
tv = tv_now;
|
|
tm = localtime(&tv.tv_sec);
|
|
len = strftime(time_string, sizeof(time_string), "%H:%M:%S", tm);
|
|
break;
|
|
case TIMESTAMP_24HOUR_START:
|
|
// "hh:mm:ss.sss" (24 hour format relative to start time)
|
|
timersub(&tv_now, &tv_start, &tv);
|
|
tv.tv_sec -= 3600; // Why is this needed??
|
|
tm = localtime(&tv.tv_sec);
|
|
len = strftime(time_string, sizeof(time_string), "%H:%M:%S", tm);
|
|
break;
|
|
case TIMESTAMP_24HOUR_DELTA:
|
|
// "hh:mm:ss.sss" (24 hour format relative to previous time stamp)
|
|
timersub(&tv_now, &tv_previous, &tv);
|
|
tv.tv_sec -= 3600; // Why is this needed??
|
|
tm = localtime(&tv.tv_sec);
|
|
len = strftime(time_string, sizeof(time_string), "%H:%M:%S", tm);
|
|
break;
|
|
case TIMESTAMP_ISO8601:
|
|
// "YYYY-MM-DDThh:mm:ss.sss" (ISO-8601)
|
|
tv = tv_now;
|
|
tm = localtime(&tv.tv_sec);
|
|
len = strftime(time_string, sizeof(time_string), "%Y-%m-%dT%H:%M:%S", tm);
|
|
break;
|
|
default:
|
|
return NULL;
|
|
}
|
|
|
|
// Append milliseconds to all timestamps
|
|
if (len)
|
|
{
|
|
len = snprintf(time_string + len, TIME_STRING_SIZE_MAX - len, ".%03ld", (long)tv.tv_usec / 1000);
|
|
}
|
|
|
|
// Save previous time value for next run
|
|
tv_previous = tv_now;
|
|
|
|
return (len < TIME_STRING_SIZE_MAX) ? time_string : NULL;
|
|
}
|
|
|
|
void delay(long ms)
|
|
{
|
|
struct timespec ts;
|
|
|
|
ts.tv_sec = ms / 1000;
|
|
ts.tv_nsec = (ms % 1000) * 1000000;
|
|
|
|
nanosleep(&ts, NULL);
|
|
}
|
|
|
|
long string_to_long(char *string)
|
|
{
|
|
long result;
|
|
char *end_token;
|
|
|
|
errno = 0;
|
|
result = strtol(string, &end_token, 10);
|
|
if ((errno != 0) || (*end_token != 0))
|
|
{
|
|
printf("Error: Invalid digit\n");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
int ctrl_key_code(unsigned char key)
|
|
{
|
|
if ((key >= 'a') && (key <= 'z'))
|
|
{
|
|
return key & ~0x60;
|
|
}
|
|
|
|
return -1;
|
|
}
|