2 * Copyright © 2010 Keith Packard <keithp@keithp.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; version 2 of the License.
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
13 * You should have received a copy of the GNU General Public License along
14 * with this program; if not, write to the Free Software Foundation, Inc.,
15 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
23 #define BLUETOOTH_PRODUCT_TELEBT "TeleBT"
30 return LIBALTOS_SUCCESS;
38 static struct altos_error last_error;
41 altos_set_last_error(int code, char *string)
43 last_error.code = code;
44 strncpy(last_error.string, string, sizeof (last_error.string) -1);
45 last_error.string[sizeof(last_error.string)-1] = '\0';
49 altos_get_last_error(struct altos_error *error)
58 /* Mac OS X don't have strndup even if _GNU_SOURCE is defined */
60 altos_strndup (const char *s, size_t n)
62 size_t len = strlen (s);
74 #define altos_strndup strndup
85 #define USB_BUF_SIZE 64
94 unsigned char out_data[USB_BUF_SIZE];
96 unsigned char in_data[USB_BUF_SIZE];
102 altos_set_last_posix_error(void)
104 altos_set_last_error(errno, strerror(errno));
107 PUBLIC struct altos_file *
108 altos_open(struct altos_device *device)
110 struct altos_file *file = calloc (sizeof (struct altos_file), 1);
115 altos_set_last_posix_error();
119 // altos_set_last_error(12, "yeah yeah, failed again");
123 file->fd = open(device->path, O_RDWR | O_NOCTTY);
125 altos_set_last_posix_error();
132 file->out_fd = open(device->path, O_RDWR | O_NOCTTY);
133 if (file->out_fd < 0) {
134 altos_set_last_posix_error();
140 ret = tcgetattr(file->fd, &term);
142 altos_set_last_posix_error();
151 cfsetospeed(&term, B9600);
152 cfsetispeed(&term, B9600);
155 term.c_cc[VTIME] = 0;
158 term.c_cc[VTIME] = 1;
160 ret = tcsetattr(file->fd, TCSAFLUSH, &term);
162 altos_set_last_posix_error();
174 altos_close(struct altos_file *file)
176 if (file->fd != -1) {
180 write(file->pipe[1], "\r", 1);
190 altos_free(struct altos_file *file)
197 altos_flush(struct altos_file *file)
199 if (file->out_used && 0) {
201 fwrite(file->out_data, 1, file->out_used, stdout);
204 while (file->out_used) {
210 ret = write (file->fd, file->out_data, file->out_used);
212 ret = write (file->out_fd, file->out_data, file->out_used);
215 altos_set_last_posix_error();
216 return -last_error.code;
219 memmove(file->out_data, file->out_data + ret,
220 file->out_used - ret);
221 file->out_used -= ret;
228 altos_putchar(struct altos_file *file, char c)
232 if (file->out_used == USB_BUF_SIZE) {
233 ret = altos_flush(file);
238 file->out_data[file->out_used++] = c;
240 if (file->out_used == USB_BUF_SIZE)
241 ret = altos_flush(file);
250 altos_fill(struct altos_file *file, int timeout)
259 while (file->in_read == file->in_used) {
261 return LIBALTOS_ERROR;
264 fd[0].events = POLLIN|POLLERR|POLLHUP|POLLNVAL;
265 fd[1].fd = file->pipe[0];
266 fd[1].events = POLLIN;
267 ret = poll(fd, 2, timeout);
269 altos_set_last_posix_error();
270 return LIBALTOS_ERROR;
273 return LIBALTOS_TIMEOUT;
275 if (fd[0].revents & (POLLHUP|POLLERR|POLLNVAL))
276 return LIBALTOS_ERROR;
277 if (fd[0].revents & POLLIN)
280 ret = read(file->fd, file->in_data, USB_BUF_SIZE);
282 altos_set_last_posix_error();
283 return LIBALTOS_ERROR;
288 if (ret == 0 && timeout > 0)
289 return LIBALTOS_TIMEOUT;
293 if (file->in_used && 0) {
295 fwrite(file->in_data, 1, file->in_used, stdout);
302 altos_getchar(struct altos_file *file, int timeout)
305 while (file->in_read == file->in_used) {
307 return LIBALTOS_ERROR;
308 ret = altos_fill(file, timeout);
312 return file->in_data[file->in_read++];
315 #endif /* POSIX_TTY */
318 * Scan for Altus Metrum devices by looking through /sys
329 #include <bluetooth/bluetooth.h>
330 #include <bluetooth/hci.h>
331 #include <bluetooth/hci_lib.h>
332 #include <bluetooth/rfcomm.h>
335 cc_fullname (char *dir, char *file)
338 int dlen = strlen (dir);
339 int flen = strlen (file);
342 if (dir[dlen-1] != '/')
344 new = malloc (dlen + slen + flen + 1);
355 cc_basename(char *file)
359 b = strrchr(file, '/');
366 load_string(char *dir, char *file)
368 char *full = cc_fullname(dir, file);
374 f = fopen(full, "r");
378 r = fgets(line, sizeof (line), f);
383 if (r[rlen-1] == '\n')
389 load_hex(char *dir, char *file)
395 line = load_string(dir, file);
398 i = strtol(line, &end, 16);
406 load_dec(char *dir, char *file)
412 line = load_string(dir, file);
415 i = strtol(line, &end, 10);
423 dir_filter_tty_colon(const struct dirent *d)
425 return strncmp(d->d_name, "tty:", 4) == 0;
429 dir_filter_tty(const struct dirent *d)
431 return strncmp(d->d_name, "tty", 3) == 0;
434 struct altos_usbdev {
439 int serial; /* AltOS always uses simple integer serial numbers */
450 struct dirent **namelist;
453 char endpoint_base[20];
459 base = cc_basename(sys);
460 num_configs = load_hex(sys, "bNumConfigurations");
461 num_interfaces = load_hex(sys, "bNumInterfaces");
462 for (config = 1; config <= num_configs; config++) {
463 for (interface = 0; interface < num_interfaces; interface++) {
464 sprintf(endpoint_base, "%s:%d.%d",
465 base, config, interface);
466 endpoint_full = cc_fullname(sys, endpoint_base);
469 /* Check for tty:ttyACMx style names
471 ntty = scandir(endpoint_full, &namelist,
472 dir_filter_tty_colon,
476 tty = cc_fullname("/dev", namelist[0]->d_name + 4);
481 /* Check for ttyACMx style names
483 ntty = scandir(endpoint_full, &namelist,
488 tty = cc_fullname("/dev", namelist[0]->d_name);
493 /* Check for tty/ttyACMx style names
495 tty_dir = cc_fullname(endpoint_full, "tty");
497 ntty = scandir(tty_dir, &namelist,
502 tty = cc_fullname("/dev", namelist[0]->d_name);
512 static struct altos_usbdev *
513 usb_scan_device(char *sys)
515 struct altos_usbdev *usbdev;
521 usbdev = calloc(1, sizeof (struct altos_usbdev));
524 usbdev->sys = strdup(sys);
525 usbdev->manufacturer = load_string(sys, "manufacturer");
526 usbdev->product_name = load_string(sys, "product");
527 usbdev->serial = load_dec(sys, "serial");
528 usbdev->idProduct = load_hex(sys, "idProduct");
529 usbdev->idVendor = load_hex(sys, "idVendor");
535 usbdev_free(struct altos_usbdev *usbdev)
538 free(usbdev->manufacturer);
539 free(usbdev->product_name);
540 /* this can get used as a return value */
546 #define USB_DEVICES "/sys/bus/usb/devices"
549 dir_filter_dev(const struct dirent *d)
551 const char *n = d->d_name;
559 if (c == '.' && n != d->d_name + 1)
567 struct altos_usbdev **dev;
573 altos_list_start(void)
576 struct dirent **ents;
578 struct altos_usbdev *dev;
579 struct altos_list *devs;
582 devs = calloc(1, sizeof (struct altos_list));
586 n = scandir (USB_DEVICES, &ents,
591 for (e = 0; e < n; e++) {
592 dir = cc_fullname(USB_DEVICES, ents[e]->d_name);
593 dev = usb_scan_device(dir);
598 devs->dev = realloc(devs->dev,
599 (devs->ndev + 1) * sizeof (struct usbdev *));
601 devs->dev = malloc (sizeof (struct usbdev *));
602 devs->dev[devs->ndev++] = dev;
610 altos_list_next(struct altos_list *list, struct altos_device *device)
612 struct altos_usbdev *dev;
613 if (list->current >= list->ndev) {
616 dev = list->dev[list->current];
617 strcpy(device->name, dev->product_name);
618 device->vendor = dev->idVendor;
619 device->product = dev->idProduct;
620 strcpy(device->path, dev->tty);
621 device->serial = dev->serial;
627 altos_list_finish(struct altos_list *usbdevs)
633 for (i = 0; i < usbdevs->ndev; i++)
634 usbdev_free(usbdevs->dev[i]);
638 struct altos_bt_list {
646 #define INQUIRY_MAX_RSP 255
648 struct altos_bt_list *
649 altos_bt_list_start(int inquiry_time)
651 struct altos_bt_list *bt_list;
653 bt_list = calloc(1, sizeof (struct altos_bt_list));
657 bt_list->ii = calloc(INQUIRY_MAX_RSP, sizeof (inquiry_info));
660 bt_list->dev_id = hci_get_route(NULL);
661 if (bt_list->dev_id < 0)
664 bt_list->sock = hci_open_dev(bt_list->dev_id);
665 if (bt_list->sock < 0)
668 bt_list->num_rsp = hci_inquiry(bt_list->dev_id,
674 if (bt_list->num_rsp < 0)
681 close(bt_list->sock);
692 altos_bt_list_next(struct altos_bt_list *bt_list,
693 struct altos_bt_device *device)
697 if (bt_list->rsp >= bt_list->num_rsp)
700 ii = &bt_list->ii[bt_list->rsp];
701 ba2str(&ii->bdaddr, device->addr);
702 memset(&device->name, '\0', sizeof (device->name));
703 if (hci_read_remote_name(bt_list->sock, &ii->bdaddr,
704 sizeof (device->name),
705 device->name, 0) < 0) {
706 strcpy(device->name, "[unknown]");
713 altos_bt_list_finish(struct altos_bt_list *bt_list)
715 close(bt_list->sock);
721 altos_bt_fill_in(char *name, char *addr, struct altos_bt_device *device)
723 strncpy(device->name, name, sizeof (device->name));
724 device->name[sizeof(device->name)-1] = '\0';
725 strncpy(device->addr, addr, sizeof (device->addr));
726 device->addr[sizeof(device->addr)-1] = '\0';
730 altos_bt_open(struct altos_bt_device *device)
732 struct sockaddr_rc addr = { 0 };
734 struct altos_file *file;
736 file = calloc(1, sizeof (struct altos_file));
739 file->fd = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
741 altos_set_last_posix_error();
745 addr.rc_family = AF_BLUETOOTH;
747 str2ba(device->addr, &addr.rc_bdaddr);
749 status = connect(file->fd,
750 (struct sockaddr *)&addr,
753 altos_set_last_posix_error();
761 file->out_fd = dup(file->fd);
776 #include <IOKitLib.h>
777 #include <IOKit/usb/USBspec.h>
778 #include <sys/param.h>
780 #include <CFNumber.h>
787 io_iterator_t iterator;
791 get_string(io_object_t object, CFStringRef entry, char *result, int result_len)
793 CFTypeRef entry_as_string;
796 entry_as_string = IORegistryEntrySearchCFProperty (object,
800 kIORegistryIterateRecursively);
801 if (entry_as_string) {
802 got_string = CFStringGetCString(entry_as_string,
804 kCFStringEncodingASCII);
806 CFRelease(entry_as_string);
814 get_number(io_object_t object, CFStringRef entry, int *result)
816 CFTypeRef entry_as_number;
819 entry_as_number = IORegistryEntrySearchCFProperty (object,
823 kIORegistryIterateRecursively);
824 if (entry_as_number) {
825 got_number = CFNumberGetValue(entry_as_number,
834 PUBLIC struct altos_list *
835 altos_list_start(void)
837 struct altos_list *list = calloc (sizeof (struct altos_list), 1);
838 CFMutableDictionaryRef matching_dictionary = IOServiceMatching("IOUSBDevice");
839 io_iterator_t tdIterator;
840 io_object_t tdObject;
844 ret = IOServiceGetMatchingServices(kIOMasterPortDefault, matching_dictionary, &list->iterator);
845 if (ret != kIOReturnSuccess)
851 altos_list_next(struct altos_list *list, struct altos_device *device)
854 char serial_string[128];
857 object = IOIteratorNext(list->iterator);
861 if (!get_number (object, CFSTR(kUSBVendorID), &device->vendor) ||
862 !get_number (object, CFSTR(kUSBProductID), &device->product))
864 if (device->vendor != 0xfffe)
866 if (device->product < 0x000a || 0x0013 < device->product)
868 if (get_string (object, CFSTR("IOCalloutDevice"), device->path, sizeof (device->path)) &&
869 get_string (object, CFSTR("USB Product Name"), device->name, sizeof (device->name)) &&
870 get_string (object, CFSTR("USB Serial Number"), serial_string, sizeof (serial_string))) {
871 device->serial = atoi(serial_string);
878 altos_list_finish(struct altos_list *list)
880 IOObjectRelease (list->iterator);
884 struct altos_bt_list {
891 #define INQUIRY_MAX_RSP 255
893 struct altos_bt_list *
894 altos_bt_list_start(int inquiry_time)
900 altos_bt_list_next(struct altos_bt_list *bt_list,
901 struct altos_bt_device *device)
907 altos_bt_list_finish(struct altos_bt_list *bt_list)
912 altos_bt_fill_in(char *name, char *addr, struct altos_bt_device *device)
914 strncpy(device->name, name, sizeof (device->name));
915 device->name[sizeof(device->name)-1] = '\0';
916 strncpy(device->addr, addr, sizeof (device->addr));
917 device->addr[sizeof(device->addr)-1] = '\0';
921 altos_bt_open(struct altos_bt_device *device)
933 #include <setupapi.h>
940 #define USB_BUF_SIZE 64
944 unsigned char out_data[USB_BUF_SIZE];
946 unsigned char in_data[USB_BUF_SIZE];
955 _altos_set_last_windows_error(char *file, int line)
957 DWORD error = GetLastError();
959 FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM,
964 sizeof (message) / sizeof (TCHAR),
966 if (error != ERROR_SUCCESS)
967 printf ("%s:%d %s\n", file, line, message);
968 altos_set_last_error(error, message);
971 #define altos_set_last_windows_error() _altos_set_last_windows_error(__FILE__, __LINE__)
973 PUBLIC struct altos_list *
974 altos_list_start(void)
976 struct altos_list *list = calloc(1, sizeof (struct altos_list));
980 list->dev_info = SetupDiGetClassDevs(NULL, "USB", NULL,
981 DIGCF_ALLCLASSES|DIGCF_PRESENT);
982 if (list->dev_info == INVALID_HANDLE_VALUE) {
983 altos_set_last_windows_error();
992 altos_list_next(struct altos_list *list, struct altos_device *device)
994 SP_DEVINFO_DATA dev_info_data;
997 char friendlyname[256];
1001 unsigned int vid, pid;
1004 DWORD friendlyname_type;
1005 DWORD friendlyname_len;
1007 dev_info_data.cbSize = sizeof (SP_DEVINFO_DATA);
1008 while(SetupDiEnumDeviceInfo(list->dev_info, list->index,
1013 dev_key = SetupDiOpenDevRegKey(list->dev_info, &dev_info_data,
1014 DICS_FLAG_GLOBAL, 0, DIREG_DEV,
1016 if (dev_key == INVALID_HANDLE_VALUE) {
1017 altos_set_last_windows_error();
1018 printf("cannot open device registry key\n");
1022 /* Fetch symbolic name for this device and parse out
1023 * the vid/pid/serial info */
1024 symbolic_len = sizeof(symbolic);
1025 result = RegQueryValueEx(dev_key, "SymbolicName", NULL, NULL,
1026 symbolic, &symbolic_len);
1028 altos_set_last_windows_error();
1029 printf("cannot find SymbolicName value\n");
1030 RegCloseKey(dev_key);
1033 vid = pid = serial = 0;
1034 sscanf((char *) symbolic + sizeof("\\??\\USB#VID_") - 1,
1036 sscanf((char *) symbolic + sizeof("\\??\\USB#VID_XXXX&PID_") - 1,
1038 sscanf((char *) symbolic + sizeof("\\??\\USB#VID_XXXX&PID_XXXX#") - 1,
1041 /* Fetch the com port name */
1042 port_len = sizeof (port);
1043 result = RegQueryValueEx(dev_key, "PortName", NULL, NULL,
1045 RegCloseKey(dev_key);
1047 altos_set_last_windows_error();
1048 printf("failed to get PortName\n");
1052 /* Fetch the device description which is the device name,
1053 * with firmware that has unique USB ids */
1054 friendlyname_len = sizeof (friendlyname);
1055 if(!SetupDiGetDeviceRegistryProperty(list->dev_info,
1059 (BYTE *)friendlyname,
1060 sizeof(friendlyname),
1063 altos_set_last_windows_error();
1064 printf("Failed to get friendlyname\n");
1067 device->vendor = vid;
1068 device->product = pid;
1069 device->serial = serial;
1070 strcpy(device->name, friendlyname);
1072 strcpy(device->path, (char *) port);
1075 result = GetLastError();
1076 if (result != ERROR_NO_MORE_ITEMS) {
1077 altos_set_last_windows_error();
1078 printf ("SetupDiEnumDeviceInfo failed error %d\n", (int) result);
1084 altos_list_finish(struct altos_list *list)
1086 SetupDiDestroyDeviceInfoList(list->dev_info);
1091 altos_queue_read(struct altos_file *file)
1094 if (file->pend_read)
1095 return LIBALTOS_SUCCESS;
1097 if (!ReadFile(file->handle, file->in_data, USB_BUF_SIZE, &got, &file->ov_read)) {
1098 if (GetLastError() != ERROR_IO_PENDING) {
1099 altos_set_last_windows_error();
1100 return LIBALTOS_ERROR;
1102 file->pend_read = TRUE;
1104 file->pend_read = FALSE;
1106 file->in_used = got;
1108 return LIBALTOS_SUCCESS;
1112 altos_wait_read(struct altos_file *file, int timeout)
1117 if (!file->pend_read)
1118 return LIBALTOS_SUCCESS;
1123 ret = WaitForSingleObject(file->ov_read.hEvent, timeout);
1126 if (!GetOverlappedResult(file->handle, &file->ov_read, &got, FALSE)) {
1127 altos_set_last_windows_error();
1128 return LIBALTOS_ERROR;
1130 file->pend_read = FALSE;
1132 file->in_used = got;
1135 return LIBALTOS_TIMEOUT;
1138 return LIBALTOS_ERROR;
1140 return LIBALTOS_SUCCESS;
1144 altos_fill(struct altos_file *file, int timeout)
1148 if (file->in_read < file->in_used)
1149 return LIBALTOS_SUCCESS;
1151 file->in_read = file->in_used = 0;
1153 ret = altos_queue_read(file);
1156 ret = altos_wait_read(file, timeout);
1160 return LIBALTOS_SUCCESS;
1164 altos_flush(struct altos_file *file)
1167 unsigned char *data = file->out_data;
1168 int used = file->out_used;
1172 if (!WriteFile(file->handle, data, used, &put, &file->ov_write)) {
1173 if (GetLastError() != ERROR_IO_PENDING) {
1174 altos_set_last_windows_error();
1175 printf ("\tflush write error\n");
1176 return LIBALTOS_ERROR;
1178 ret = WaitForSingleObject(file->ov_write.hEvent, INFINITE);
1181 if (!GetOverlappedResult(file->handle, &file->ov_write, &put, FALSE)) {
1182 altos_set_last_windows_error();
1183 printf ("\tflush result error\n");
1184 return LIBALTOS_ERROR;
1188 altos_set_last_windows_error();
1189 printf ("\tflush wait error\n");
1190 return LIBALTOS_ERROR;
1197 return LIBALTOS_SUCCESS;
1200 PUBLIC struct altos_file *
1201 altos_open(struct altos_device *device)
1203 struct altos_file *file = calloc (1, sizeof (struct altos_file));
1205 COMMTIMEOUTS timeouts;
1210 strcpy(full_name, "\\\\.\\");
1211 strcat(full_name, device->path);
1212 file->handle = CreateFile(full_name, GENERIC_READ|GENERIC_WRITE,
1213 0, NULL, OPEN_EXISTING,
1214 FILE_FLAG_OVERLAPPED, NULL);
1215 if (file->handle == INVALID_HANDLE_VALUE) {
1216 altos_set_last_windows_error();
1217 printf ("cannot open %s\n", full_name);
1221 file->ov_read.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
1222 file->ov_write.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
1224 timeouts.ReadIntervalTimeout = MAXDWORD;
1225 timeouts.ReadTotalTimeoutMultiplier = MAXDWORD;
1226 timeouts.ReadTotalTimeoutConstant = 1 << 30; /* almost forever */
1227 timeouts.WriteTotalTimeoutMultiplier = 0;
1228 timeouts.WriteTotalTimeoutConstant = 0;
1229 SetCommTimeouts(file->handle, &timeouts);
1235 altos_close(struct altos_file *file)
1237 if (file->handle != INVALID_HANDLE_VALUE) {
1238 CloseHandle(file->handle);
1239 file->handle = INVALID_HANDLE_VALUE;
1240 SetEvent(file->ov_read.hEvent);
1241 SetEvent(file->ov_write.hEvent);
1242 CloseHandle(file->ov_read.hEvent);
1243 CloseHandle(file->ov_write.hEvent);
1248 altos_free(struct altos_file *file)
1255 altos_putchar(struct altos_file *file, char c)
1259 if (file->out_used == USB_BUF_SIZE) {
1260 ret = altos_flush(file);
1264 file->out_data[file->out_used++] = c;
1265 if (file->out_used == USB_BUF_SIZE)
1266 return altos_flush(file);
1267 return LIBALTOS_SUCCESS;
1271 altos_getchar(struct altos_file *file, int timeout)
1274 while (file->in_read == file->in_used) {
1275 if (file->handle == INVALID_HANDLE_VALUE)
1276 return LIBALTOS_ERROR;
1277 ret = altos_fill(file, timeout);
1281 return file->in_data[file->in_read++];
1284 struct altos_bt_list *
1285 altos_bt_list_start(int inquiry_time)
1291 altos_bt_list_next(struct altos_bt_list *bt_list,
1292 struct altos_bt_device *device)
1298 altos_bt_list_finish(struct altos_bt_list *bt_list)
1304 altos_bt_fill_in(char *name, char *addr, struct altos_bt_device *device)
1306 strncpy(device->name, name, sizeof (device->name));
1307 device->name[sizeof(device->name)-1] = '\0';
1308 strncpy(device->addr, addr, sizeof (device->addr));
1309 device->addr[sizeof(device->addr)-1] = '\0';
1313 altos_bt_open(struct altos_bt_device *device)