+SP_API void sp_free_event_set(struct sp_event_set *event_set)
+{
+ TRACE("%p", event_set);
+
+ if (!event_set) {
+ DEBUG("Null event set");
+ RETURN();
+ }
+
+ DEBUG("Freeing event set");
+
+ if (event_set->handles)
+ free(event_set->handles);
+ if (event_set->masks)
+ free(event_set->masks);
+
+ free(event_set);
+
+ RETURN();
+}
+
+SP_API enum sp_return sp_wait(struct sp_event_set *event_set,
+ unsigned int timeout_ms)
+{
+ TRACE("%p, %d", event_set, timeout_ms);
+
+ if (!event_set)
+ RETURN_ERROR(SP_ERR_ARG, "Null event set");
+
+#ifdef _WIN32
+ if (WaitForMultipleObjects(event_set->count, event_set->handles, FALSE,
+ timeout_ms ? timeout_ms : INFINITE) == WAIT_FAILED)
+ RETURN_FAIL("WaitForMultipleObjects() failed");
+
+ RETURN_OK();
+#else
+ struct timeout timeout;
+ int poll_timeout;
+ int result;
+ struct pollfd *pollfds;
+ unsigned int i;
+
+ if (!(pollfds = malloc(sizeof(struct pollfd) * event_set->count)))
+ RETURN_ERROR(SP_ERR_MEM, "pollfds malloc() failed");
+
+ for (i = 0; i < event_set->count; i++) {
+ pollfds[i].fd = ((int *)event_set->handles)[i];
+ pollfds[i].events = 0;
+ pollfds[i].revents = 0;
+ if (event_set->masks[i] & SP_EVENT_RX_READY)
+ pollfds[i].events |= POLLIN;
+ if (event_set->masks[i] & SP_EVENT_TX_READY)
+ pollfds[i].events |= POLLOUT;
+ if (event_set->masks[i] & SP_EVENT_ERROR)
+ pollfds[i].events |= POLLERR;
+ }
+
+ timeout_start(&timeout, timeout_ms);
+ timeout_limit(&timeout, INT_MAX);
+
+ /* Loop until an event occurs. */
+ while (1) {
+
+ if (timeout_check(&timeout)) {
+ DEBUG("Wait timed out");
+ break;
+ }
+
+ poll_timeout = (int) timeout_remaining_ms(&timeout);
+ if (poll_timeout == 0)
+ poll_timeout = -1;
+
+ result = poll(pollfds, event_set->count, poll_timeout);
+
+ timeout_update(&timeout);
+
+ if (result < 0) {
+ if (errno == EINTR) {
+ DEBUG("poll() call was interrupted, repeating");
+ continue;
+ } else {
+ free(pollfds);
+ RETURN_FAIL("poll() failed");
+ }
+ } else if (result == 0) {
+ DEBUG("poll() timed out");
+ if (!timeout.overflow)
+ break;
+ } else {
+ DEBUG("poll() completed");
+ break;
+ }
+ }
+
+ free(pollfds);
+ RETURN_OK();
+#endif
+}
+
+#ifdef USE_TERMIOS_SPEED
+static enum sp_return get_baudrate(int fd, int *baudrate)
+{
+ void *data;
+
+ TRACE("%d, %p", fd, baudrate);
+
+ DEBUG("Getting baud rate");
+
+ if (!(data = malloc(get_termios_size())))
+ RETURN_ERROR(SP_ERR_MEM, "termios malloc failed");
+
+ if (ioctl(fd, get_termios_get_ioctl(), data) < 0) {
+ free(data);
+ RETURN_FAIL("Getting termios failed");
+ }
+
+ *baudrate = get_termios_speed(data);
+
+ free(data);
+
+ RETURN_OK();
+}
+
+static enum sp_return set_baudrate(int fd, int baudrate)
+{
+ void *data;
+
+ TRACE("%d, %d", fd, baudrate);
+
+ DEBUG("Getting baud rate");
+
+ if (!(data = malloc(get_termios_size())))
+ RETURN_ERROR(SP_ERR_MEM, "termios malloc failed");
+
+ if (ioctl(fd, get_termios_get_ioctl(), data) < 0) {
+ free(data);
+ RETURN_FAIL("Getting termios failed");
+ }
+
+ DEBUG("Setting baud rate");
+
+ set_termios_speed(data, baudrate);
+
+ if (ioctl(fd, get_termios_set_ioctl(), data) < 0) {
+ free(data);
+ RETURN_FAIL("Setting termios failed");
+ }
+
+ free(data);
+
+ RETURN_OK();
+}
+#endif /* USE_TERMIOS_SPEED */
+
+#ifdef USE_TERMIOX
+static enum sp_return get_flow(int fd, struct port_data *data)
+{
+ void *termx;
+
+ TRACE("%d, %p", fd, data);
+
+ DEBUG("Getting advanced flow control");
+
+ if (!(termx = malloc(get_termiox_size())))
+ RETURN_ERROR(SP_ERR_MEM, "termiox malloc failed");
+
+ if (ioctl(fd, TCGETX, termx) < 0) {
+ free(termx);
+ RETURN_FAIL("Getting termiox failed");
+ }
+
+ get_termiox_flow(termx, &data->rts_flow, &data->cts_flow,
+ &data->dtr_flow, &data->dsr_flow);
+
+ free(termx);
+
+ RETURN_OK();
+}
+
+static enum sp_return set_flow(int fd, struct port_data *data)
+{
+ void *termx;
+
+ TRACE("%d, %p", fd, data);
+
+ DEBUG("Getting advanced flow control");
+
+ if (!(termx = malloc(get_termiox_size())))
+ RETURN_ERROR(SP_ERR_MEM, "termiox malloc failed");
+
+ if (ioctl(fd, TCGETX, termx) < 0) {
+ free(termx);
+ RETURN_FAIL("Getting termiox failed");
+ }
+
+ DEBUG("Setting advanced flow control");
+
+ set_termiox_flow(termx, data->rts_flow, data->cts_flow,
+ data->dtr_flow, data->dsr_flow);
+
+ if (ioctl(fd, TCSETX, termx) < 0) {
+ free(termx);
+ RETURN_FAIL("Setting termiox failed");
+ }
+
+ free(termx);
+
+ RETURN_OK();
+}
+#endif /* USE_TERMIOX */
+
+static enum sp_return get_config(struct sp_port *port, struct port_data *data,
+ struct sp_port_config *config)
+{
+ unsigned int i;
+
+ TRACE("%p, %p, %p", port, data, config);
+
+ DEBUG_FMT("Getting configuration for port %s", port->name);
+
+#ifdef _WIN32
+ if (!GetCommState(port->hdl, &data->dcb))
+ RETURN_FAIL("GetCommState() failed");
+
+ for (i = 0; i < NUM_STD_BAUDRATES; i++) {
+ if (data->dcb.BaudRate == std_baudrates[i].index) {
+ config->baudrate = std_baudrates[i].value;
+ break;
+ }
+ }
+
+ if (i == NUM_STD_BAUDRATES)
+ /* BaudRate field can be either an index or a custom baud rate. */
+ config->baudrate = data->dcb.BaudRate;
+
+ config->bits = data->dcb.ByteSize;
+
+ switch (data->dcb.Parity) {
+ case NOPARITY:
+ config->parity = SP_PARITY_NONE;