Myth/serial
1
0
Fork 0
mirror of https://github.com/wjwwood/serial.git synced 2026-01-23 04:04:54 +08:00
Code Issues Projects Releases Wiki Activity

Add MillisecondTimer class.

Browse Source
This commit is contained in:
Mike Purvis 2013-10-28 19:48:01 -04:00
parent dd7259149f
commit 16a024691b
2 changed files with 54 additions and 29 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
include/serial/impl/unix.h
View File

@ -53,6 +53,18 @@ using std::invalid_argument;
using serial::SerialException;
using serial::IOException;
class TimerExpiredException : public std::exception {};
class MillisecondTimer {
public:
MillisecondTimer(const uint32_t millis);
uint32_t remaining();
private:
static timespec now();
timespec timeout_time;
};
class serial::Serial::SerialImpl {
public:
SerialImpl (const string &port,

71
src/impl/unix.cc
View File

@ -48,12 +48,54 @@
using std::string;
using std::stringstream;
using std::invalid_argument;
using serial::MillisecondTimer;
using serial::Serial;
using serial::TimerExpiredException;
using serial::SerialException;
using serial::PortNotOpenedException;
using serial::IOException;
MillisecondTimer::MillisecondTimer (const uint32_t millis)
: timeout_time(now())
{
int64_t tv_nsec = timeout_time.tv_nsec + (millis * 1e6);
if (tv_nsec > 1e9) {
timeout_time.tv_nsec = tv_nsec % (int)1e6;
timeout_time.tv_sec += tv_nsec / (int)1e6;
}
}
uint32_t
MillisecondTimer::remaining ()
{
timespec now_time(now());
int64_t millis = (timeout_time.tv_sec - now_time.tv_sec) * 1e3;
millis += (timeout_time.tv_nsec - now_time.tv_nsec) / 1e6;
if (millis <= 0) {
throw TimerExpiredException();
}
return millis;
}
timespec
MillisecondTimer::now ()
{
timespec time;
# ifdef __MACH__ // OS X does not have clock_gettime, use clock_get_time
clock_serv_t cclock;
mach_timespec_t mts;
host_get_clock_service(mach_host_self(), CALENDAR_CLOCK, &cclock);
clock_get_time(cclock, &mts);
mach_port_deallocate(mach_task_self(), cclock);
time.tv_sec = mts.tv_sec;
time.tv_nsec = mts.tv_nsec;
# else
clock_gettime(CLOCK_REALTIME, &time);
# endif
return time;
}
Serial::SerialImpl::SerialImpl (const string &port, unsigned long baudrate,
bytesize_t bytesize,
parity_t parity, stopbits_t stopbits,
@ -404,35 +446,6 @@ Serial::SerialImpl::available ()
}
}
inline void
get_time_now (struct timespec &time)
{
# ifdef __MACH__ // OS X does not have clock_gettime, use clock_get_time
clock_serv_t cclock;
mach_timespec_t mts;
host_get_clock_service(mach_host_self(), CALENDAR_CLOCK, &cclock);
clock_get_time(cclock, &mts);
mach_port_deallocate(mach_task_self(), cclock);
time.tv_sec = mts.tv_sec;
time.tv_nsec = mts.tv_nsec;
# else
clock_gettime(CLOCK_REALTIME, &time);
# endif
}
inline void
diff_timespec (timespec &start, timespec &end, timespec &result) {
if (start.tv_sec > end.tv_sec) {
throw SerialException ("Timetravel, start time later than end time.");
}
result.tv_sec = end.tv_sec - start.tv_sec;
result.tv_nsec = end.tv_nsec - start.tv_nsec;
if (result.tv_nsec < 0) {
result.tv_nsec = 1e9 - result.tv_nsec;
result.tv_sec -= 1;
}
}
size_t
Serial::SerialImpl::read (uint8_t *buf, size_t size)
{