Refactor scan options check.

[libsigrok.git] / src / serial.c

diff --git a/src/serial.c b/src/serial.c
index 37463573256f26c0c750d789ac931566968ecd69..192b18a7245a4caffa17eb3a23ab3801bd16c33e 100644 (file)
--- a/src/serial.c
+++ b/src/serial.c
@@ -4,6 +4,7 @@
  * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
  * Copyright (C) 2010-2012 Uwe Hermann <uwe@hermann-uwe.de>
  * Copyright (C) 2012 Alexandru Gagniuc <mr.nuke.me@gmail.com>
+ * Copyright (C) 2014 Uffe Jakobsen <uffe@uffe.org>
  *
  * 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
@@ -169,6 +170,44 @@ SR_PRIV int serial_flush(struct sr_serial_dev_inst *serial)
        return SR_OK;
 }
 
+/**
+ * Drain serial port buffers.
+ *
+ * @param serial Previously initialized serial port structure.
+ *
+ * @retval SR_OK Success.
+ * @retval SR_ERR Failure.
+ */
+SR_PRIV int serial_drain(struct sr_serial_dev_inst *serial)
+{
+       int ret;
+       char *error;
+
+       if (!serial) {
+               sr_dbg("Invalid serial port.");
+               return SR_ERR;
+       }
+
+       if (!serial->data) {
+               sr_dbg("Cannot drain unopened serial port %s.", serial->port);
+               return SR_ERR;
+       }
+
+       sr_spew("Draining serial port %s.", serial->port);
+
+       ret = sp_drain(serial->data);
+
+       if (ret == SP_ERR_FAIL) {
+               error = sp_last_error_message();
+               sr_err("Error draining port (%d): %s.",
+                       sp_last_error_code(), error);
+               sp_free_error_message(error);
+               return SR_ERR;
+       }
+
+       return SR_OK;
+}
+
 static int _serial_write(struct sr_serial_dev_inst *serial,
                const void *buf, size_t count, int nonblocking, unsigned int timeout_ms)
 {