xref: /freebsd/usr.sbin/bluetooth/bthidd/parser.y (revision 6032284eb9cbdf7cf20bb465b2de3a3e5bfaab46)
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