Use mach_absolute_time() on OSX without clock_gettime().

[libserialport.git] / serialport.c

diff --git a/serialport.c b/serialport.c
index 74d46eede7953d7ac0c761c18001cd0a3a102ffe..6e681533ed24896a33de59f7e17597a4f0bf5082 100644 (file)
--- a/serialport.c
+++ b/serialport.c
@@ -49,12 +49,33 @@ static const struct std_baudrate std_baudrates[] = {
 
 void (*sp_debug_handler)(const char *format, ...) = sp_default_debug_handler;
 
+static void get_time(struct timeval *time);
+
 static enum sp_return get_config(struct sp_port *port, struct port_data *data,
        struct sp_port_config *config);
 
 static enum sp_return set_config(struct sp_port *port, struct port_data *data,
        const struct sp_port_config *config);
 
+static void get_time(struct timeval *time)
+{
+#ifdef HAVE_CLOCK_GETTIME
+       struct timespec ts;
+       clock_gettime(CLOCK_MONOTONIC, &ts);
+       time->tv_sec = ts.tv_sec;
+       time->tv_usec = ts.tv_nsec / 1000;
+#elif defined(__APPLE__)
+       mach_timebase_info_data_t info;
+       mach_timebase_info(&info);
+       uint64_t ticks = mach_absolute_time();
+       uint64_t ns = (ticks * info.numer) / info.denom;
+       time->tv_sec = ns / 1000000000;
+       time->tv_usec = (ns % 1000000000) / 1000;
+#else
+       gettimeofday(time, NULL);
+#endif
+}
+
 SP_API enum sp_return sp_get_port_by_name(const char *portname, struct sp_port **port_ptr)
 {
        struct sp_port *port;
@@ -826,7 +847,7 @@ SP_API enum sp_return sp_blocking_write(struct sp_port *port, const void *buf,
 
        if (timeout_ms) {
                /* Get time at start of operation. */
-               gettimeofday(&start, NULL);
+               get_time(&start);
                /* Define duration of timeout. */
                delta.tv_sec = timeout_ms / 1000;
                delta.tv_usec = (timeout_ms % 1000) * 1000;
@@ -845,7 +866,7 @@ SP_API enum sp_return sp_blocking_write(struct sp_port *port, const void *buf,
                 * select() is even run.
                 */
                if (timeout_ms && started) {
-                       gettimeofday(&now, NULL);
+                       get_time(&now);
                        if (timercmp(&now, &end, >))
                                /* Timeout has expired. */
                                break;
@@ -1046,7 +1067,7 @@ SP_API enum sp_return sp_blocking_read(struct sp_port *port, void *buf,
 
        if (timeout_ms) {
                /* Get time at start of operation. */
-               gettimeofday(&start, NULL);
+               get_time(&start);
                /* Define duration of timeout. */
                delta.tv_sec = timeout_ms / 1000;
                delta.tv_usec = (timeout_ms % 1000) * 1000;
@@ -1065,7 +1086,7 @@ SP_API enum sp_return sp_blocking_read(struct sp_port *port, void *buf,
                 * select() is even run.
                 */
                if (timeout_ms && started) {
-                       gettimeofday(&now, NULL);
+                       get_time(&now);
                        if (timercmp(&now, &end, >))
                                /* Timeout has expired. */
                                break;
@@ -1183,7 +1204,7 @@ SP_API enum sp_return sp_blocking_read_next(struct sp_port *port, void *buf,
 
        if (timeout_ms) {
                /* Get time at start of operation. */
-               gettimeofday(&start, NULL);
+               get_time(&start);
                /* Define duration of timeout. */
                delta.tv_sec = timeout_ms / 1000;
                delta.tv_usec = (timeout_ms % 1000) * 1000;
@@ -1202,7 +1223,7 @@ SP_API enum sp_return sp_blocking_read_next(struct sp_port *port, void *buf,
                 * select() is even run.
                 */
                if (timeout_ms && started) {
-                       gettimeofday(&now, NULL);
+                       get_time(&now);
                        if (timercmp(&now, &end, >))
                                /* Timeout has expired. */
                                break;
@@ -1485,7 +1506,7 @@ SP_API enum sp_return sp_wait(struct sp_event_set *event_set,
 
        if (timeout_ms) {
                /* Get time at start of operation. */
-               gettimeofday(&start, NULL);
+               get_time(&start);
                /* Define duration of timeout. */
                delta.tv_sec = timeout_ms / 1000;
                delta.tv_usec = (timeout_ms % 1000) * 1000;
@@ -1506,7 +1527,7 @@ SP_API enum sp_return sp_wait(struct sp_event_set *event_set,
                        timeout_overflow = (timeout_ms > INT_MAX);
                        timeout_remaining_ms = timeout_overflow ? INT_MAX : timeout_ms;
                } else {
-                       gettimeofday(&now, NULL);
+                       get_time(&now);
                        if (timercmp(&now, &end, >)) {
                                DEBUG("Wait timed out");
                                break;