X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;f=serialport.c;h=7127cb36e532f369539af7f57c5d8199dc68af45;hb=70518e4fddf921fddf9af36f1b7aebeb9cd70a67;hp=269992e83a6cc2efe7ad85883c970ce384d870a3;hpb=067417af4fd8b619ed5ede2184cb450e35dc3ecd;p=libserialport.git diff --git a/serialport.c b/serialport.c index 269992e..7127cb3 100644 --- a/serialport.c +++ b/serialport.c @@ -4,6 +4,7 @@ * Copyright (C) 2010-2012 Bert Vermeulen * Copyright (C) 2010-2012 Uwe Hermann * Copyright (C) 2013 Martin Ling + * Copyright (C) 2013 Matthias Heidbrink * * This program is free software: you can redistribute it and/or modify * it under the terms of the GNU Lesser General Public License as @@ -37,25 +38,29 @@ #ifdef __APPLE__ #include #include +#include #include #endif #ifdef __linux__ #include "libudev.h" #include "linux/serial.h" +#include "linux_termios.h" +#if defined(TCGETX) && defined(TCSETX) && defined(HAVE_TERMIOX) +#define USE_TERMIOX +#endif #endif #include "libserialport.h" -struct sp_port_data { +struct port_data { #ifdef _WIN32 DCB dcb; #else struct termios term; int controlbits; - int rts; - int cts; - int dtr; - int dsr; +#ifdef USE_TERMIOX + int flow; +#endif #endif }; @@ -81,13 +86,14 @@ const struct std_baudrate std_baudrates[] = { */ BAUD(110), BAUD(300), BAUD(600), BAUD(1200), BAUD(2400), BAUD(4800), BAUD(9600), BAUD(14400), BAUD(19200), BAUD(38400), BAUD(57600), - BAUD(115200), BAUD(128000), BAUD(256000) + BAUD(115200), BAUD(128000), BAUD(256000), #else - BAUD(50), BAUD(75), BAUD(110), BAUD(134), BAUD(150), BAUD(200), BAUD(300), - BAUD(600), BAUD(1200), BAUD(1800), BAUD(2400), BAUD(4800), BAUD(9600), - BAUD(19200), BAUD(38400), BAUD(57600), BAUD(115200), BAUD(230400), + BAUD(50), BAUD(75), BAUD(110), BAUD(134), BAUD(150), BAUD(200), + BAUD(300), BAUD(600), BAUD(1200), BAUD(1800), BAUD(2400), BAUD(4800), + BAUD(9600), BAUD(19200), BAUD(38400), BAUD(57600), BAUD(115200), + BAUD(230400), #if !defined(__APPLE__) && !defined(__OpenBSD__) - BAUD(460800) + BAUD(460800), #endif #endif }; @@ -95,20 +101,17 @@ const struct std_baudrate std_baudrates[] = { #define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0])) #define NUM_STD_BAUDRATES ARRAY_SIZE(std_baudrates) -/* Helper functions for configuring ports. */ -static int start_config(struct sp_port *port, struct sp_port_data *data); -static int set_baudrate(struct sp_port_data *data, int baudrate); -static int set_bits(struct sp_port_data *data, int bits); -static int set_parity(struct sp_port_data *data, int parity); -static int set_stopbits(struct sp_port_data *data, int stopbits); -static int set_rts(struct sp_port_data *data, int rts); -static int set_cts(struct sp_port_data *data, int cts); -static int set_dtr(struct sp_port_data *data, int dtr); -static int set_dsr(struct sp_port_data *data, int dsr); -static int set_xon_xoff(struct sp_port_data *data, int xon_xoff); -static int apply_config(struct sp_port *port, struct sp_port_data *data); - -int sp_get_port_by_name(const char *portname, struct sp_port **port_ptr) +#define TRY(x) do { int ret = x; if (ret != SP_OK) return ret; } while (0) + +/* Helper functions. */ +static enum sp_return validate_port(struct sp_port *port); +static struct sp_port **list_append(struct sp_port **list, const char *portname); +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); + +enum sp_return sp_get_port_by_name(const char *portname, struct sp_port **port_ptr) { struct sp_port *port; int len; @@ -126,20 +129,25 @@ int sp_get_port_by_name(const char *portname, struct sp_port **port_ptr) len = strlen(portname) + 1; - if (!(port->name = malloc(len))) - { + if (!(port->name = malloc(len))) { free(port); return SP_ERR_MEM; } memcpy(port->name, portname, len); +#ifdef _WIN32 + port->hdl = INVALID_HANDLE_VALUE; +#else + port->fd = -1; +#endif + *port_ptr = port; return SP_OK; } -int sp_copy_port(const struct sp_port *port, struct sp_port **copy_ptr) +enum sp_return sp_copy_port(const struct sp_port *port, struct sp_port **copy_ptr) { if (!copy_ptr) return SP_ERR_ARG; @@ -163,7 +171,7 @@ void sp_free_port(struct sp_port *port) free(port); } -static struct sp_port **sp_list_append(struct sp_port **list, const char *portname) +static struct sp_port **list_append(struct sp_port **list, const char *portname) { void *tmp; unsigned int count; @@ -182,7 +190,7 @@ fail: return NULL; } -int sp_list_ports(struct sp_port ***list_ptr) +enum sp_return sp_list_ports(struct sp_port ***list_ptr) { struct sp_port **list; int ret = SP_OK; @@ -202,25 +210,21 @@ int sp_list_ports(struct sp_port ***list_ptr) int name_len; if (RegOpenKeyEx(HKEY_LOCAL_MACHINE, _T("HARDWARE\\DEVICEMAP\\SERIALCOMM"), - 0, KEY_QUERY_VALUE, &key) != ERROR_SUCCESS) - { + 0, KEY_QUERY_VALUE, &key) != ERROR_SUCCESS) { ret = SP_ERR_FAIL; goto out_done; } if (RegQueryInfoKey(key, NULL, NULL, NULL, NULL, NULL, NULL, NULL, - &max_value_len, &max_data_size, NULL, NULL) != ERROR_SUCCESS) - { + &max_value_len, &max_data_size, NULL, NULL) != ERROR_SUCCESS) { ret = SP_ERR_FAIL; goto out_close; } max_data_len = max_data_size / sizeof(TCHAR); - if (!(value = malloc((max_value_len + 1) * sizeof(TCHAR)))) - { + if (!(value = malloc((max_value_len + 1) * sizeof(TCHAR)))) { ret = SP_ERR_MEM; goto out_close; } - if (!(data = malloc((max_data_len + 1) * sizeof(TCHAR)))) - { + if (!(data = malloc((max_data_len + 1) * sizeof(TCHAR)))) { ret = SP_ERR_MEM; goto out_free_value; } @@ -237,8 +241,7 @@ int sp_list_ports(struct sp_port ***list_ptr) #else name_len = data_len + 1; #endif - if (!(name = malloc(name_len))) - { + if (!(name = malloc(name_len))) { ret = SP_ERR_MEM; goto out; } @@ -247,8 +250,7 @@ int sp_list_ports(struct sp_port ***list_ptr) #else strcpy(name, data); #endif - if (type == REG_SZ && !(list = sp_list_append(list, name))) - { + if (type == REG_SZ && !(list = list_append(list, name))) { ret = SP_ERR_MEM; goto out; } @@ -271,14 +273,12 @@ out_done: CFTypeRef cf_path; Boolean result; - if (IOMasterPort(MACH_PORT_NULL, &master) != KERN_SUCCESS) - { + if (IOMasterPort(MACH_PORT_NULL, &master) != KERN_SUCCESS) { ret = SP_ERR_FAIL; goto out_done; } - if (!(classes = IOServiceMatching(kIOSerialBSDServiceValue))) - { + if (!(classes = IOServiceMatching(kIOSerialBSDServiceValue))) { ret = SP_ERR_FAIL; goto out_done; } @@ -286,14 +286,12 @@ out_done: CFDictionarySetValue(classes, CFSTR(kIOSerialBSDTypeKey), CFSTR(kIOSerialBSDAllTypes)); - if (IOServiceGetMatchingServices(master, classes, &iter) != KERN_SUCCESS) - { + if (IOServiceGetMatchingServices(master, classes, &iter) != KERN_SUCCESS) { ret = SP_ERR_FAIL; goto out_done; } - if (!(path = malloc(PATH_MAX))) - { + if (!(path = malloc(PATH_MAX))) { ret = SP_ERR_MEM; goto out_release; } @@ -305,8 +303,7 @@ out_done: result = CFStringGetCString(cf_path, path, PATH_MAX, kCFStringEncodingASCII); CFRelease(cf_path); - if (result && !(list = sp_list_append(list, path))) - { + if (result && !(list = list_append(list, path))) { ret = SP_ERR_MEM; IOObjectRelease(port); goto out; @@ -337,14 +334,12 @@ out_done: udev_enumerate_add_match_subsystem(ud_enumerate, "tty"); udev_enumerate_scan_devices(ud_enumerate); ud_list = udev_enumerate_get_list_entry(ud_enumerate); - udev_list_entry_foreach(ud_entry, ud_list) - { + udev_list_entry_foreach(ud_entry, ud_list) { path = udev_list_entry_get_name(ud_entry); ud_dev = udev_device_new_from_syspath(ud, path); /* If there is no parent device, this is a virtual tty. */ ud_parent = udev_device_get_parent(ud_dev); - if (ud_parent == NULL) - { + if (ud_parent == NULL) { udev_device_unref(ud_dev); continue; } @@ -353,8 +348,7 @@ out_done: * The only way to tell which actually exist on a given system * is to try to open them and make an ioctl call. */ driver = udev_device_get_driver(ud_parent); - if (driver && !strcmp(driver, "serial8250")) - { + if (driver && !strcmp(driver, "serial8250")) { if ((fd = open(name, O_RDWR | O_NONBLOCK | O_NOCTTY)) < 0) goto skip; ioctl_result = ioctl(fd, TIOCGSERIAL, &serial_info); @@ -364,11 +358,10 @@ out_done: if (serial_info.type == PORT_UNKNOWN) goto skip; } - list = sp_list_append(list, name); + list = list_append(list, name); skip: udev_device_unref(ud_dev); - if (!list) - { + if (!list) { ret = SP_ERR_MEM; goto out; } @@ -378,15 +371,11 @@ out: udev_unref(ud); #endif - if (ret == SP_OK) - { + if (ret == SP_OK) { *list_ptr = list; - } - else - { + } else { if (list) sp_free_port_list(list); - *list_ptr = NULL; } @@ -402,7 +391,7 @@ void sp_free_port_list(struct sp_port **list) free(list); } -static int sp_validate_port(struct sp_port *port) +static enum sp_return validate_port(struct sp_port *port) { if (port == NULL) return 0; @@ -416,9 +405,9 @@ static int sp_validate_port(struct sp_port *port) return 1; } -#define CHECK_PORT() do { if (!sp_validate_port(port)) return SP_ERR_ARG; } while (0) +#define CHECK_PORT() do { if (!validate_port(port)) return SP_ERR_ARG; } while (0) -int sp_open(struct sp_port *port, int flags) +enum sp_return sp_open(struct sp_port *port, enum sp_mode flags) { if (!port) return SP_ERR_ARG; @@ -449,7 +438,9 @@ int sp_open(struct sp_port *port, int flags) return SP_ERR_FAIL; #else int flags_local = 0; - struct sp_port_data data; + struct port_data data; + struct sp_port_config config; + int ret; /* Map 'flags' to the OS-specific settings. */ if (flags & SP_MODE_RDWR) @@ -462,7 +453,12 @@ int sp_open(struct sp_port *port, int flags) if ((port->fd = open(port->name, flags_local)) < 0) return SP_ERR_FAIL; - start_config(port, &data); + ret = get_config(port, &data, &config); + + if (ret < 0) { + sp_close(port); + return ret; + } /* Turn off all serial port cooking. */ data.term.c_iflag &= ~(ISTRIP | INLCR | ICRNL); @@ -476,13 +472,18 @@ int sp_open(struct sp_port *port, int flags) /* Ignore modem status lines; enable receiver */ data.term.c_cflag |= (CLOCAL | CREAD); - apply_config(port, &data); + ret = set_config(port, &data, &config); + + if (ret < 0) { + sp_close(port); + return ret; + } #endif return SP_OK; } -int sp_close(struct sp_port *port) +enum sp_return sp_close(struct sp_port *port) { CHECK_PORT(); @@ -490,16 +491,18 @@ int sp_close(struct sp_port *port) /* Returns non-zero upon success, 0 upon failure. */ if (CloseHandle(port->hdl) == 0) return SP_ERR_FAIL; + port->hdl = INVALID_HANDLE_VALUE; #else /* Returns 0 upon success, -1 upon failure. */ if (close(port->fd) == -1) return SP_ERR_FAIL; + port->fd = -1; #endif return SP_OK; } -int sp_flush(struct sp_port *port) +enum sp_return sp_flush(struct sp_port *port) { CHECK_PORT(); @@ -515,7 +518,7 @@ int sp_flush(struct sp_port *port) return SP_OK; } -int sp_write(struct sp_port *port, const void *buf, size_t count) +enum sp_return sp_write(struct sp_port *port, const void *buf, size_t count) { CHECK_PORT(); @@ -540,7 +543,7 @@ int sp_write(struct sp_port *port, const void *buf, size_t count) #endif } -int sp_read(struct sp_port *port, void *buf, size_t count) +enum sp_return sp_read(struct sp_port *port, void *buf, size_t count) { CHECK_PORT(); @@ -564,344 +567,87 @@ int sp_read(struct sp_port *port, void *buf, size_t count) #endif } -static int start_config(struct sp_port *port, struct sp_port_data *data) +#ifdef __linux__ +static enum sp_return get_baudrate(int fd, int *baudrate) { - CHECK_PORT(); -#ifdef _WIN32 - if (!GetCommState(port->hdl, &data->dcb)) - return SP_ERR_FAIL; -#else - if (tcgetattr(port->fd, &data->term) < 0) - return SP_ERR_FAIL; + void *data; - if (ioctl(port->fd, TIOCMGET, &data->controlbits) < 0) + if (!(data = malloc(get_termios_size()))) + return SP_ERR_MEM; + + if (ioctl(fd, get_termios_get_ioctl(), data) < 0) return SP_ERR_FAIL; - if (data->term.c_cflag & CRTSCTS) { - data->rts = SP_RTS_FLOW_CONTROL; - data->cts = SP_CTS_FLOW_CONTROL; - } else { - data->rts = (data->controlbits & TIOCM_RTS) ? SP_RTS_ON : SP_RTS_OFF; - data->cts = SP_CTS_IGNORE; - } + *baudrate = get_termios_speed(data); - data->dtr = (data->controlbits & TIOCM_DTR) ? SP_DTR_ON : SP_DTR_OFF; - data->dsr = SP_DSR_IGNORE; -#endif return SP_OK; } -static int set_baudrate(struct sp_port_data *data, int baudrate) +static enum sp_return set_baudrate(int fd, int baudrate) { - unsigned int i; - for (i = 0; i < NUM_STD_BAUDRATES; i++) { - if (baudrate == std_baudrates[i].value) { -#ifdef _WIN32 - data->dcb.BaudRate = std_baudrates[i].index; -#else - if (cfsetospeed(&data->term, std_baudrates[i].index) < 0) - return SP_ERR_FAIL; + void *data; - if (cfsetispeed(&data->term, std_baudrates[i].index) < 0) - return SP_ERR_FAIL; -#endif - break; - } - } + if (!(data = malloc(get_termios_size()))) + return SP_ERR_MEM; - if (i == NUM_STD_BAUDRATES) - return SP_ERR_ARG; + if (ioctl(fd, get_termios_get_ioctl(), data) < 0) + return SP_ERR_FAIL; - return SP_OK; -} + set_termios_speed(data, baudrate); -static int set_bits(struct sp_port_data *data, int bits) -{ -#ifdef _WIN32 - data->dcb.ByteSize = bits; -#else - data->term.c_cflag &= ~CSIZE; - switch (bits) { - case 8: - data->term.c_cflag |= CS8; - break; - case 7: - data->term.c_cflag |= CS7; - break; - case 6: - data->term.c_cflag |= CS6; - break; - default: - return SP_ERR_ARG; - } -#endif - return SP_OK; -} + if (ioctl(fd, get_termios_set_ioctl(), data) < 0) + return SP_ERR_FAIL; -static int set_parity(struct sp_port_data *data, int parity) -{ -#ifdef _WIN32 - switch (parity) { - /* Note: There's also SPACEPARITY, MARKPARITY (unneeded so far). */ - case SP_PARITY_NONE: - data->dcb.Parity = NOPARITY; - break; - case SP_PARITY_EVEN: - data->dcb.Parity = EVENPARITY; - break; - case SP_PARITY_ODD: - data->dcb.Parity = ODDPARITY; - break; - default: - return SP_ERR_ARG; - } -#else - data->term.c_iflag &= ~IGNPAR; - data->term.c_cflag &= ~(PARENB | PARODD); - switch (parity) { - case SP_PARITY_NONE: - data->term.c_iflag |= IGNPAR; - break; - case SP_PARITY_EVEN: - data->term.c_cflag |= PARENB; - break; - case SP_PARITY_ODD: - data->term.c_cflag |= PARENB | PARODD; - break; - default: - return SP_ERR_ARG; - } -#endif return SP_OK; } -static int set_stopbits(struct sp_port_data *data, int stopbits) +#ifdef USE_TERMIOX +static enum sp_return get_flow(int fd, int *flow) { -#ifdef _WIN32 - switch (stopbits) { - /* Note: There's also ONE5STOPBITS == 1.5 (unneeded so far). */ - case 1: - data->dcb.StopBits = ONESTOPBIT; - break; - case 2: - data->dcb.StopBits = TWOSTOPBITS; - break; - default: - return SP_ERR_ARG; - } -#else - data->term.c_cflag &= ~CSTOPB; - switch (stopbits) { - case 1: - data->term.c_cflag &= ~CSTOPB; - break; - case 2: - data->term.c_cflag |= CSTOPB; - break; - default: - return SP_ERR_ARG; - } -#endif - return SP_OK; -} - -static int set_rts(struct sp_port_data *data, int rts) -{ -#ifdef _WIN32 - switch (rts) { - case SP_RTS_OFF: - data->dcb.fRtsControl = RTS_CONTROL_DISABLE; - break; - case SP_RTS_ON: - data->dcb.fRtsControl = RTS_CONTROL_ENABLE; - break; - case SP_RTS_FLOW_CONTROL: - data->dcb.fRtsControl = RTS_CONTROL_HANDSHAKE; - break; - default: - return SP_ERR_ARG; - } -#else - data->rts = rts; -#endif - return SP_OK; -} + void *data; -static int set_cts(struct sp_port_data *data, int cts) -{ -#ifdef _WIN32 - switch (cts) { - case SP_CTS_IGNORE: - data->dcb.fOutxCtsFlow = FALSE; - break; - case SP_CTS_FLOW_CONTROL: - data->dcb.fOutxCtsFlow = TRUE; - break; - default: - return SP_ERR_ARG; - } -#else - data->cts = cts; -#endif - return SP_OK; -} + if (!(data = malloc(get_termiox_size()))) + return SP_ERR_MEM; -static int set_dtr(struct sp_port_data *data, int dtr) -{ -#ifdef _WIN32 - switch (dtr) { - case SP_DTR_OFF: - data->dcb.fDtrControl = DTR_CONTROL_DISABLE; - break; - case SP_DTR_ON: - data->dcb.fDtrControl = DTR_CONTROL_ENABLE; - break; - case SP_DTR_FLOW_CONTROL: - data->dcb.fDtrControl = DTR_CONTROL_HANDSHAKE; - break; - default: - return SP_ERR_ARG; - } -#else - data->dtr = dtr; -#endif - return SP_OK; -} + if (ioctl(fd, TCGETX, data) < 0) + return SP_ERR_FAIL; -static int set_dsr(struct sp_port_data *data, int dsr) -{ -#ifdef _WIN32 - switch (dsr) { - case SP_DSR_IGNORE: - data->dcb.fOutxDsrFlow = FALSE; - break; - case SP_DSR_FLOW_CONTROL: - data->dcb.fOutxDsrFlow = TRUE; - break; - default: - return SP_ERR_ARG; - } -#else - data->dsr = dsr; -#endif - return SP_OK; -} + *flow = get_termiox_flow(data); -static int set_xon_xoff(struct sp_port_data *data, int xon_xoff) -{ -#ifdef _WIN32 - switch (xon_xoff) { - case SP_XONXOFF_DISABLED: - data->dcb.fInX = FALSE; - data->dcb.fOutX = FALSE; - break; - case SP_XONXOFF_IN: - data->dcb.fInX = TRUE; - data->dcb.fOutX = FALSE; - break; - case SP_XONXOFF_OUT: - data->dcb.fInX = FALSE; - data->dcb.fOutX = TRUE; - break; - case SP_XONXOFF_INOUT: - data->dcb.fInX = TRUE; - data->dcb.fOutX = TRUE; - break; - default: - return SP_ERR_ARG; - } -#else - data->term.c_iflag &= ~(IXON | IXOFF | IXANY); - switch (xon_xoff) { - case SP_XONXOFF_DISABLED: - break; - case SP_XONXOFF_IN: - data->term.c_iflag |= IXOFF; - break; - case SP_XONXOFF_OUT: - data->term.c_iflag |= IXON | IXANY; - break; - case SP_XONXOFF_INOUT: - data->term.c_iflag |= IXON | IXOFF | IXANY; - break; - default: - return SP_ERR_ARG; - } -#endif return SP_OK; } -static int apply_config(struct sp_port *port, struct sp_port_data *data) +static enum sp_return set_flow(int fd, int flow) { -#ifdef _WIN32 - if (!SetCommState(port->hdl, &data->dcb)) - return SP_ERR_FAIL; -#else - int controlbits; + void *data; - /* Asymmetric use of RTS/CTS not supported yet. */ - if ((data->rts == SP_RTS_FLOW_CONTROL) != (data->cts == SP_CTS_FLOW_CONTROL)) - return SP_ERR_ARG; - - /* DTR/DSR flow control not supported yet. */ - if (data->dtr == SP_DTR_FLOW_CONTROL || data->dsr == SP_DSR_FLOW_CONTROL) - return SP_ERR_ARG; - - if (data->rts == SP_RTS_FLOW_CONTROL) - data->term.c_iflag |= CRTSCTS; - else - { - controlbits = TIOCM_RTS; - if (ioctl(port->fd, data->rts == SP_RTS_ON ? TIOCMBIS : TIOCMBIC, - &controlbits) < 0) - return SP_ERR_FAIL; - } - - controlbits = TIOCM_DTR; - if (ioctl(port->fd, data->dtr == SP_DTR_ON ? TIOCMBIS : TIOCMBIC, - &controlbits) < 0) - return SP_ERR_FAIL; + if (!(data = malloc(get_termiox_size()))) + return SP_ERR_MEM; - /* Write the configured settings. */ - if (tcsetattr(port->fd, TCSADRAIN, &data->term) < 0) + if (ioctl(fd, TCGETX, data) < 0) return SP_ERR_FAIL; -#endif - return SP_OK; -} -#define TRY(x) do { int ret = x; if (ret != SP_OK) return ret; } while (0) -#define TRY_SET(x, y) do { if (y >= 0) TRY(set_##x(&data, y)); } while (0) -#define TRY_SET_CONFIG(x) TRY_SET(x, config->x) + set_termiox_flow(data, flow); -int sp_set_config(struct sp_port *port, struct sp_port_config *config) -{ - struct sp_port_data data; - - TRY(start_config(port, &data)); - TRY_SET_CONFIG(baudrate); - TRY_SET_CONFIG(bits); - TRY_SET_CONFIG(parity); - TRY_SET_CONFIG(stopbits); - TRY_SET_CONFIG(rts); - TRY_SET_CONFIG(cts); - TRY_SET_CONFIG(dtr); - TRY_SET_CONFIG(dsr); - TRY_SET_CONFIG(xon_xoff); - TRY(apply_config(port, &data)); + if (ioctl(fd, TCSETX, data) < 0) + return SP_ERR_FAIL; return SP_OK; } +#endif /* USE_TERMIOX */ +#endif /* __linux__ */ -int sp_get_config(struct sp_port *port, struct sp_port_config *config) +static enum sp_return get_config(struct sp_port *port, struct port_data *data, + struct sp_port_config *config) { - struct sp_port_data data; unsigned int i; - TRY(start_config(port, &data)); - #ifdef _WIN32 + if (!GetCommState(port->hdl, &data->dcb)) + return SP_ERR_FAIL; + for (i = 0; i < NUM_STD_BAUDRATES; i++) { - if (data.dcb.BaudRate == std_baudrates[i].index) { + if (data->dcb.BaudRate == std_baudrates[i].index) { config->baudrate = std_baudrates[i].value; break; } @@ -909,12 +655,12 @@ int sp_get_config(struct sp_port *port, struct sp_port_config *config) if (i == NUM_STD_BAUDRATES) /* BaudRate field can be either an index or a custom baud rate. */ - config->baudrate = data.dcb.BaudRate; + config->baudrate = data->dcb.BaudRate; - config->bits = data.dcb.ByteSize; + config->bits = data->dcb.ByteSize; - if (data.dcb.fParity) - switch (data.dcb.Parity) { + if (data->dcb.fParity) + switch (data->dcb.Parity) { case NOPARITY: config->parity = SP_PARITY_NONE; break; @@ -930,7 +676,7 @@ int sp_get_config(struct sp_port *port, struct sp_port_config *config) else config->parity = SP_PARITY_NONE; - switch (data.dcb.StopBits) { + switch (data->dcb.StopBits) { case ONESTOPBIT: config->stopbits = 1; break; @@ -941,49 +687,80 @@ int sp_get_config(struct sp_port *port, struct sp_port_config *config) config->stopbits = -1; } - switch (data.dcb.fRtsControl) { - case RTS_CONTROL_DISABLE: - config->rts = SP_RTS_OFF; - break; - case RTS_CONTROL_ENABLE: - config->rts = SP_RTS_ON; - break; - case RTS_CONTROL_HANDSHAKE: - config->rts = SP_RTS_FLOW_CONTROL; - break; - default: - config->rts = -1; + switch (data->dcb.fRtsControl) { + case RTS_CONTROL_DISABLE: + config->rts = SP_RTS_OFF; + break; + case RTS_CONTROL_ENABLE: + config->rts = SP_RTS_ON; + break; + case RTS_CONTROL_HANDSHAKE: + config->rts = SP_RTS_FLOW_CONTROL; + break; + default: + config->rts = -1; } - config->cts = data.dcb.fOutxCtsFlow ? SP_CTS_FLOW_CONTROL : SP_CTS_IGNORE; + config->cts = data->dcb.fOutxCtsFlow ? SP_CTS_FLOW_CONTROL : SP_CTS_IGNORE; - switch (data.dcb.fDtrControl) { - case DTR_CONTROL_DISABLE: - config->dtr = SP_DTR_OFF; - break; - case DTR_CONTROL_ENABLE: - config->dtr = SP_DTR_ON; - break; - case DTR_CONTROL_HANDSHAKE: - config->dtr = SP_DTR_FLOW_CONTROL; - break; - default: - config->dtr = -1; + switch (data->dcb.fDtrControl) { + case DTR_CONTROL_DISABLE: + config->dtr = SP_DTR_OFF; + break; + case DTR_CONTROL_ENABLE: + config->dtr = SP_DTR_ON; + break; + case DTR_CONTROL_HANDSHAKE: + config->dtr = SP_DTR_FLOW_CONTROL; + break; + default: + config->dtr = -1; } - config->dsr = data.dcb.fOutxDsrFlow ? SP_DSR_FLOW_CONTROL : SP_DSR_IGNORE; -#else + config->dsr = data->dcb.fOutxDsrFlow ? SP_DSR_FLOW_CONTROL : SP_DSR_IGNORE; + + if (data->dcb.fInX) { + if (data->dcb.fOutX) + config->xon_xoff = SP_XONXOFF_INOUT; + else + config->xon_xoff = SP_XONXOFF_IN; + } else { + if (data->dcb.fOutX) + config->xon_xoff = SP_XONXOFF_OUT; + else + config->xon_xoff = SP_XONXOFF_DISABLED; + } + +#else // !_WIN32 + + if (tcgetattr(port->fd, &data->term) < 0) + return SP_ERR_FAIL; + + if (ioctl(port->fd, TIOCMGET, &data->controlbits) < 0) + return SP_ERR_FAIL; + +#ifdef USE_TERMIOX + TRY(get_flow(port->fd, &data->flow)); +#endif + for (i = 0; i < NUM_STD_BAUDRATES; i++) { - if (cfgetispeed(&data.term) == std_baudrates[i].index) { + if (cfgetispeed(&data->term) == std_baudrates[i].index) { config->baudrate = std_baudrates[i].value; break; } } - if (i == NUM_STD_BAUDRATES) + if (i == NUM_STD_BAUDRATES) { +#ifdef __APPLE__ + config->baudrate = (int)data->term.c_ispeed; +#elif defined(__linux__) + TRY(get_baudrate(port->fd, &config->baudrate)); +#else config->baudrate = -1; +#endif + } - switch (data.term.c_cflag & CSIZE) { + switch (data->term.c_cflag & CSIZE) { case CS8: config->bits = 8; break; @@ -1000,80 +777,493 @@ int sp_get_config(struct sp_port *port, struct sp_port_config *config) config->bits = -1; } - if (!(data.term.c_cflag & PARENB) && (data.term.c_iflag & IGNPAR)) + if (!(data->term.c_cflag & PARENB) && (data->term.c_iflag & IGNPAR)) config->parity = SP_PARITY_NONE; - else if (!(data.term.c_cflag & PARENB) || (data.term.c_iflag & IGNPAR)) + else if (!(data->term.c_cflag & PARENB) || (data->term.c_iflag & IGNPAR)) config->parity = -1; else - config->parity = (data.term.c_cflag & PARODD) ? SP_PARITY_ODD : SP_PARITY_EVEN; + config->parity = (data->term.c_cflag & PARODD) ? SP_PARITY_ODD : SP_PARITY_EVEN; - config->stopbits = (data.term.c_cflag & CSTOPB) ? 2 : 1; + config->stopbits = (data->term.c_cflag & CSTOPB) ? 2 : 1; - if (data.term.c_cflag & CRTSCTS) { + if (data->term.c_cflag & CRTSCTS) { config->rts = SP_RTS_FLOW_CONTROL; config->cts = SP_CTS_FLOW_CONTROL; } else { - config->rts = (data.controlbits & TIOCM_RTS) ? SP_RTS_ON : SP_RTS_OFF; +#ifdef USE_TERMIOX + if (data->flow & RTS_FLOW) + config->rts = SP_RTS_FLOW_CONTROL; + else + config->rts = (data->controlbits & TIOCM_RTS) ? SP_RTS_ON : SP_RTS_OFF; + + config->cts = (data->flow & CTS_FLOW) ? SP_CTS_FLOW_CONTROL : SP_CTS_IGNORE; +#else + config->rts = (data->controlbits & TIOCM_RTS) ? SP_RTS_ON : SP_RTS_OFF; config->cts = SP_CTS_IGNORE; +#endif } - config->dtr = (data.controlbits & TIOCM_DTR) ? SP_DTR_ON : SP_DTR_OFF; +#ifdef USE_TERMIOX + if (data->flow & DTR_FLOW) + config->dtr = SP_DTR_FLOW_CONTROL; + else + config->dtr = (data->controlbits & TIOCM_DTR) ? SP_DTR_ON : SP_DTR_OFF; + + config->dsr = (data->flow & DSR_FLOW) ? SP_DSR_FLOW_CONTROL : SP_DSR_IGNORE; +#else + config->dtr = (data->controlbits & TIOCM_DTR) ? SP_DTR_ON : SP_DTR_OFF; config->dsr = SP_DSR_IGNORE; #endif + if (data->term.c_iflag & IXOFF) { + if (data->term.c_iflag & IXON) + config->xon_xoff = SP_XONXOFF_INOUT; + else + config->xon_xoff = SP_XONXOFF_IN; + } else { + if (data->term.c_iflag & IXON) + config->xon_xoff = SP_XONXOFF_OUT; + else + config->xon_xoff = SP_XONXOFF_DISABLED; + } +#endif + + return SP_OK; +} + +static enum sp_return set_config(struct sp_port *port, struct port_data *data, + const struct sp_port_config *config) +{ + unsigned int i; +#ifdef __APPLE__ + BAUD_TYPE baud_nonstd; + + baud_nonstd = B0; +#endif +#ifdef __linux__ + int baud_nonstd = 0; +#endif + +#ifdef _WIN32 + if (config->baudrate >= 0) { + for (i = 0; i < NUM_STD_BAUDRATES; i++) { + if (config->baudrate == std_baudrates[i].value) { + data->dcb.BaudRate = std_baudrates[i].index; + break; + } + } + + if (i == NUM_STD_BAUDRATES) + data->dcb.BaudRate = config->baudrate; + } + + if (config->bits >= 0) + data->dcb.ByteSize = config->bits; + + if (config->parity >= 0) { + switch (config->parity) { + /* Note: There's also SPACEPARITY, MARKPARITY (unneeded so far). */ + case SP_PARITY_NONE: + data->dcb.Parity = NOPARITY; + break; + case SP_PARITY_EVEN: + data->dcb.Parity = EVENPARITY; + break; + case SP_PARITY_ODD: + data->dcb.Parity = ODDPARITY; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->stopbits >= 0) { + switch (config->stopbits) { + /* Note: There's also ONE5STOPBITS == 1.5 (unneeded so far). */ + case 1: + data->dcb.StopBits = ONESTOPBIT; + break; + case 2: + data->dcb.StopBits = TWOSTOPBITS; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->rts >= 0) { + switch (config->rts) { + case SP_RTS_OFF: + data->dcb.fRtsControl = RTS_CONTROL_DISABLE; + break; + case SP_RTS_ON: + data->dcb.fRtsControl = RTS_CONTROL_ENABLE; + break; + case SP_RTS_FLOW_CONTROL: + data->dcb.fRtsControl = RTS_CONTROL_HANDSHAKE; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->cts >= 0) { + switch (config->cts) { + case SP_CTS_IGNORE: + data->dcb.fOutxCtsFlow = FALSE; + break; + case SP_CTS_FLOW_CONTROL: + data->dcb.fOutxCtsFlow = TRUE; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->dtr >= 0) { + switch (config->dtr) { + case SP_DTR_OFF: + data->dcb.fDtrControl = DTR_CONTROL_DISABLE; + break; + case SP_DTR_ON: + data->dcb.fDtrControl = DTR_CONTROL_ENABLE; + break; + case SP_DTR_FLOW_CONTROL: + data->dcb.fDtrControl = DTR_CONTROL_HANDSHAKE; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->dsr >= 0) { + switch (config->dsr) { + case SP_DSR_IGNORE: + data->dcb.fOutxDsrFlow = FALSE; + break; + case SP_DSR_FLOW_CONTROL: + data->dcb.fOutxDsrFlow = TRUE; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->xon_xoff >= 0) { + switch (config->xon_xoff) { + case SP_XONXOFF_DISABLED: + data->dcb.fInX = FALSE; + data->dcb.fOutX = FALSE; + break; + case SP_XONXOFF_IN: + data->dcb.fInX = TRUE; + data->dcb.fOutX = FALSE; + break; + case SP_XONXOFF_OUT: + data->dcb.fInX = FALSE; + data->dcb.fOutX = TRUE; + break; + case SP_XONXOFF_INOUT: + data->dcb.fInX = TRUE; + data->dcb.fOutX = TRUE; + break; + default: + return SP_ERR_ARG; + } + } + + if (!SetCommState(port->hdl, &data->dcb)) + return SP_ERR_FAIL; + +#else /* !_WIN32 */ + + int controlbits; + + if (config->baudrate >= 0) { + for (i = 0; i < NUM_STD_BAUDRATES; i++) { + if (config->baudrate == std_baudrates[i].value) { + if (cfsetospeed(&data->term, std_baudrates[i].index) < 0) + return SP_ERR_FAIL; + + if (cfsetispeed(&data->term, std_baudrates[i].index) < 0) + return SP_ERR_FAIL; + break; + } + } + + /* Non-standard baud rate */ + if (i == NUM_STD_BAUDRATES) { +#ifdef __APPLE__ + /* Set "dummy" baud rate */ + if (cfsetspeed(&data->term, B9600) < 0) + return SP_ERR_FAIL; + baud_nonstd = config->baudrate; +#elif defined(__linux__) + baud_nonstd = 1; +#else + return SP_ERR_ARG; +#endif + } + } + + if (config->bits >= 0) { + data->term.c_cflag &= ~CSIZE; + switch (config->bits) { + case 8: + data->term.c_cflag |= CS8; + break; + case 7: + data->term.c_cflag |= CS7; + break; + case 6: + data->term.c_cflag |= CS6; + break; + case 5: + data->term.c_cflag |= CS5; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->parity >= 0) { + data->term.c_iflag &= ~IGNPAR; + data->term.c_cflag &= ~(PARENB | PARODD); + switch (config->parity) { + case SP_PARITY_NONE: + data->term.c_iflag |= IGNPAR; + break; + case SP_PARITY_EVEN: + data->term.c_cflag |= PARENB; + break; + case SP_PARITY_ODD: + data->term.c_cflag |= PARENB | PARODD; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->stopbits >= 0) { + data->term.c_cflag &= ~CSTOPB; + switch (config->stopbits) { + case 1: + data->term.c_cflag &= ~CSTOPB; + break; + case 2: + data->term.c_cflag |= CSTOPB; + break; + default: + return SP_ERR_ARG; + } + } + + if (config->rts >= 0 || config->cts >= 0) { +#ifdef USE_TERMIOX + data->flow &= ~(RTS_FLOW | CTS_FLOW); + switch (config->rts) { + case SP_RTS_OFF: + case SP_RTS_ON: + controlbits = TIOCM_RTS; + if (ioctl(port->fd, config->rts == SP_RTS_ON ? TIOCMBIS : TIOCMBIC, + &controlbits) < 0) + return SP_ERR_FAIL; + break; + case SP_RTS_FLOW_CONTROL: + data->flow |= RTS_FLOW; + break; + default: + break; + } + if (config->cts == SP_CTS_FLOW_CONTROL) + data->flow |= CTS_FLOW; + + if (data->flow & (RTS_FLOW | CTS_FLOW)) + data->term.c_iflag |= CRTSCTS; + else + data->term.c_iflag &= ~CRTSCTS; +#else + /* Asymmetric use of RTS/CTS not supported. */ + if (data->term.c_iflag & CRTSCTS) { + /* Flow control can only be disabled for both RTS & CTS together. */ + if (config->rts >= 0 && config->rts != SP_RTS_FLOW_CONTROL) { + if (config->cts != SP_CTS_IGNORE) + return SP_ERR_ARG; + } + if (config->cts >= 0 && config->cts != SP_CTS_FLOW_CONTROL) { + if (config->rts <= 0 || config->rts == SP_RTS_FLOW_CONTROL) + return SP_ERR_ARG; + } + } else { + /* Flow control can only be enabled for both RTS & CTS together. */ + if (((config->rts == SP_RTS_FLOW_CONTROL) && (config->cts != SP_CTS_FLOW_CONTROL)) || + ((config->cts == SP_CTS_FLOW_CONTROL) && (config->rts != SP_RTS_FLOW_CONTROL))) + return SP_ERR_ARG; + } + + if (config->rts >= 0) { + if (config->rts == SP_RTS_FLOW_CONTROL) { + data->term.c_iflag |= CRTSCTS; + } else { + controlbits = TIOCM_RTS; + if (ioctl(port->fd, config->rts == SP_RTS_ON ? TIOCMBIS : TIOCMBIC, + &controlbits) < 0) + return SP_ERR_FAIL; + } + } +#endif + } + + if (config->dtr >= 0 || config->dsr >= 0) { +#ifdef USE_TERMIOX + data->flow &= ~(DTR_FLOW | DSR_FLOW); + switch (config->dtr) { + case SP_DTR_OFF: + case SP_DTR_ON: + controlbits = TIOCM_DTR; + if (ioctl(port->fd, config->dtr == SP_DTR_ON ? TIOCMBIS : TIOCMBIC, + &controlbits) < 0) + return SP_ERR_FAIL; + break; + case SP_DTR_FLOW_CONTROL: + data->flow |= DTR_FLOW; + break; + default: + break; + } + if (config->dsr == SP_DSR_FLOW_CONTROL) + data->flow |= DSR_FLOW; +#else + /* DTR/DSR flow control not supported. */ + if (config->dtr == SP_DTR_FLOW_CONTROL || config->dsr == SP_DSR_FLOW_CONTROL) + return SP_ERR_ARG; + + if (config->dtr >= 0) { + controlbits = TIOCM_DTR; + if (ioctl(port->fd, config->dtr == SP_DTR_ON ? TIOCMBIS : TIOCMBIC, + &controlbits) < 0) + return SP_ERR_FAIL; + } +#endif + } + + if (config->xon_xoff >= 0) { + data->term.c_iflag &= ~(IXON | IXOFF | IXANY); + switch (config->xon_xoff) { + case SP_XONXOFF_DISABLED: + break; + case SP_XONXOFF_IN: + data->term.c_iflag |= IXOFF; + break; + case SP_XONXOFF_OUT: + data->term.c_iflag |= IXON | IXANY; + break; + case SP_XONXOFF_INOUT: + data->term.c_iflag |= IXON | IXOFF | IXANY; + break; + default: + return SP_ERR_ARG; + } + } + + if (tcsetattr(port->fd, TCSADRAIN, &data->term) < 0) + return SP_ERR_FAIL; + +#ifdef __APPLE__ + if (baud_nonstd != B0) { + if (ioctl(port->fd, IOSSIOSPEED, &baud_nonstd) == -1) + return SP_ERR_FAIL; + /* Set baud rates in data->term to correct, but incompatible + * with tcsetattr() value, same as delivered by tcgetattr(). */ + if (cfsetspeed(&data->term, baud_nonstd) < 0) + return SP_ERR_FAIL; + } +#elif defined(__linux__) + if (baud_nonstd) + TRY(set_baudrate(port->fd, config->baudrate)); +#ifdef USE_TERMIOX + TRY(set_flow(port->fd, data->flow)); +#endif +#endif + +#endif /* !_WIN32 */ + return SP_OK; } -int sp_set_flowcontrol(struct sp_port *port, int flowcontrol) +enum sp_return sp_set_config(struct sp_port *port, const struct sp_port_config *config) { - struct sp_port_data data; + struct port_data data; + struct sp_port_config prev_config; - TRY(start_config(port, &data)); + CHECK_PORT(); + + if (!config) + return SP_ERR_ARG; + + TRY(get_config(port, &data, &prev_config)); + TRY(set_config(port, &data, config)); + + return SP_OK; +} + +#define CREATE_SETTER(x, type) int sp_set_##x(struct sp_port *port, type x) { \ + struct port_data data; \ + struct sp_port_config config; \ + CHECK_PORT(); \ + TRY(get_config(port, &data, &config)); \ + config.x = x; \ + TRY(set_config(port, &data, &config)); \ + return SP_OK; \ +} + +CREATE_SETTER(baudrate, int) +CREATE_SETTER(bits, int) +CREATE_SETTER(parity, enum sp_parity) +CREATE_SETTER(stopbits, int) +CREATE_SETTER(rts, enum sp_rts) +CREATE_SETTER(cts, enum sp_cts) +CREATE_SETTER(dtr, enum sp_dtr) +CREATE_SETTER(dsr, enum sp_dsr) +CREATE_SETTER(xon_xoff, enum sp_xonxoff) + +enum sp_return sp_set_flowcontrol(struct sp_port *port, enum sp_flowcontrol flowcontrol) +{ + struct port_data data; + struct sp_port_config config; + + CHECK_PORT(); + + TRY(get_config(port, &data, &config)); if (flowcontrol == SP_FLOWCONTROL_XONXOFF) - TRY_SET(xon_xoff, SP_XONXOFF_INOUT); + config.xon_xoff = SP_XONXOFF_INOUT; else - TRY_SET(xon_xoff, SP_XONXOFF_DISABLED); + config.xon_xoff = SP_XONXOFF_DISABLED; if (flowcontrol == SP_FLOWCONTROL_RTSCTS) { - TRY_SET(rts, SP_RTS_FLOW_CONTROL); - TRY_SET(cts, SP_CTS_FLOW_CONTROL); + config.rts = SP_RTS_FLOW_CONTROL; + config.cts = SP_CTS_FLOW_CONTROL; } else { - TRY_SET(rts, SP_RTS_ON); - TRY_SET(cts, SP_CTS_IGNORE); + if (config.rts == SP_RTS_FLOW_CONTROL) + config.rts = SP_RTS_ON; + config.cts = SP_CTS_IGNORE; } if (flowcontrol == SP_FLOWCONTROL_DTRDSR) { - TRY_SET(dtr, SP_DTR_FLOW_CONTROL); - TRY_SET(dsr, SP_DSR_FLOW_CONTROL); + config.dtr = SP_DTR_FLOW_CONTROL; + config.dsr = SP_DSR_FLOW_CONTROL; } else { - TRY_SET(dtr, SP_DTR_ON); - TRY_SET(dsr, SP_DSR_IGNORE); + if (config.dtr == SP_DTR_FLOW_CONTROL) + config.dtr = SP_DTR_ON; + config.dsr = SP_DSR_IGNORE; } - TRY(apply_config(port, &data)); + TRY(set_config(port, &data, &config)); return SP_OK; } -#define CREATE_SETTER(x) int sp_set_##x(struct sp_port *port, int x) { \ - struct sp_port_data data; \ - TRY(start_config(port, &data)); \ - TRY(set_##x(&data, x)); \ - TRY(apply_config(port, &data)); \ - return SP_OK; \ -} - -CREATE_SETTER(baudrate) -CREATE_SETTER(bits) -CREATE_SETTER(parity) -CREATE_SETTER(stopbits) -CREATE_SETTER(rts) -CREATE_SETTER(cts) -CREATE_SETTER(dtr) -CREATE_SETTER(dsr) -CREATE_SETTER(xon_xoff) - int sp_last_error_code(void) { #ifdef _WIN32