[libserialport.git] / linux.c

/*
 * This file is part of the libserialport project.
 *
 * Copyright (C) 2014 Aurelien Jacobs <aurel@gnuage.org>
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as
 * published by the Free Software Foundation, either version 3 of the
 * License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#include "libserialport.h"
#include "libserialport_internal.h"

SP_PRIV enum sp_return get_port_details(struct sp_port *port)
{
	/* Description limited to 127 char,
	   anything longer would not be user friendly anyway */
	char description[128];
	int bus, address, vid, pid = -1;
	char manufacturer[128], product[128], serial[128];
	char baddr[32];
	const char dir_name[] = "/sys/class/tty/%s/device/%s%s";
	char sub_dir[32] = "", file_name[PATH_MAX];
	char *ptr, *dev = port->name + 5;
	FILE *file;
	int i, count;

	if (strncmp(port->name, "/dev/", 5))
		RETURN_ERROR(SP_ERR_ARG, "Device name not recognized.");

	snprintf(file_name, sizeof(file_name), "/sys/class/tty/%s", dev);
	count = readlink(file_name, file_name, sizeof(file_name));
	if (count <= 0 || count >= (int) sizeof(file_name)-1)
		RETURN_ERROR(SP_ERR_ARG, "Device not found.");
	file_name[count] = 0;
	if (strstr(file_name, "bluetooth"))
		port->transport = SP_TRANSPORT_BLUETOOTH;
	else if (strstr(file_name, "usb"))
		port->transport = SP_TRANSPORT_USB;

	if (port->transport == SP_TRANSPORT_USB) {
		for (i=0; i<5; i++) {
			strcat(sub_dir, "../");

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "busnum");
			if (!(file = fopen(file_name, "r")))
				continue;
			count = fscanf(file, "%d", &bus);
			fclose(file);
			if (count != 1)
				continue;

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "devnum");
			if (!(file = fopen(file_name, "r")))
				continue;
			count = fscanf(file, "%d", &address);
			fclose(file);
			if (count != 1)
				continue;

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "idVendor");
			if (!(file = fopen(file_name, "r")))
				continue;
			count = fscanf(file, "%4x", &vid);
			fclose(file);
			if (count != 1)
				continue;

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "idProduct");
			if (!(file = fopen(file_name, "r")))
				continue;
			count = fscanf(file, "%4x", &pid);
			fclose(file);
			if (count != 1)
				continue;

			port->usb_bus = bus;
			port->usb_address = address;
			port->usb_vid = vid;
			port->usb_pid = pid;

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "product");
			if ((file = fopen(file_name, "r"))) {
				if ((ptr = fgets(description, sizeof(description), file))) {
					ptr = description + strlen(description) - 1;
					if (ptr >= description && *ptr == '\n')
						*ptr = 0;
					port->description = strdup(description);
				}
				fclose(file);
			}
			if (!file || !ptr)
				port->description = strdup(dev);

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "manufacturer");
			if ((file = fopen(file_name, "r"))) {
				if ((ptr = fgets(manufacturer, sizeof(manufacturer), file))) {
					ptr = manufacturer + strlen(manufacturer) - 1;
					if (ptr >= manufacturer && *ptr == '\n')
						*ptr = 0;
					port->usb_manufacturer = strdup(manufacturer);
				}
				fclose(file);
			}

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "product");
			if ((file = fopen(file_name, "r"))) {
				if ((ptr = fgets(product, sizeof(product), file))) {
					ptr = product + strlen(product) - 1;
					if (ptr >= product && *ptr == '\n')
						*ptr = 0;
					port->usb_product = strdup(product);
				}
				fclose(file);
			}

			snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "serial");
			if ((file = fopen(file_name, "r"))) {
				if ((ptr = fgets(serial, sizeof(serial), file))) {
					ptr = serial + strlen(serial) - 1;
					if (ptr >= serial && *ptr == '\n')
						*ptr = 0;
					port->usb_serial = strdup(serial);
				}
				fclose(file);
			}

			break;
		}
	} else {
		port->description = strdup(dev);

		if (port->transport == SP_TRANSPORT_BLUETOOTH) {
			snprintf(file_name, sizeof(file_name), dir_name, dev, "", "address");
			if ((file = fopen(file_name, "r"))) {
				if ((ptr = fgets(baddr, sizeof(baddr), file))) {
					ptr = baddr + strlen(baddr) - 1;
					if (ptr >= baddr && *ptr == '\n')
						*ptr = 0;
					port->bluetooth_address = strdup(baddr);
				}
				fclose(file);
			}
		}
	}

	RETURN_OK();
}

SP_PRIV enum sp_return list_ports(struct sp_port ***list)
{
	char name[PATH_MAX], target[PATH_MAX];
	struct dirent entry, *result;
#ifdef HAVE_SERIAL_STRUCT
	struct serial_struct serial_info;
	int ioctl_result;
#endif
#ifndef HAVE_READLINKAT
	char buf[sizeof(entry.d_name) + 16];
#endif
	int len, fd;
	DIR *dir;
	int ret = SP_OK;

	DEBUG("Enumerating tty devices");
	if (!(dir = opendir("/sys/class/tty")))
		RETURN_FAIL("could not open /sys/class/tty");

	DEBUG("Iterating over results");
	while (!readdir_r(dir, &entry, &result) && result) {
#ifdef HAVE_READLINKAT
		len = readlinkat(dirfd(dir), entry.d_name, target, sizeof(target));
#else
		snprintf(buf, sizeof(buf), "/sys/class/tty/%s", entry.d_name);
		len = readlink(buf, target, sizeof(target));
#endif
		if (len <= 0 || len >= (int) sizeof(target)-1)
			continue;
		target[len] = 0;
		if (strstr(target, "virtual"))
			continue;
		snprintf(name, sizeof(name), "/dev/%s", entry.d_name);
		DEBUG_FMT("Found device %s", name);
		if (strstr(target, "serial8250")) {
			/* The serial8250 driver has a hardcoded number of ports.
			 * The only way to tell which actually exist on a given system
			 * is to try to open them and make an ioctl call. */
			DEBUG("serial8250 device, attempting to open");
			if ((fd = open(name, O_RDWR | O_NONBLOCK | O_NOCTTY)) < 0) {
				DEBUG("open failed, skipping");
				continue;
			}
#ifdef HAVE_SERIAL_STRUCT
			ioctl_result = ioctl(fd, TIOCGSERIAL, &serial_info);
#endif
			close(fd);
#ifdef HAVE_SERIAL_STRUCT
			if (ioctl_result != 0) {
				DEBUG("ioctl failed, skipping");
				continue;
			}
			if (serial_info.type == PORT_UNKNOWN) {
				DEBUG("port type is unknown, skipping");
				continue;
			}
#endif
		}
		DEBUG_FMT("Found port %s", name);
		*list = list_append(*list, name);
		if (!list) {
			SET_ERROR(ret, SP_ERR_MEM, "list append failed");
			break;
		}
	}
	closedir(dir);

	return ret;
}
Commit	Line	Data
e33dcf90 ML	1	/*
	2	* This file is part of the libserialport project.
	3	*
	4	* Copyright (C) 2014 Aurelien Jacobs <aurel@gnuage.org>
	5	*
	6	* This program is free software: you can redistribute it and/or modify
	7	* it under the terms of the GNU Lesser General Public License as
	8	* published by the Free Software Foundation, either version 3 of the
	9	* License, or (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU Lesser General Public License
	17	* along with this program. If not, see <http://www.gnu.org/licenses/>.
	18	*/
	19
	20	#include "libserialport.h"
	21	#include "libserialport_internal.h"
	22
970f279a	23	SP_PRIV enum sp_return get_port_details(struct sp_port *port)
e33dcf90 ML	24	{
	25	/* Description limited to 127 char,
	26	anything longer would not be user friendly anyway */
	27	char description[128];
	28	int bus, address, vid, pid = -1;
	29	char manufacturer[128], product[128], serial[128];
	30	char baddr[32];
	31	const char dir_name[] = "/sys/class/tty/%s/device/%s%s";
	32	char sub_dir[32] = "", file_name[PATH_MAX];
	33	char ptr, dev = port->name + 5;
	34	FILE *file;
	35	int i, count;
	36
	37	if (strncmp(port->name, "/dev/", 5))
7890cef6	38	RETURN_ERROR(SP_ERR_ARG, "Device name not recognized.");
e33dcf90 ML	39
	40	snprintf(file_name, sizeof(file_name), "/sys/class/tty/%s", dev);
	41	count = readlink(file_name, file_name, sizeof(file_name));
	42	if (count <= 0 \|\| count >= (int) sizeof(file_name)-1)
7890cef6	43	RETURN_ERROR(SP_ERR_ARG, "Device not found.");
e33dcf90 ML	44	file_name[count] = 0;
	45	if (strstr(file_name, "bluetooth"))
	46	port->transport = SP_TRANSPORT_BLUETOOTH;
	47	else if (strstr(file_name, "usb"))
	48	port->transport = SP_TRANSPORT_USB;
	49
	50	if (port->transport == SP_TRANSPORT_USB) {
	51	for (i=0; i<5; i++) {
	52	strcat(sub_dir, "../");
	53
	54	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "busnum");
	55	if (!(file = fopen(file_name, "r")))
	56	continue;
	57	count = fscanf(file, "%d", &bus);
	58	fclose(file);
	59	if (count != 1)
	60	continue;
	61
	62	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "devnum");
	63	if (!(file = fopen(file_name, "r")))
	64	continue;
	65	count = fscanf(file, "%d", &address);
	66	fclose(file);
	67	if (count != 1)
	68	continue;
	69
	70	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "idVendor");
	71	if (!(file = fopen(file_name, "r")))
	72	continue;
	73	count = fscanf(file, "%4x", &vid);
	74	fclose(file);
	75	if (count != 1)
	76	continue;
	77
	78	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "idProduct");
	79	if (!(file = fopen(file_name, "r")))
	80	continue;
	81	count = fscanf(file, "%4x", &pid);
	82	fclose(file);
	83	if (count != 1)
	84	continue;
	85
	86	port->usb_bus = bus;
	87	port->usb_address = address;
	88	port->usb_vid = vid;
	89	port->usb_pid = pid;
	90
	91	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "product");
	92	if ((file = fopen(file_name, "r"))) {
	93	if ((ptr = fgets(description, sizeof(description), file))) {
	94	ptr = description + strlen(description) - 1;
	95	if (ptr >= description && *ptr == '\n')
	96	*ptr = 0;
	97	port->description = strdup(description);
	98	}
	99	fclose(file);
	100	}
	101	if (!file \|\| !ptr)
	102	port->description = strdup(dev);
	103
	104	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "manufacturer");
	105	if ((file = fopen(file_name, "r"))) {
	106	if ((ptr = fgets(manufacturer, sizeof(manufacturer), file))) {
	107	ptr = manufacturer + strlen(manufacturer) - 1;
108	if (ptr >= manufacturer && *ptr == '\n')
109	*ptr = 0;
110	port->usb_manufacturer = strdup(manufacturer);
111	}
112	fclose(file);
113	}
114
115	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "product");
116	if ((file = fopen(file_name, "r"))) {
117	if ((ptr = fgets(product, sizeof(product), file))) {
118	ptr = product + strlen(product) - 1;
119	if (ptr >= product && *ptr == '\n')
120	*ptr = 0;
121	port->usb_product = strdup(product);
122	}
123	fclose(file);
124	}
125
126	snprintf(file_name, sizeof(file_name), dir_name, dev, sub_dir, "serial");
127	if ((file = fopen(file_name, "r"))) {
128	if ((ptr = fgets(serial, sizeof(serial), file))) {
129	ptr = serial + strlen(serial) - 1;
130	if (ptr >= serial && *ptr == '\n')
131	*ptr = 0;
132	port->usb_serial = strdup(serial);
133	}
134	fclose(file);
135	}
136
137	break;
138	}
139	} else {
140	port->description = strdup(dev);
141
142	if (port->transport == SP_TRANSPORT_BLUETOOTH) {
143	snprintf(file_name, sizeof(file_name), dir_name, dev, "", "address");
144	if ((file = fopen(file_name, "r"))) {
145	if ((ptr = fgets(baddr, sizeof(baddr), file))) {
146	ptr = baddr + strlen(baddr) - 1;
147	if (ptr >= baddr && *ptr == '\n')
148	*ptr = 0;
149	port->bluetooth_address = strdup(baddr);
150	}
151	fclose(file);
152	}
153	}
154	}
155
156	RETURN_OK();
157	}
48a4076f	158
970f279a	159	SP_PRIV enum sp_return list_ports(struct sp_port ***list)
48a4076f AJ	160	{
	161	char name[PATH_MAX], target[PATH_MAX];
	162	struct dirent entry, *result;
12056e2f	163	#ifdef HAVE_SERIAL_STRUCT
48a4076f	164	struct serial_struct serial_info;
12056e2f MC	165	int ioctl_result;
12056e2f MC	166	#endif
5bd33b7c MC	167	#ifndef HAVE_READLINKAT
	168	char buf[sizeof(entry.d_name) + 16];
	169	#endif
12056e2f	170	int len, fd;
48a4076f AJ	171	DIR *dir;
	172	int ret = SP_OK;
	173
	174	DEBUG("Enumerating tty devices");
	175	if (!(dir = opendir("/sys/class/tty")))
	176	RETURN_FAIL("could not open /sys/class/tty");
	177
	178	DEBUG("Iterating over results");
	179	while (!readdir_r(dir, &entry, &result) && result) {
5bd33b7c	180	#ifdef HAVE_READLINKAT
48a4076f	181	len = readlinkat(dirfd(dir), entry.d_name, target, sizeof(target));
5bd33b7c MC	182	#else
	183	snprintf(buf, sizeof(buf), "/sys/class/tty/%s", entry.d_name);
	184	len = readlink(buf, target, sizeof(target));
	185	#endif
48a4076f AJ	186	if (len <= 0 \|\| len >= (int) sizeof(target)-1)
	187	continue;
	188	target[len] = 0;
	189	if (strstr(target, "virtual"))
	190	continue;
	191	snprintf(name, sizeof(name), "/dev/%s", entry.d_name);
7890cef6	192	DEBUG_FMT("Found device %s", name);
48a4076f AJ	193	if (strstr(target, "serial8250")) {
	194	/* The serial8250 driver has a hardcoded number of ports.
	195	* The only way to tell which actually exist on a given system
	196	* is to try to open them and make an ioctl call. */
	197	DEBUG("serial8250 device, attempting to open");
	198	if ((fd = open(name, O_RDWR \| O_NONBLOCK \| O_NOCTTY)) < 0) {
	199	DEBUG("open failed, skipping");
	200	continue;
	201	}
12056e2f	202	#ifdef HAVE_SERIAL_STRUCT
48a4076f	203	ioctl_result = ioctl(fd, TIOCGSERIAL, &serial_info);
12056e2f	204	#endif
48a4076f	205	close(fd);
12056e2f	206	#ifdef HAVE_SERIAL_STRUCT
48a4076f AJ	207	if (ioctl_result != 0) {
	208	DEBUG("ioctl failed, skipping");
	209	continue;
	210	}
	211	if (serial_info.type == PORT_UNKNOWN) {
	212	DEBUG("port type is unknown, skipping");
	213	continue;
	214	}
12056e2f	215	#endif
48a4076f	216	}
7890cef6	217	DEBUG_FMT("Found port %s", name);
48a4076f AJ	218	list = list_append(list, name);
	219	if (!list) {
	220	SET_ERROR(ret, SP_ERR_MEM, "list append failed");
	221	break;
	222	}
	223	}
	224	closedir(dir);
	225
	226	return ret;
	227	}