16490c2ffSMaksim Yevmenkin %{ 26490c2ffSMaksim Yevmenkin /* 36490c2ffSMaksim Yevmenkin * parser.y 47aebfa93SMaksim Yevmenkin */ 57aebfa93SMaksim Yevmenkin 67aebfa93SMaksim Yevmenkin /*- 77aebfa93SMaksim Yevmenkin * Copyright (c) 2006 Maksim Yevmenkin <m_evmenkin@yahoo.com> 86490c2ffSMaksim Yevmenkin * All rights reserved. 96490c2ffSMaksim Yevmenkin * 106490c2ffSMaksim Yevmenkin * Redistribution and use in source and binary forms, with or without 116490c2ffSMaksim Yevmenkin * modification, are permitted provided that the following conditions 126490c2ffSMaksim Yevmenkin * are met: 136490c2ffSMaksim Yevmenkin * 1. Redistributions of source code must retain the above copyright 146490c2ffSMaksim Yevmenkin * notice, this list of conditions and the following disclaimer. 156490c2ffSMaksim Yevmenkin * 2. Redistributions in binary form must reproduce the above copyright 166490c2ffSMaksim Yevmenkin * notice, this list of conditions and the following disclaimer in the 176490c2ffSMaksim Yevmenkin * documentation and/or other materials provided with the distribution. 186490c2ffSMaksim Yevmenkin * 196490c2ffSMaksim Yevmenkin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 206490c2ffSMaksim Yevmenkin * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 216490c2ffSMaksim Yevmenkin * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 226490c2ffSMaksim Yevmenkin * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 236490c2ffSMaksim Yevmenkin * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 246490c2ffSMaksim Yevmenkin * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 256490c2ffSMaksim Yevmenkin * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 266490c2ffSMaksim Yevmenkin * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 276490c2ffSMaksim Yevmenkin * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 286490c2ffSMaksim Yevmenkin * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 296490c2ffSMaksim Yevmenkin * SUCH DAMAGE. 306490c2ffSMaksim Yevmenkin * 317aebfa93SMaksim Yevmenkin * $Id: parser.y,v 1.7 2006/09/07 21:06:53 max Exp $ 326490c2ffSMaksim Yevmenkin * $FreeBSD$ 336490c2ffSMaksim Yevmenkin */ 346490c2ffSMaksim Yevmenkin 356490c2ffSMaksim Yevmenkin #include <sys/queue.h> 368d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED 376490c2ffSMaksim Yevmenkin #include <bluetooth.h> 387aebfa93SMaksim Yevmenkin #include <dev/usb/usb.h> 397aebfa93SMaksim Yevmenkin #include <dev/usb/usbhid.h> 406490c2ffSMaksim Yevmenkin #include <errno.h> 416490c2ffSMaksim Yevmenkin #include <limits.h> 426490c2ffSMaksim Yevmenkin #include <stdio.h> 435e2a209aSBaptiste Daroussin #include <stdlib.h> 446490c2ffSMaksim Yevmenkin #include <string.h> 456490c2ffSMaksim Yevmenkin #include <unistd.h> 463adfd74aSMaksim Yevmenkin #include <usbhid.h> 476490c2ffSMaksim Yevmenkin 486490c2ffSMaksim Yevmenkin #ifndef BTHIDCONTROL 496490c2ffSMaksim Yevmenkin #include <stdarg.h> 506490c2ffSMaksim Yevmenkin #include <syslog.h> 516490c2ffSMaksim Yevmenkin #define SYSLOG syslog 526490c2ffSMaksim Yevmenkin #define LOGCRIT LOG_CRIT 536490c2ffSMaksim Yevmenkin #define LOGERR LOG_ERR 546490c2ffSMaksim Yevmenkin #define LOGWARNING LOG_WARNING 556490c2ffSMaksim Yevmenkin #define EOL 566490c2ffSMaksim Yevmenkin #else 576490c2ffSMaksim Yevmenkin #define SYSLOG fprintf 586490c2ffSMaksim Yevmenkin #define LOGCRIT stderr 596490c2ffSMaksim Yevmenkin #define LOGERR stderr 606490c2ffSMaksim Yevmenkin #define LOGWARNING stderr 616490c2ffSMaksim Yevmenkin #define EOL "\n" 626490c2ffSMaksim Yevmenkin #endif /* ndef BTHIDCONTROL */ 636490c2ffSMaksim Yevmenkin 646490c2ffSMaksim Yevmenkin #include "bthid_config.h" 656490c2ffSMaksim Yevmenkin 666490c2ffSMaksim Yevmenkin int yylex (void); 677aebfa93SMaksim Yevmenkin void yyerror (char const *); 687aebfa93SMaksim Yevmenkin static int32_t check_hid_device(hid_device_p hid_device); 696490c2ffSMaksim Yevmenkin static void free_hid_device (hid_device_p hid_device); 706490c2ffSMaksim Yevmenkin 717aebfa93SMaksim Yevmenkin extern FILE *yyin; 726490c2ffSMaksim Yevmenkin extern int yylineno; 737aebfa93SMaksim Yevmenkin char const *config_file = BTHIDD_CONFFILE; 747aebfa93SMaksim Yevmenkin char const *hids_file = BTHIDD_HIDSFILE; 756490c2ffSMaksim Yevmenkin 766490c2ffSMaksim Yevmenkin static char buffer[1024]; 777aebfa93SMaksim Yevmenkin static int32_t hid_descriptor_size; 786490c2ffSMaksim Yevmenkin static hid_device_t *hid_device = NULL; 796490c2ffSMaksim Yevmenkin static LIST_HEAD(, hid_device) hid_devices; 806490c2ffSMaksim Yevmenkin 816490c2ffSMaksim Yevmenkin %} 826490c2ffSMaksim Yevmenkin 836490c2ffSMaksim Yevmenkin %union { 846490c2ffSMaksim Yevmenkin bdaddr_t bdaddr; 857aebfa93SMaksim Yevmenkin int32_t num; 866490c2ffSMaksim Yevmenkin } 876490c2ffSMaksim Yevmenkin 886490c2ffSMaksim Yevmenkin %token <bdaddr> T_BDADDRSTRING 896490c2ffSMaksim Yevmenkin %token <num> T_HEXBYTE 90*6032284eSVladimir Kondratyev %token <num> T_HEXWORD 91*6032284eSVladimir Kondratyev %token T_DEVICE T_BDADDR T_VENDOR_ID T_PRODUCT_ID T_VERSION T_CONTROL_PSM 92*6032284eSVladimir Kondratyev %token T_INTERRUPT_PSM T_RECONNECT_INITIATE T_BATTERY_POWER 93*6032284eSVladimir Kondratyev %token T_NORMALLY_CONNECTABLE T_HID_DESCRIPTOR 946490c2ffSMaksim Yevmenkin %token T_TRUE T_FALSE T_ERROR 956490c2ffSMaksim Yevmenkin 966490c2ffSMaksim Yevmenkin %% 976490c2ffSMaksim Yevmenkin 986490c2ffSMaksim Yevmenkin config: line 996490c2ffSMaksim Yevmenkin | config line 1006490c2ffSMaksim Yevmenkin ; 1016490c2ffSMaksim Yevmenkin 1026490c2ffSMaksim Yevmenkin line: T_DEVICE 1036490c2ffSMaksim Yevmenkin { 1046490c2ffSMaksim Yevmenkin hid_device = (hid_device_t *) calloc(1, sizeof(*hid_device)); 1056490c2ffSMaksim Yevmenkin if (hid_device == NULL) { 1066490c2ffSMaksim Yevmenkin SYSLOG(LOGCRIT, "Could not allocate new " \ 1076490c2ffSMaksim Yevmenkin "config entry" EOL); 1086490c2ffSMaksim Yevmenkin YYABORT; 1096490c2ffSMaksim Yevmenkin } 1106490c2ffSMaksim Yevmenkin 1116490c2ffSMaksim Yevmenkin hid_device->new_device = 1; 1126490c2ffSMaksim Yevmenkin } 1136490c2ffSMaksim Yevmenkin '{' options '}' 1146490c2ffSMaksim Yevmenkin { 1156490c2ffSMaksim Yevmenkin if (check_hid_device(hid_device)) 1166490c2ffSMaksim Yevmenkin LIST_INSERT_HEAD(&hid_devices,hid_device,next); 1176490c2ffSMaksim Yevmenkin else 1186490c2ffSMaksim Yevmenkin free_hid_device(hid_device); 1196490c2ffSMaksim Yevmenkin 1206490c2ffSMaksim Yevmenkin hid_device = NULL; 1216490c2ffSMaksim Yevmenkin } 1226490c2ffSMaksim Yevmenkin ; 1236490c2ffSMaksim Yevmenkin 1246490c2ffSMaksim Yevmenkin options: option ';' 1256490c2ffSMaksim Yevmenkin | options option ';' 1266490c2ffSMaksim Yevmenkin ; 1276490c2ffSMaksim Yevmenkin 1286490c2ffSMaksim Yevmenkin option: bdaddr 129*6032284eSVladimir Kondratyev | vendor_id 130*6032284eSVladimir Kondratyev | product_id 131*6032284eSVladimir Kondratyev | version 1326490c2ffSMaksim Yevmenkin | control_psm 1336490c2ffSMaksim Yevmenkin | interrupt_psm 1346490c2ffSMaksim Yevmenkin | reconnect_initiate 1356490c2ffSMaksim Yevmenkin | battery_power 1366490c2ffSMaksim Yevmenkin | normally_connectable 1376490c2ffSMaksim Yevmenkin | hid_descriptor 1386490c2ffSMaksim Yevmenkin | parser_error 1396490c2ffSMaksim Yevmenkin ; 1406490c2ffSMaksim Yevmenkin 1416490c2ffSMaksim Yevmenkin bdaddr: T_BDADDR T_BDADDRSTRING 1426490c2ffSMaksim Yevmenkin { 1436490c2ffSMaksim Yevmenkin memcpy(&hid_device->bdaddr, &$2, sizeof(hid_device->bdaddr)); 1446490c2ffSMaksim Yevmenkin } 1456490c2ffSMaksim Yevmenkin ; 1466490c2ffSMaksim Yevmenkin 147*6032284eSVladimir Kondratyev vendor_id: T_VENDOR_ID T_HEXWORD 148*6032284eSVladimir Kondratyev { 149*6032284eSVladimir Kondratyev hid_device->vendor_id = $2; 150*6032284eSVladimir Kondratyev } 151*6032284eSVladimir Kondratyev ; 152*6032284eSVladimir Kondratyev 153*6032284eSVladimir Kondratyev product_id: T_PRODUCT_ID T_HEXWORD 154*6032284eSVladimir Kondratyev { 155*6032284eSVladimir Kondratyev hid_device->product_id = $2; 156*6032284eSVladimir Kondratyev } 157*6032284eSVladimir Kondratyev ; 158*6032284eSVladimir Kondratyev 159*6032284eSVladimir Kondratyev version: T_VERSION T_HEXWORD 160*6032284eSVladimir Kondratyev { 161*6032284eSVladimir Kondratyev hid_device->version = $2; 162*6032284eSVladimir Kondratyev } 163*6032284eSVladimir Kondratyev ; 164*6032284eSVladimir Kondratyev 1656490c2ffSMaksim Yevmenkin control_psm: T_CONTROL_PSM T_HEXBYTE 1666490c2ffSMaksim Yevmenkin { 1676490c2ffSMaksim Yevmenkin hid_device->control_psm = $2; 1686490c2ffSMaksim Yevmenkin } 1696490c2ffSMaksim Yevmenkin ; 1706490c2ffSMaksim Yevmenkin 1716490c2ffSMaksim Yevmenkin interrupt_psm: T_INTERRUPT_PSM T_HEXBYTE 1726490c2ffSMaksim Yevmenkin { 1736490c2ffSMaksim Yevmenkin hid_device->interrupt_psm = $2; 1746490c2ffSMaksim Yevmenkin } 1756490c2ffSMaksim Yevmenkin ; 1766490c2ffSMaksim Yevmenkin 1776490c2ffSMaksim Yevmenkin reconnect_initiate: T_RECONNECT_INITIATE T_TRUE 1786490c2ffSMaksim Yevmenkin { 1796490c2ffSMaksim Yevmenkin hid_device->reconnect_initiate = 1; 1806490c2ffSMaksim Yevmenkin } 1816490c2ffSMaksim Yevmenkin | T_RECONNECT_INITIATE T_FALSE 1826490c2ffSMaksim Yevmenkin { 1836490c2ffSMaksim Yevmenkin hid_device->reconnect_initiate = 0; 1846490c2ffSMaksim Yevmenkin } 1856490c2ffSMaksim Yevmenkin ; 1866490c2ffSMaksim Yevmenkin 1876490c2ffSMaksim Yevmenkin battery_power: T_BATTERY_POWER T_TRUE 1886490c2ffSMaksim Yevmenkin { 1896490c2ffSMaksim Yevmenkin hid_device->battery_power = 1; 1906490c2ffSMaksim Yevmenkin } 1916490c2ffSMaksim Yevmenkin | T_BATTERY_POWER T_FALSE 1926490c2ffSMaksim Yevmenkin { 1936490c2ffSMaksim Yevmenkin hid_device->battery_power = 0; 1946490c2ffSMaksim Yevmenkin } 1956490c2ffSMaksim Yevmenkin ; 1966490c2ffSMaksim Yevmenkin 1976490c2ffSMaksim Yevmenkin normally_connectable: T_NORMALLY_CONNECTABLE T_TRUE 1986490c2ffSMaksim Yevmenkin { 1996490c2ffSMaksim Yevmenkin hid_device->normally_connectable = 1; 2006490c2ffSMaksim Yevmenkin } 2016490c2ffSMaksim Yevmenkin | T_NORMALLY_CONNECTABLE T_FALSE 2026490c2ffSMaksim Yevmenkin { 2036490c2ffSMaksim Yevmenkin hid_device->normally_connectable = 0; 2046490c2ffSMaksim Yevmenkin } 2056490c2ffSMaksim Yevmenkin ; 2066490c2ffSMaksim Yevmenkin 2076490c2ffSMaksim Yevmenkin hid_descriptor: T_HID_DESCRIPTOR 2086490c2ffSMaksim Yevmenkin { 2096490c2ffSMaksim Yevmenkin hid_descriptor_size = 0; 2106490c2ffSMaksim Yevmenkin } 2116490c2ffSMaksim Yevmenkin '{' hid_descriptor_bytes '}' 2126490c2ffSMaksim Yevmenkin { 2136490c2ffSMaksim Yevmenkin if (hid_device->desc != NULL) 2146490c2ffSMaksim Yevmenkin hid_dispose_report_desc(hid_device->desc); 2156490c2ffSMaksim Yevmenkin 2166e9bee64SMaksim Yevmenkin hid_device->desc = hid_use_report_desc((unsigned char *) buffer, hid_descriptor_size); 2176490c2ffSMaksim Yevmenkin if (hid_device->desc == NULL) { 2186490c2ffSMaksim Yevmenkin SYSLOG(LOGCRIT, "Could not use HID descriptor" EOL); 2196490c2ffSMaksim Yevmenkin YYABORT; 2206490c2ffSMaksim Yevmenkin } 2216490c2ffSMaksim Yevmenkin } 2226490c2ffSMaksim Yevmenkin ; 2236490c2ffSMaksim Yevmenkin 2246490c2ffSMaksim Yevmenkin hid_descriptor_bytes: hid_descriptor_byte 2256490c2ffSMaksim Yevmenkin | hid_descriptor_bytes hid_descriptor_byte 2266490c2ffSMaksim Yevmenkin ; 2276490c2ffSMaksim Yevmenkin 2286490c2ffSMaksim Yevmenkin hid_descriptor_byte: T_HEXBYTE 2296490c2ffSMaksim Yevmenkin { 2307aebfa93SMaksim Yevmenkin if (hid_descriptor_size >= (int32_t) sizeof(buffer)) { 2316490c2ffSMaksim Yevmenkin SYSLOG(LOGCRIT, "HID descriptor is too big" EOL); 2326490c2ffSMaksim Yevmenkin YYABORT; 2336490c2ffSMaksim Yevmenkin } 2346490c2ffSMaksim Yevmenkin 2356490c2ffSMaksim Yevmenkin buffer[hid_descriptor_size ++] = $1; 2366490c2ffSMaksim Yevmenkin } 2376490c2ffSMaksim Yevmenkin ; 2386490c2ffSMaksim Yevmenkin 2396490c2ffSMaksim Yevmenkin parser_error: T_ERROR 2406490c2ffSMaksim Yevmenkin { 2416490c2ffSMaksim Yevmenkin YYABORT; 2426490c2ffSMaksim Yevmenkin } 2436490c2ffSMaksim Yevmenkin 2446490c2ffSMaksim Yevmenkin %% 2456490c2ffSMaksim Yevmenkin 2466490c2ffSMaksim Yevmenkin /* Display parser error message */ 2476490c2ffSMaksim Yevmenkin void 2486490c2ffSMaksim Yevmenkin yyerror(char const *message) 2496490c2ffSMaksim Yevmenkin { 2506490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "%s in line %d" EOL, message, yylineno); 2516490c2ffSMaksim Yevmenkin } 2526490c2ffSMaksim Yevmenkin 2536490c2ffSMaksim Yevmenkin /* Re-read config file */ 2547aebfa93SMaksim Yevmenkin int32_t 2556490c2ffSMaksim Yevmenkin read_config_file(void) 2566490c2ffSMaksim Yevmenkin { 2577aebfa93SMaksim Yevmenkin int32_t e; 2586490c2ffSMaksim Yevmenkin 2596490c2ffSMaksim Yevmenkin if (config_file == NULL) { 2606490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Unknown config file name!" EOL); 2616490c2ffSMaksim Yevmenkin return (-1); 2626490c2ffSMaksim Yevmenkin } 2636490c2ffSMaksim Yevmenkin 2646490c2ffSMaksim Yevmenkin if ((yyin = fopen(config_file, "r")) == NULL) { 2656490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Could not open config file '%s'. %s (%d)" EOL, 2666490c2ffSMaksim Yevmenkin config_file, strerror(errno), errno); 2676490c2ffSMaksim Yevmenkin return (-1); 2686490c2ffSMaksim Yevmenkin } 2696490c2ffSMaksim Yevmenkin 2706490c2ffSMaksim Yevmenkin clean_config(); 2716490c2ffSMaksim Yevmenkin if (yyparse() < 0) { 2726490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Could not parse config file '%s'" EOL, 2736490c2ffSMaksim Yevmenkin config_file); 2746490c2ffSMaksim Yevmenkin e = -1; 2756490c2ffSMaksim Yevmenkin } else 2766490c2ffSMaksim Yevmenkin e = 0; 2776490c2ffSMaksim Yevmenkin 2786490c2ffSMaksim Yevmenkin fclose(yyin); 2796490c2ffSMaksim Yevmenkin yyin = NULL; 2806490c2ffSMaksim Yevmenkin 2816490c2ffSMaksim Yevmenkin return (e); 2826490c2ffSMaksim Yevmenkin } 2836490c2ffSMaksim Yevmenkin 2846490c2ffSMaksim Yevmenkin /* Clean config */ 2856490c2ffSMaksim Yevmenkin void 2866490c2ffSMaksim Yevmenkin clean_config(void) 2876490c2ffSMaksim Yevmenkin { 2886490c2ffSMaksim Yevmenkin while (!LIST_EMPTY(&hid_devices)) { 2897aebfa93SMaksim Yevmenkin hid_device_p d = LIST_FIRST(&hid_devices); 2906490c2ffSMaksim Yevmenkin 2917aebfa93SMaksim Yevmenkin LIST_REMOVE(d, next); 2927aebfa93SMaksim Yevmenkin free_hid_device(d); 2936490c2ffSMaksim Yevmenkin } 2946490c2ffSMaksim Yevmenkin } 2956490c2ffSMaksim Yevmenkin 2966490c2ffSMaksim Yevmenkin /* Lookup config entry */ 2976490c2ffSMaksim Yevmenkin hid_device_p 2986490c2ffSMaksim Yevmenkin get_hid_device(bdaddr_p bdaddr) 2996490c2ffSMaksim Yevmenkin { 3007aebfa93SMaksim Yevmenkin hid_device_p d; 3016490c2ffSMaksim Yevmenkin 3027aebfa93SMaksim Yevmenkin LIST_FOREACH(d, &hid_devices, next) 3037aebfa93SMaksim Yevmenkin if (memcmp(&d->bdaddr, bdaddr, sizeof(bdaddr_t)) == 0) 3046490c2ffSMaksim Yevmenkin break; 3056490c2ffSMaksim Yevmenkin 3067aebfa93SMaksim Yevmenkin return (d); 3076490c2ffSMaksim Yevmenkin } 3086490c2ffSMaksim Yevmenkin 3096490c2ffSMaksim Yevmenkin /* Get next config entry */ 3106490c2ffSMaksim Yevmenkin hid_device_p 3116490c2ffSMaksim Yevmenkin get_next_hid_device(hid_device_p d) 3126490c2ffSMaksim Yevmenkin { 3136490c2ffSMaksim Yevmenkin return ((d == NULL)? LIST_FIRST(&hid_devices) : LIST_NEXT(d, next)); 3146490c2ffSMaksim Yevmenkin } 3156490c2ffSMaksim Yevmenkin 3166490c2ffSMaksim Yevmenkin /* Print config entry */ 3176490c2ffSMaksim Yevmenkin void 3187aebfa93SMaksim Yevmenkin print_hid_device(hid_device_p d, FILE *f) 3196490c2ffSMaksim Yevmenkin { 3206490c2ffSMaksim Yevmenkin /* XXX FIXME hack! */ 3216490c2ffSMaksim Yevmenkin struct report_desc { 3226490c2ffSMaksim Yevmenkin unsigned int size; 3236490c2ffSMaksim Yevmenkin unsigned char data[1]; 3246490c2ffSMaksim Yevmenkin }; 3256490c2ffSMaksim Yevmenkin /* XXX FIXME hack! */ 3266490c2ffSMaksim Yevmenkin 3277aebfa93SMaksim Yevmenkin struct report_desc *desc = (struct report_desc *) d->desc; 3287aebfa93SMaksim Yevmenkin uint32_t i; 3296490c2ffSMaksim Yevmenkin 3306490c2ffSMaksim Yevmenkin fprintf(f, 3316490c2ffSMaksim Yevmenkin "device {\n" \ 3326490c2ffSMaksim Yevmenkin " bdaddr %s;\n" \ 333*6032284eSVladimir Kondratyev " vendor_id 0x%04x;\n" \ 334*6032284eSVladimir Kondratyev " product_id 0x%04x;\n" \ 335*6032284eSVladimir Kondratyev " version 0x%04x;\n" \ 3366490c2ffSMaksim Yevmenkin " control_psm 0x%x;\n" \ 3379fbe483aSMaksim Yevmenkin " interrupt_psm 0x%x;\n" \ 3386490c2ffSMaksim Yevmenkin " reconnect_initiate %s;\n" \ 3396490c2ffSMaksim Yevmenkin " battery_power %s;\n" \ 3406490c2ffSMaksim Yevmenkin " normally_connectable %s;\n" \ 3416490c2ffSMaksim Yevmenkin " hid_descriptor {", 3427aebfa93SMaksim Yevmenkin bt_ntoa(&d->bdaddr, NULL), 343*6032284eSVladimir Kondratyev d->vendor_id, d->product_id, d->version, 3447aebfa93SMaksim Yevmenkin d->control_psm, d->interrupt_psm, 3457aebfa93SMaksim Yevmenkin d->reconnect_initiate? "true" : "false", 3467aebfa93SMaksim Yevmenkin d->battery_power? "true" : "false", 3477aebfa93SMaksim Yevmenkin d->normally_connectable? "true" : "false"); 3486490c2ffSMaksim Yevmenkin 3496490c2ffSMaksim Yevmenkin for (i = 0; i < desc->size; i ++) { 3506490c2ffSMaksim Yevmenkin if ((i % 8) == 0) 351c46a9ea8SMaksim Yevmenkin fprintf(f, "\n "); 3526490c2ffSMaksim Yevmenkin 3536490c2ffSMaksim Yevmenkin fprintf(f, "0x%2.2x ", desc->data[i]); 3546490c2ffSMaksim Yevmenkin } 3556490c2ffSMaksim Yevmenkin 356c46a9ea8SMaksim Yevmenkin fprintf(f, 3576490c2ffSMaksim Yevmenkin "\n" \ 3586490c2ffSMaksim Yevmenkin " };\n" \ 3596490c2ffSMaksim Yevmenkin "}\n"); 3606490c2ffSMaksim Yevmenkin } 3616490c2ffSMaksim Yevmenkin 3626490c2ffSMaksim Yevmenkin /* Check config entry */ 3637aebfa93SMaksim Yevmenkin static int32_t 3647aebfa93SMaksim Yevmenkin check_hid_device(hid_device_p d) 3656490c2ffSMaksim Yevmenkin { 3667aebfa93SMaksim Yevmenkin hid_data_t hd; 3677aebfa93SMaksim Yevmenkin hid_item_t hi; 3687aebfa93SMaksim Yevmenkin int32_t page; 3697aebfa93SMaksim Yevmenkin 3707aebfa93SMaksim Yevmenkin if (get_hid_device(&d->bdaddr) != NULL) { 3716490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Ignoring duplicated entry for bdaddr %s" EOL, 3727aebfa93SMaksim Yevmenkin bt_ntoa(&d->bdaddr, NULL)); 3736490c2ffSMaksim Yevmenkin return (0); 3746490c2ffSMaksim Yevmenkin } 3756490c2ffSMaksim Yevmenkin 3767aebfa93SMaksim Yevmenkin if (d->control_psm == 0) { 3776490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Ignoring entry with invalid control PSM" EOL); 3786490c2ffSMaksim Yevmenkin return (0); 3796490c2ffSMaksim Yevmenkin } 3806490c2ffSMaksim Yevmenkin 3817aebfa93SMaksim Yevmenkin if (d->interrupt_psm == 0) { 3826490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Ignoring entry with invalid interrupt PSM" EOL); 3836490c2ffSMaksim Yevmenkin return (0); 3846490c2ffSMaksim Yevmenkin } 3856490c2ffSMaksim Yevmenkin 3867aebfa93SMaksim Yevmenkin if (d->desc == NULL) { 3876490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Ignoring entry without HID descriptor" EOL); 3886490c2ffSMaksim Yevmenkin return (0); 3896490c2ffSMaksim Yevmenkin } 3906490c2ffSMaksim Yevmenkin 3917aebfa93SMaksim Yevmenkin /* XXX somehow need to make sure descriptor is valid */ 3927aebfa93SMaksim Yevmenkin for (hd = hid_start_parse(d->desc, ~0, -1); hid_get_item(hd, &hi) > 0; ) { 3937aebfa93SMaksim Yevmenkin switch (hi.kind) { 3947aebfa93SMaksim Yevmenkin case hid_collection: 3957aebfa93SMaksim Yevmenkin case hid_endcollection: 3967aebfa93SMaksim Yevmenkin case hid_output: 3977aebfa93SMaksim Yevmenkin case hid_feature: 3987aebfa93SMaksim Yevmenkin break; 3997aebfa93SMaksim Yevmenkin 4007aebfa93SMaksim Yevmenkin case hid_input: 4017aebfa93SMaksim Yevmenkin /* Check if the device may send keystrokes */ 4027aebfa93SMaksim Yevmenkin page = HID_PAGE(hi.usage); 40306912ebaSMaksim Yevmenkin if (page == HUP_KEYBOARD) 4047aebfa93SMaksim Yevmenkin d->keyboard = 1; 4057aebfa93SMaksim Yevmenkin break; 4067aebfa93SMaksim Yevmenkin } 4077aebfa93SMaksim Yevmenkin } 4087aebfa93SMaksim Yevmenkin hid_end_parse(hd); 4097aebfa93SMaksim Yevmenkin 4106490c2ffSMaksim Yevmenkin return (1); 4116490c2ffSMaksim Yevmenkin } 4126490c2ffSMaksim Yevmenkin 4136490c2ffSMaksim Yevmenkin /* Free config entry */ 4146490c2ffSMaksim Yevmenkin static void 4157aebfa93SMaksim Yevmenkin free_hid_device(hid_device_p d) 4166490c2ffSMaksim Yevmenkin { 4177aebfa93SMaksim Yevmenkin if (d->desc != NULL) 4187aebfa93SMaksim Yevmenkin hid_dispose_report_desc(d->desc); 4196490c2ffSMaksim Yevmenkin 4207aebfa93SMaksim Yevmenkin memset(d, 0, sizeof(*d)); 4217aebfa93SMaksim Yevmenkin free(d); 4226490c2ffSMaksim Yevmenkin } 4236490c2ffSMaksim Yevmenkin 4246490c2ffSMaksim Yevmenkin /* Re-read hids file */ 4257aebfa93SMaksim Yevmenkin int32_t 4266490c2ffSMaksim Yevmenkin read_hids_file(void) 4276490c2ffSMaksim Yevmenkin { 4287aebfa93SMaksim Yevmenkin FILE *f; 4297aebfa93SMaksim Yevmenkin hid_device_t *d; 4307aebfa93SMaksim Yevmenkin char *line; 4316490c2ffSMaksim Yevmenkin bdaddr_t bdaddr; 4327aebfa93SMaksim Yevmenkin int32_t lineno; 4336490c2ffSMaksim Yevmenkin 4346490c2ffSMaksim Yevmenkin if (hids_file == NULL) { 4356490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Unknown HIDs file name!" EOL); 4366490c2ffSMaksim Yevmenkin return (-1); 4376490c2ffSMaksim Yevmenkin } 4386490c2ffSMaksim Yevmenkin 4396490c2ffSMaksim Yevmenkin if ((f = fopen(hids_file, "r")) == NULL) { 4406490c2ffSMaksim Yevmenkin if (errno == ENOENT) 4416490c2ffSMaksim Yevmenkin return (0); 4426490c2ffSMaksim Yevmenkin 4436490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Could not open HIDs file '%s'. %s (%d)" EOL, 4446490c2ffSMaksim Yevmenkin hids_file, strerror(errno), errno); 4456490c2ffSMaksim Yevmenkin return (-1); 4466490c2ffSMaksim Yevmenkin } 4476490c2ffSMaksim Yevmenkin 4486490c2ffSMaksim Yevmenkin for (lineno = 1; fgets(buffer, sizeof(buffer), f) != NULL; lineno ++) { 4496490c2ffSMaksim Yevmenkin if ((line = strtok(buffer, "\r\n\t ")) == NULL) 4506490c2ffSMaksim Yevmenkin continue; /* ignore empty lines */ 4516490c2ffSMaksim Yevmenkin 4526490c2ffSMaksim Yevmenkin if (!bt_aton(line, &bdaddr)) { 4536490c2ffSMaksim Yevmenkin SYSLOG(LOGWARNING, "Ignoring unparseable BD_ADDR in " \ 4546490c2ffSMaksim Yevmenkin "%s:%d" EOL, hids_file, lineno); 4556490c2ffSMaksim Yevmenkin continue; 4566490c2ffSMaksim Yevmenkin } 4576490c2ffSMaksim Yevmenkin 4587aebfa93SMaksim Yevmenkin if ((d = get_hid_device(&bdaddr)) != NULL) 4597aebfa93SMaksim Yevmenkin d->new_device = 0; 4606490c2ffSMaksim Yevmenkin } 4616490c2ffSMaksim Yevmenkin 4626490c2ffSMaksim Yevmenkin fclose(f); 4636490c2ffSMaksim Yevmenkin 4646490c2ffSMaksim Yevmenkin return (0); 4656490c2ffSMaksim Yevmenkin } 4666490c2ffSMaksim Yevmenkin 4676490c2ffSMaksim Yevmenkin /* Write hids file */ 4687aebfa93SMaksim Yevmenkin int32_t 4696490c2ffSMaksim Yevmenkin write_hids_file(void) 4706490c2ffSMaksim Yevmenkin { 4716490c2ffSMaksim Yevmenkin char path[PATH_MAX]; 4727aebfa93SMaksim Yevmenkin FILE *f; 4737aebfa93SMaksim Yevmenkin hid_device_t *d; 4746490c2ffSMaksim Yevmenkin 4756490c2ffSMaksim Yevmenkin if (hids_file == NULL) { 4766490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Unknown HIDs file name!" EOL); 4776490c2ffSMaksim Yevmenkin return (-1); 4786490c2ffSMaksim Yevmenkin } 4796490c2ffSMaksim Yevmenkin 4806490c2ffSMaksim Yevmenkin snprintf(path, sizeof(path), "%s.new", hids_file); 4816490c2ffSMaksim Yevmenkin 4826490c2ffSMaksim Yevmenkin if ((f = fopen(path, "w")) == NULL) { 4836490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Could not open HIDs file '%s'. %s (%d)" EOL, 4846490c2ffSMaksim Yevmenkin path, strerror(errno), errno); 4856490c2ffSMaksim Yevmenkin return (-1); 4866490c2ffSMaksim Yevmenkin } 4876490c2ffSMaksim Yevmenkin 4887aebfa93SMaksim Yevmenkin LIST_FOREACH(d, &hid_devices, next) 4897aebfa93SMaksim Yevmenkin if (!d->new_device) 4907aebfa93SMaksim Yevmenkin fprintf(f, "%s\n", bt_ntoa(&d->bdaddr, NULL)); 4916490c2ffSMaksim Yevmenkin 4926490c2ffSMaksim Yevmenkin fclose(f); 4936490c2ffSMaksim Yevmenkin 4946490c2ffSMaksim Yevmenkin if (rename(path, hids_file) < 0) { 4956490c2ffSMaksim Yevmenkin SYSLOG(LOGERR, "Could not rename new HIDs file '%s' to '%s'. " \ 4966490c2ffSMaksim Yevmenkin "%s (%d)" EOL, path, hids_file, strerror(errno), errno); 4976490c2ffSMaksim Yevmenkin unlink(path); 4986490c2ffSMaksim Yevmenkin return (-1); 4996490c2ffSMaksim Yevmenkin } 5006490c2ffSMaksim Yevmenkin 5016490c2ffSMaksim Yevmenkin return (0); 5026490c2ffSMaksim Yevmenkin } 5036490c2ffSMaksim Yevmenkin 504