1  | 
     | 
     | 
    /*	$OpenBSD: parse.c,v 1.11 2015/02/04 00:43:45 mpi Exp $	*/  | 
    
    
    2  | 
     | 
     | 
    /*	$NetBSD: parse.c,v 1.2 2001/12/29 20:44:22 augustss Exp $	*/  | 
    
    
    3  | 
     | 
     | 
     | 
    
    
    4  | 
     | 
     | 
    /*  | 
    
    
    5  | 
     | 
     | 
     * Copyright (c) 1999, 2001 Lennart Augustsson <augustss@netbsd.org>  | 
    
    
    6  | 
     | 
     | 
     * All rights reserved.  | 
    
    
    7  | 
     | 
     | 
     *  | 
    
    
    8  | 
     | 
     | 
     * Redistribution and use in source and binary forms, with or without  | 
    
    
    9  | 
     | 
     | 
     * modification, are permitted provided that the following conditions  | 
    
    
    10  | 
     | 
     | 
     * are met:  | 
    
    
    11  | 
     | 
     | 
     * 1. Redistributions of source code must retain the above copyright  | 
    
    
    12  | 
     | 
     | 
     *    notice, this list of conditions and the following disclaimer.  | 
    
    
    13  | 
     | 
     | 
     * 2. Redistributions in binary form must reproduce the above copyright  | 
    
    
    14  | 
     | 
     | 
     *    notice, this list of conditions and the following disclaimer in the  | 
    
    
    15  | 
     | 
     | 
     *    documentation and/or other materials provided with the distribution.  | 
    
    
    16  | 
     | 
     | 
     *  | 
    
    
    17  | 
     | 
     | 
     * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND  | 
    
    
    18  | 
     | 
     | 
     * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE  | 
    
    
    19  | 
     | 
     | 
     * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE  | 
    
    
    20  | 
     | 
     | 
     * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE  | 
    
    
    21  | 
     | 
     | 
     * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL  | 
    
    
    22  | 
     | 
     | 
     * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS  | 
    
    
    23  | 
     | 
     | 
     * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)  | 
    
    
    24  | 
     | 
     | 
     * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT  | 
    
    
    25  | 
     | 
     | 
     * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY  | 
    
    
    26  | 
     | 
     | 
     * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF  | 
    
    
    27  | 
     | 
     | 
     * SUCH DAMAGE.  | 
    
    
    28  | 
     | 
     | 
     */  | 
    
    
    29  | 
     | 
     | 
     | 
    
    
    30  | 
     | 
     | 
    #include <stdlib.h>  | 
    
    
    31  | 
     | 
     | 
    #include <string.h>  | 
    
    
    32  | 
     | 
     | 
     | 
    
    
    33  | 
     | 
     | 
    #include <dev/usb/usb.h>  | 
    
    
    34  | 
     | 
     | 
    #include <dev/usb/usbhid.h>  | 
    
    
    35  | 
     | 
     | 
     | 
    
    
    36  | 
     | 
     | 
    #include "usbhid.h"  | 
    
    
    37  | 
     | 
     | 
    #include "usbvar.h"  | 
    
    
    38  | 
     | 
     | 
     | 
    
    
    39  | 
     | 
     | 
    #define	MAXUSAGE 100  | 
    
    
    40  | 
     | 
     | 
    #define	MAXPUSH 4  | 
    
    
    41  | 
     | 
     | 
    #define	MAXID 64  | 
    
    
    42  | 
     | 
     | 
    #define	ITEMTYPES 3  | 
    
    
    43  | 
     | 
     | 
     | 
    
    
    44  | 
     | 
     | 
    struct hid_pos_data { | 
    
    
    45  | 
     | 
     | 
    	int32_t rid;  | 
    
    
    46  | 
     | 
     | 
    	uint32_t pos[ITEMTYPES];  | 
    
    
    47  | 
     | 
     | 
    };  | 
    
    
    48  | 
     | 
     | 
     | 
    
    
    49  | 
     | 
     | 
    struct hid_data { | 
    
    
    50  | 
     | 
     | 
    	const uint8_t *start;  | 
    
    
    51  | 
     | 
     | 
    	const uint8_t *end;  | 
    
    
    52  | 
     | 
     | 
    	const uint8_t *p;  | 
    
    
    53  | 
     | 
     | 
    	struct hid_item cur[MAXPUSH];  | 
    
    
    54  | 
     | 
     | 
    	struct hid_pos_data last_pos[MAXID];  | 
    
    
    55  | 
     | 
     | 
    	uint32_t pos[ITEMTYPES];  | 
    
    
    56  | 
     | 
     | 
    	int32_t usages_min[MAXUSAGE];  | 
    
    
    57  | 
     | 
     | 
    	int32_t usages_max[MAXUSAGE];  | 
    
    
    58  | 
     | 
     | 
    	int32_t usage_last;	/* last seen usage */  | 
    
    
    59  | 
     | 
     | 
    	uint32_t loc_size;	/* last seen size */  | 
    
    
    60  | 
     | 
     | 
    	uint32_t loc_count;	/* last seen count */  | 
    
    
    61  | 
     | 
     | 
    	uint8_t	kindset;	/* we have 5 kinds so 8 bits are enough */  | 
    
    
    62  | 
     | 
     | 
    	uint8_t	pushlevel;	/* current pushlevel */  | 
    
    
    63  | 
     | 
     | 
    	uint8_t	ncount;		/* end usage item count */  | 
    
    
    64  | 
     | 
     | 
    	uint8_t icount;		/* current usage item count */  | 
    
    
    65  | 
     | 
     | 
    	uint8_t	nusage;		/* end "usages_min/max" index */  | 
    
    
    66  | 
     | 
     | 
    	uint8_t	iusage;		/* current "usages_min/max" index */  | 
    
    
    67  | 
     | 
     | 
    	uint8_t ousage;		/* current "usages_min/max" offset */  | 
    
    
    68  | 
     | 
     | 
    	uint8_t	susage;		/* usage set flags */  | 
    
    
    69  | 
     | 
     | 
    	int32_t	reportid;	/* requested report ID */  | 
    
    
    70  | 
     | 
     | 
    	struct hid_item savedcoll; /* save coll until we know the ID */  | 
    
    
    71  | 
     | 
     | 
    	uint8_t hassavedcoll;  | 
    
    
    72  | 
     | 
     | 
    };  | 
    
    
    73  | 
     | 
     | 
     | 
    
    
    74  | 
     | 
     | 
    static void  | 
    
    
    75  | 
     | 
     | 
    hid_clear_local(hid_item_t *c)  | 
    
    
    76  | 
     | 
     | 
    { | 
    
    
    77  | 
     | 
     | 
     | 
    
    
    78  | 
     | 
     | 
    	c->usage = 0;  | 
    
    
    79  | 
     | 
     | 
    	c->usage_minimum = 0;  | 
    
    
    80  | 
     | 
     | 
    	c->usage_maximum = 0;  | 
    
    
    81  | 
     | 
     | 
    	c->designator_index = 0;  | 
    
    
    82  | 
     | 
     | 
    	c->designator_minimum = 0;  | 
    
    
    83  | 
     | 
     | 
    	c->designator_maximum = 0;  | 
    
    
    84  | 
     | 
     | 
    	c->string_index = 0;  | 
    
    
    85  | 
     | 
     | 
    	c->string_minimum = 0;  | 
    
    
    86  | 
     | 
     | 
    	c->string_maximum = 0;  | 
    
    
    87  | 
     | 
     | 
    	c->set_delimiter = 0;  | 
    
    
    88  | 
     | 
     | 
    }  | 
    
    
    89  | 
     | 
     | 
     | 
    
    
    90  | 
     | 
     | 
    static void  | 
    
    
    91  | 
     | 
     | 
    hid_switch_rid(struct hid_data *s, struct hid_item *c, int32_t next_rID)  | 
    
    
    92  | 
     | 
     | 
    { | 
    
    
    93  | 
     | 
     | 
    	uint8_t i, j;  | 
    
    
    94  | 
     | 
     | 
     | 
    
    
    95  | 
     | 
     | 
    	/* check for same report ID - optimise */  | 
    
    
    96  | 
     | 
     | 
     | 
    
    
    97  | 
     | 
     | 
    	if (c->report_ID == next_rID)  | 
    
    
    98  | 
     | 
     | 
    		return;  | 
    
    
    99  | 
     | 
     | 
     | 
    
    
    100  | 
     | 
     | 
    	/* save current position for current rID */  | 
    
    
    101  | 
     | 
     | 
     | 
    
    
    102  | 
     | 
     | 
    	if (c->report_ID == 0) { | 
    
    
    103  | 
     | 
     | 
    		i = 0;  | 
    
    
    104  | 
     | 
     | 
    	} else { | 
    
    
    105  | 
     | 
     | 
    		for (i = 1; i != MAXID; i++) { | 
    
    
    106  | 
     | 
     | 
    			if (s->last_pos[i].rid == c->report_ID)  | 
    
    
    107  | 
     | 
     | 
    				break;  | 
    
    
    108  | 
     | 
     | 
    			if (s->last_pos[i].rid == 0)  | 
    
    
    109  | 
     | 
     | 
    				break;  | 
    
    
    110  | 
     | 
     | 
    		}  | 
    
    
    111  | 
     | 
     | 
    	}  | 
    
    
    112  | 
     | 
     | 
    	if (i != MAXID) { | 
    
    
    113  | 
     | 
     | 
    		s->last_pos[i].rid = c->report_ID;  | 
    
    
    114  | 
     | 
     | 
    		for (j = 0; j < ITEMTYPES; j++)  | 
    
    
    115  | 
     | 
     | 
    			s->last_pos[i].pos[j] = s->pos[j];  | 
    
    
    116  | 
     | 
     | 
    	}  | 
    
    
    117  | 
     | 
     | 
     | 
    
    
    118  | 
     | 
     | 
    	/* store next report ID */  | 
    
    
    119  | 
     | 
     | 
     | 
    
    
    120  | 
     | 
     | 
    	c->report_ID = next_rID;  | 
    
    
    121  | 
     | 
     | 
     | 
    
    
    122  | 
     | 
     | 
    	/* lookup last position for next rID */  | 
    
    
    123  | 
     | 
     | 
     | 
    
    
    124  | 
     | 
     | 
    	if (next_rID == 0) { | 
    
    
    125  | 
     | 
     | 
    		i = 0;  | 
    
    
    126  | 
     | 
     | 
    	} else { | 
    
    
    127  | 
     | 
     | 
    		for (i = 1; i != MAXID; i++) { | 
    
    
    128  | 
     | 
     | 
    			if (s->last_pos[i].rid == next_rID)  | 
    
    
    129  | 
     | 
     | 
    				break;  | 
    
    
    130  | 
     | 
     | 
    			if (s->last_pos[i].rid == 0)  | 
    
    
    131  | 
     | 
     | 
    				break;  | 
    
    
    132  | 
     | 
     | 
    		}  | 
    
    
    133  | 
     | 
     | 
    	}  | 
    
    
    134  | 
     | 
     | 
    	if (i != MAXID) { | 
    
    
    135  | 
     | 
     | 
    		s->last_pos[i].rid = next_rID;  | 
    
    
    136  | 
     | 
     | 
    		for (j = 0; j < ITEMTYPES; j++)  | 
    
    
    137  | 
     | 
     | 
    			s->pos[j] = s->last_pos[i].pos[j];  | 
    
    
    138  | 
     | 
     | 
    	} else { | 
    
    
    139  | 
     | 
     | 
    		for (j = 0; j < ITEMTYPES; j++)  | 
    
    
    140  | 
     | 
     | 
    			s->pos[j] = 0;	/* Out of RID entries. */  | 
    
    
    141  | 
     | 
     | 
    	}  | 
    
    
    142  | 
     | 
     | 
    }  | 
    
    
    143  | 
     | 
     | 
     | 
    
    
    144  | 
     | 
     | 
    hid_data_t  | 
    
    
    145  | 
     | 
     | 
    hid_start_parse(report_desc_t d, int kindset, int id)  | 
    
    
    146  | 
     | 
     | 
    { | 
    
    
    147  | 
     | 
     | 
    	struct hid_data *s;  | 
    
    
    148  | 
     | 
     | 
     | 
    
    
    149  | 
     | 
     | 
    	s = calloc(1, sizeof *s);  | 
    
    
    150  | 
     | 
     | 
    	if (s == NULL)  | 
    
    
    151  | 
     | 
     | 
    		return (NULL);  | 
    
    
    152  | 
     | 
     | 
    	s->start = s->p = d->data;  | 
    
    
    153  | 
     | 
     | 
    	s->end = d->data + d->size;  | 
    
    
    154  | 
     | 
     | 
    	s->kindset = kindset;  | 
    
    
    155  | 
     | 
     | 
    	s->reportid = id;  | 
    
    
    156  | 
     | 
     | 
    	s->hassavedcoll = 0;  | 
    
    
    157  | 
     | 
     | 
    	return (s);  | 
    
    
    158  | 
     | 
     | 
    }  | 
    
    
    159  | 
     | 
     | 
     | 
    
    
    160  | 
     | 
     | 
    void  | 
    
    
    161  | 
     | 
     | 
    hid_end_parse(hid_data_t s)  | 
    
    
    162  | 
     | 
     | 
    { | 
    
    
    163  | 
     | 
     | 
     | 
    
    
    164  | 
     | 
     | 
    	if (s == NULL)  | 
    
    
    165  | 
     | 
     | 
    		return;  | 
    
    
    166  | 
     | 
     | 
     | 
    
    
    167  | 
     | 
     | 
    	free(s);  | 
    
    
    168  | 
     | 
     | 
    }  | 
    
    
    169  | 
     | 
     | 
     | 
    
    
    170  | 
     | 
     | 
    static uint8_t  | 
    
    
    171  | 
     | 
     | 
    hid_get_byte(struct hid_data *s, const uint16_t wSize)  | 
    
    
    172  | 
     | 
     | 
    { | 
    
    
    173  | 
     | 
     | 
    	const uint8_t *ptr;  | 
    
    
    174  | 
     | 
     | 
    	uint8_t retval;  | 
    
    
    175  | 
     | 
     | 
     | 
    
    
    176  | 
     | 
     | 
    	ptr = s->p;  | 
    
    
    177  | 
     | 
     | 
     | 
    
    
    178  | 
     | 
     | 
    	/* check if end is reached */  | 
    
    
    179  | 
     | 
     | 
    	if (ptr == s->end)  | 
    
    
    180  | 
     | 
     | 
    		return (0);  | 
    
    
    181  | 
     | 
     | 
     | 
    
    
    182  | 
     | 
     | 
    	/* read out a byte */  | 
    
    
    183  | 
     | 
     | 
    	retval = *ptr;  | 
    
    
    184  | 
     | 
     | 
     | 
    
    
    185  | 
     | 
     | 
    	/* check if data pointer can be advanced by "wSize" bytes */  | 
    
    
    186  | 
     | 
     | 
    	if ((s->end - ptr) < wSize)  | 
    
    
    187  | 
     | 
     | 
    		ptr = s->end;  | 
    
    
    188  | 
     | 
     | 
    	else  | 
    
    
    189  | 
     | 
     | 
    		ptr += wSize;  | 
    
    
    190  | 
     | 
     | 
     | 
    
    
    191  | 
     | 
     | 
    	/* update pointer */  | 
    
    
    192  | 
     | 
     | 
    	s->p = ptr;  | 
    
    
    193  | 
     | 
     | 
     | 
    
    
    194  | 
     | 
     | 
    	return (retval);  | 
    
    
    195  | 
     | 
     | 
    }  | 
    
    
    196  | 
     | 
     | 
     | 
    
    
    197  | 
     | 
     | 
    #define REPORT_SAVED_COLL \  | 
    
    
    198  | 
     | 
     | 
    	do { \ | 
    
    
    199  | 
     | 
     | 
    		if (s->hassavedcoll) { \ | 
    
    
    200  | 
     | 
     | 
    			*h = s->savedcoll; \  | 
    
    
    201  | 
     | 
     | 
    			h->report_ID = c->report_ID; \  | 
    
    
    202  | 
     | 
     | 
    			s->hassavedcoll = 0; \  | 
    
    
    203  | 
     | 
     | 
    			return (1); \  | 
    
    
    204  | 
     | 
     | 
    		} \  | 
    
    
    205  | 
     | 
     | 
    	} while(0)  | 
    
    
    206  | 
     | 
     | 
     | 
    
    
    207  | 
     | 
     | 
    static int  | 
    
    
    208  | 
     | 
     | 
    hid_get_item_raw(hid_data_t s, hid_item_t *h)  | 
    
    
    209  | 
     | 
     | 
    { | 
    
    
    210  | 
     | 
     | 
    	hid_item_t nc, *c;  | 
    
    
    211  | 
     | 
     | 
    	unsigned int bTag, bType, bSize;  | 
    
    
    212  | 
     | 
     | 
    	int32_t mask;  | 
    
    
    213  | 
     | 
     | 
    	int32_t dval;  | 
    
    
    214  | 
     | 
     | 
     | 
    
    
    215  | 
     | 
     | 
    	if (s == NULL)  | 
    
    
    216  | 
     | 
     | 
    		return (0);  | 
    
    
    217  | 
     | 
     | 
     | 
    
    
    218  | 
     | 
     | 
    	c = &s->cur[s->pushlevel];  | 
    
    
    219  | 
     | 
     | 
     | 
    
    
    220  | 
     | 
     | 
     top:  | 
    
    
    221  | 
     | 
     | 
    	/* check if there is an array of items */  | 
    
    
    222  | 
     | 
     | 
    	if (s->icount < s->ncount) { | 
    
    
    223  | 
     | 
     | 
    		REPORT_SAVED_COLL;  | 
    
    
    224  | 
     | 
     | 
    		/* get current usage */  | 
    
    
    225  | 
     | 
     | 
    		if (s->iusage < s->nusage) { | 
    
    
    226  | 
     | 
     | 
    			dval = s->usages_min[s->iusage] + s->ousage;  | 
    
    
    227  | 
     | 
     | 
    			c->usage = dval;  | 
    
    
    228  | 
     | 
     | 
    			s->usage_last = dval;  | 
    
    
    229  | 
     | 
     | 
    			if (dval == s->usages_max[s->iusage]) { | 
    
    
    230  | 
     | 
     | 
    				s->iusage ++;  | 
    
    
    231  | 
     | 
     | 
    				s->ousage = 0;  | 
    
    
    232  | 
     | 
     | 
    			} else { | 
    
    
    233  | 
     | 
     | 
    				s->ousage ++;  | 
    
    
    234  | 
     | 
     | 
    			}  | 
    
    
    235  | 
     | 
     | 
    		} else { | 
    
    
    236  | 
     | 
     | 
    			/* Using last usage */  | 
    
    
    237  | 
     | 
     | 
    			dval = s->usage_last;  | 
    
    
    238  | 
     | 
     | 
    		}  | 
    
    
    239  | 
     | 
     | 
    		s->icount ++;  | 
    
    
    240  | 
     | 
     | 
    		/*  | 
    
    
    241  | 
     | 
     | 
    		 * Only copy HID item, increment position and return  | 
    
    
    242  | 
     | 
     | 
    		 * if correct kindset!  | 
    
    
    243  | 
     | 
     | 
    		 */  | 
    
    
    244  | 
     | 
     | 
    		if (s->kindset & (1 << c->kind)) { | 
    
    
    245  | 
     | 
     | 
    			*h = *c;  | 
    
    
    246  | 
     | 
     | 
    			h->pos = s->pos[c->kind];  | 
    
    
    247  | 
     | 
     | 
    			s->pos[c->kind] += c->report_size * c->report_count;  | 
    
    
    248  | 
     | 
     | 
    			return (1);  | 
    
    
    249  | 
     | 
     | 
    		}  | 
    
    
    250  | 
     | 
     | 
    	}  | 
    
    
    251  | 
     | 
     | 
     | 
    
    
    252  | 
     | 
     | 
    	/* reset state variables */  | 
    
    
    253  | 
     | 
     | 
    	s->icount = 0;  | 
    
    
    254  | 
     | 
     | 
    	s->ncount = 0;  | 
    
    
    255  | 
     | 
     | 
    	s->iusage = 0;  | 
    
    
    256  | 
     | 
     | 
    	s->nusage = 0;  | 
    
    
    257  | 
     | 
     | 
    	s->susage = 0;  | 
    
    
    258  | 
     | 
     | 
    	s->ousage = 0;  | 
    
    
    259  | 
     | 
     | 
    	hid_clear_local(c);  | 
    
    
    260  | 
     | 
     | 
     | 
    
    
    261  | 
     | 
     | 
    	/* get next item */  | 
    
    
    262  | 
     | 
     | 
    	while (s->p != s->end) { | 
    
    
    263  | 
     | 
     | 
     | 
    
    
    264  | 
     | 
     | 
    		bSize = hid_get_byte(s, 1);  | 
    
    
    265  | 
     | 
     | 
    		if (bSize == 0xfe) { | 
    
    
    266  | 
     | 
     | 
    			/* long item */  | 
    
    
    267  | 
     | 
     | 
    			bSize = hid_get_byte(s, 1);  | 
    
    
    268  | 
     | 
     | 
    			bSize |= hid_get_byte(s, 1) << 8;  | 
    
    
    269  | 
     | 
     | 
    			bTag = hid_get_byte(s, 1);  | 
    
    
    270  | 
     | 
     | 
    			bType = 0xff;	/* XXX what should it be */  | 
    
    
    271  | 
     | 
     | 
    		} else { | 
    
    
    272  | 
     | 
     | 
    			/* short item */  | 
    
    
    273  | 
     | 
     | 
    			bTag = bSize >> 4;  | 
    
    
    274  | 
     | 
     | 
    			bType = (bSize >> 2) & 3;  | 
    
    
    275  | 
     | 
     | 
    			bSize &= 3;  | 
    
    
    276  | 
     | 
     | 
    			if (bSize == 3)  | 
    
    
    277  | 
     | 
     | 
    				bSize = 4;  | 
    
    
    278  | 
     | 
     | 
    		}  | 
    
    
    279  | 
     | 
     | 
     | 
    
    
    280  | 
     | 
     | 
    		switch(bSize) { | 
    
    
    281  | 
     | 
     | 
    		case 0:  | 
    
    
    282  | 
     | 
     | 
    			dval = 0;  | 
    
    
    283  | 
     | 
     | 
    			mask = 0;  | 
    
    
    284  | 
     | 
     | 
    			break;  | 
    
    
    285  | 
     | 
     | 
    		case 1:  | 
    
    
    286  | 
     | 
     | 
    			dval = (int8_t)hid_get_byte(s, 1);  | 
    
    
    287  | 
     | 
     | 
    			mask = 0xFF;  | 
    
    
    288  | 
     | 
     | 
    			break;  | 
    
    
    289  | 
     | 
     | 
    		case 2:  | 
    
    
    290  | 
     | 
     | 
    			dval = hid_get_byte(s, 1);  | 
    
    
    291  | 
     | 
     | 
    			dval |= hid_get_byte(s, 1) << 8;  | 
    
    
    292  | 
     | 
     | 
    			dval = (int16_t)dval;  | 
    
    
    293  | 
     | 
     | 
    			mask = 0xFFFF;  | 
    
    
    294  | 
     | 
     | 
    			break;  | 
    
    
    295  | 
     | 
     | 
    		case 4:  | 
    
    
    296  | 
     | 
     | 
    			dval = hid_get_byte(s, 1);  | 
    
    
    297  | 
     | 
     | 
    			dval |= hid_get_byte(s, 1) << 8;  | 
    
    
    298  | 
     | 
     | 
    			dval |= hid_get_byte(s, 1) << 16;  | 
    
    
    299  | 
     | 
     | 
    			dval |= hid_get_byte(s, 1) << 24;  | 
    
    
    300  | 
     | 
     | 
    			mask = 0xFFFFFFFF;  | 
    
    
    301  | 
     | 
     | 
    			break;  | 
    
    
    302  | 
     | 
     | 
    		default:  | 
    
    
    303  | 
     | 
     | 
    			dval = hid_get_byte(s, bSize);  | 
    
    
    304  | 
     | 
     | 
    			continue;  | 
    
    
    305  | 
     | 
     | 
    		}  | 
    
    
    306  | 
     | 
     | 
     | 
    
    
    307  | 
     | 
     | 
    		switch (bType) { | 
    
    
    308  | 
     | 
     | 
    		case 0:		/* Main */  | 
    
    
    309  | 
     | 
     | 
    			switch (bTag) { | 
    
    
    310  | 
     | 
     | 
    			case 8:	/* Input */  | 
    
    
    311  | 
     | 
     | 
    				c->kind = hid_input;  | 
    
    
    312  | 
     | 
     | 
    				c->flags = dval;  | 
    
    
    313  | 
     | 
     | 
    		ret:  | 
    
    
    314  | 
     | 
     | 
    				c->report_count = s->loc_count;  | 
    
    
    315  | 
     | 
     | 
    				c->report_size = s->loc_size;  | 
    
    
    316  | 
     | 
     | 
     | 
    
    
    317  | 
     | 
     | 
    				if (c->flags & HIO_VARIABLE) { | 
    
    
    318  | 
     | 
     | 
    					/* range check usage count */  | 
    
    
    319  | 
     | 
     | 
    					if (c->report_count > 255) { | 
    
    
    320  | 
     | 
     | 
    						s->ncount = 255;  | 
    
    
    321  | 
     | 
     | 
    					} else  | 
    
    
    322  | 
     | 
     | 
    						s->ncount = c->report_count;  | 
    
    
    323  | 
     | 
     | 
     | 
    
    
    324  | 
     | 
     | 
    					/*  | 
    
    
    325  | 
     | 
     | 
    					 * The "top" loop will return  | 
    
    
    326  | 
     | 
     | 
    					 * one and one item:  | 
    
    
    327  | 
     | 
     | 
    					 */  | 
    
    
    328  | 
     | 
     | 
    					c->report_count = 1;  | 
    
    
    329  | 
     | 
     | 
    					c->usage_minimum = 0;  | 
    
    
    330  | 
     | 
     | 
    					c->usage_maximum = 0;  | 
    
    
    331  | 
     | 
     | 
    				} else { | 
    
    
    332  | 
     | 
     | 
    					s->ncount = 1;  | 
    
    
    333  | 
     | 
     | 
    				}  | 
    
    
    334  | 
     | 
     | 
    				goto top;  | 
    
    
    335  | 
     | 
     | 
     | 
    
    
    336  | 
     | 
     | 
    			case 9:	/* Output */  | 
    
    
    337  | 
     | 
     | 
    				c->kind = hid_output;  | 
    
    
    338  | 
     | 
     | 
    				c->flags = dval;  | 
    
    
    339  | 
     | 
     | 
    				goto ret;  | 
    
    
    340  | 
     | 
     | 
    			case 10:	/* Collection */  | 
    
    
    341  | 
     | 
     | 
    				c->kind = hid_collection;  | 
    
    
    342  | 
     | 
     | 
    				c->collection = dval;  | 
    
    
    343  | 
     | 
     | 
    				c->collevel++;  | 
    
    
    344  | 
     | 
     | 
    				c->usage = s->usage_last;  | 
    
    
    345  | 
     | 
     | 
    				nc = *c;  | 
    
    
    346  | 
     | 
     | 
    				if (s->hassavedcoll) { | 
    
    
    347  | 
     | 
     | 
    					*h = s->savedcoll;  | 
    
    
    348  | 
     | 
     | 
    					h->report_ID = nc.report_ID;  | 
    
    
    349  | 
     | 
     | 
    					s->savedcoll = nc;  | 
    
    
    350  | 
     | 
     | 
    					return (1);  | 
    
    
    351  | 
     | 
     | 
    				} else { | 
    
    
    352  | 
     | 
     | 
    					s->hassavedcoll = 1;  | 
    
    
    353  | 
     | 
     | 
    					s->savedcoll = nc;  | 
    
    
    354  | 
     | 
     | 
    				}  | 
    
    
    355  | 
     | 
     | 
    				goto top;  | 
    
    
    356  | 
     | 
     | 
    			case 11:	/* Feature */  | 
    
    
    357  | 
     | 
     | 
    				c->kind = hid_feature;  | 
    
    
    358  | 
     | 
     | 
    				c->flags = dval;  | 
    
    
    359  | 
     | 
     | 
    				goto ret;  | 
    
    
    360  | 
     | 
     | 
    			case 12:	/* End collection */  | 
    
    
    361  | 
     | 
     | 
    				REPORT_SAVED_COLL;  | 
    
    
    362  | 
     | 
     | 
    				c->kind = hid_endcollection;  | 
    
    
    363  | 
     | 
     | 
    				if (c->collevel == 0) { | 
    
    
    364  | 
     | 
     | 
    					/* Invalid end collection. */  | 
    
    
    365  | 
     | 
     | 
    					return (0);  | 
    
    
    366  | 
     | 
     | 
    				}  | 
    
    
    367  | 
     | 
     | 
    				c->collevel--;  | 
    
    
    368  | 
     | 
     | 
    				*h = *c;  | 
    
    
    369  | 
     | 
     | 
    				return (1);  | 
    
    
    370  | 
     | 
     | 
    			default:  | 
    
    
    371  | 
     | 
     | 
    				break;  | 
    
    
    372  | 
     | 
     | 
    			}  | 
    
    
    373  | 
     | 
     | 
    			break;  | 
    
    
    374  | 
     | 
     | 
     | 
    
    
    375  | 
     | 
     | 
    		case 1:		/* Global */  | 
    
    
    376  | 
     | 
     | 
    			switch (bTag) { | 
    
    
    377  | 
     | 
     | 
    			case 0:  | 
    
    
    378  | 
     | 
     | 
    				c->_usage_page = dval << 16;  | 
    
    
    379  | 
     | 
     | 
    				break;  | 
    
    
    380  | 
     | 
     | 
    			case 1:  | 
    
    
    381  | 
     | 
     | 
    				c->logical_minimum = dval;  | 
    
    
    382  | 
     | 
     | 
    				break;  | 
    
    
    383  | 
     | 
     | 
    			case 2:  | 
    
    
    384  | 
     | 
     | 
    				c->logical_maximum = dval;  | 
    
    
    385  | 
     | 
     | 
    				break;  | 
    
    
    386  | 
     | 
     | 
    			case 3:  | 
    
    
    387  | 
     | 
     | 
    				c->physical_minimum = dval;  | 
    
    
    388  | 
     | 
     | 
    				break;  | 
    
    
    389  | 
     | 
     | 
    			case 4:  | 
    
    
    390  | 
     | 
     | 
    				c->physical_maximum = dval;  | 
    
    
    391  | 
     | 
     | 
    				break;  | 
    
    
    392  | 
     | 
     | 
    			case 5:  | 
    
    
    393  | 
     | 
     | 
    				c->unit_exponent = dval;  | 
    
    
    394  | 
     | 
     | 
    				break;  | 
    
    
    395  | 
     | 
     | 
    			case 6:  | 
    
    
    396  | 
     | 
     | 
    				c->unit = dval;  | 
    
    
    397  | 
     | 
     | 
    				break;  | 
    
    
    398  | 
     | 
     | 
    			case 7:  | 
    
    
    399  | 
     | 
     | 
    				/* mask because value is unsigned */  | 
    
    
    400  | 
     | 
     | 
    				s->loc_size = dval & mask;  | 
    
    
    401  | 
     | 
     | 
    				break;  | 
    
    
    402  | 
     | 
     | 
    			case 8:  | 
    
    
    403  | 
     | 
     | 
    				hid_switch_rid(s, c, dval & mask);  | 
    
    
    404  | 
     | 
     | 
    				break;  | 
    
    
    405  | 
     | 
     | 
    			case 9:  | 
    
    
    406  | 
     | 
     | 
    				/* mask because value is unsigned */  | 
    
    
    407  | 
     | 
     | 
    				s->loc_count = dval & mask;  | 
    
    
    408  | 
     | 
     | 
    				break;  | 
    
    
    409  | 
     | 
     | 
    			case 10:	/* Push */  | 
    
    
    410  | 
     | 
     | 
    				s->pushlevel ++;  | 
    
    
    411  | 
     | 
     | 
    				if (s->pushlevel < MAXPUSH) { | 
    
    
    412  | 
     | 
     | 
    					s->cur[s->pushlevel] = *c;  | 
    
    
    413  | 
     | 
     | 
    					/* store size and count */  | 
    
    
    414  | 
     | 
     | 
    					c->report_size = s->loc_size;  | 
    
    
    415  | 
     | 
     | 
    					c->report_count = s->loc_count;  | 
    
    
    416  | 
     | 
     | 
    					/* update current item pointer */  | 
    
    
    417  | 
     | 
     | 
    					c = &s->cur[s->pushlevel];  | 
    
    
    418  | 
     | 
     | 
    				}  | 
    
    
    419  | 
     | 
     | 
    				break;  | 
    
    
    420  | 
     | 
     | 
    			case 11:	/* Pop */  | 
    
    
    421  | 
     | 
     | 
    				s->pushlevel --;  | 
    
    
    422  | 
     | 
     | 
    				if (s->pushlevel < MAXPUSH) { | 
    
    
    423  | 
     | 
     | 
    					c = &s->cur[s->pushlevel];  | 
    
    
    424  | 
     | 
     | 
    					/* restore size and count */  | 
    
    
    425  | 
     | 
     | 
    					s->loc_size = c->report_size;  | 
    
    
    426  | 
     | 
     | 
    					s->loc_count = c->report_count;  | 
    
    
    427  | 
     | 
     | 
    					c->report_size = 0;  | 
    
    
    428  | 
     | 
     | 
    					c->report_count = 0;  | 
    
    
    429  | 
     | 
     | 
    				}  | 
    
    
    430  | 
     | 
     | 
    				break;  | 
    
    
    431  | 
     | 
     | 
    			default:  | 
    
    
    432  | 
     | 
     | 
    				break;  | 
    
    
    433  | 
     | 
     | 
    			}  | 
    
    
    434  | 
     | 
     | 
    			break;  | 
    
    
    435  | 
     | 
     | 
    		case 2:		/* Local */  | 
    
    
    436  | 
     | 
     | 
    			switch (bTag) { | 
    
    
    437  | 
     | 
     | 
    			case 0:  | 
    
    
    438  | 
     | 
     | 
    				if (bSize != 4)  | 
    
    
    439  | 
     | 
     | 
    					dval = (dval & mask) | c->_usage_page;  | 
    
    
    440  | 
     | 
     | 
     | 
    
    
    441  | 
     | 
     | 
    				/* set last usage, in case of a collection */  | 
    
    
    442  | 
     | 
     | 
    				s->usage_last = dval;  | 
    
    
    443  | 
     | 
     | 
     | 
    
    
    444  | 
     | 
     | 
    				if (s->nusage < MAXUSAGE) { | 
    
    
    445  | 
     | 
     | 
    					s->usages_min[s->nusage] = dval;  | 
    
    
    446  | 
     | 
     | 
    					s->usages_max[s->nusage] = dval;  | 
    
    
    447  | 
     | 
     | 
    					s->nusage ++;  | 
    
    
    448  | 
     | 
     | 
    				}  | 
    
    
    449  | 
     | 
     | 
    				/* else XXX */  | 
    
    
    450  | 
     | 
     | 
     | 
    
    
    451  | 
     | 
     | 
    				/* clear any pending usage sets */  | 
    
    
    452  | 
     | 
     | 
    				s->susage = 0;  | 
    
    
    453  | 
     | 
     | 
    				break;  | 
    
    
    454  | 
     | 
     | 
    			case 1:  | 
    
    
    455  | 
     | 
     | 
    				s->susage |= 1;  | 
    
    
    456  | 
     | 
     | 
     | 
    
    
    457  | 
     | 
     | 
    				if (bSize != 4)  | 
    
    
    458  | 
     | 
     | 
    					dval = (dval & mask) | c->_usage_page;  | 
    
    
    459  | 
     | 
     | 
    				c->usage_minimum = dval;  | 
    
    
    460  | 
     | 
     | 
     | 
    
    
    461  | 
     | 
     | 
    				goto check_set;  | 
    
    
    462  | 
     | 
     | 
    			case 2:  | 
    
    
    463  | 
     | 
     | 
    				s->susage |= 2;  | 
    
    
    464  | 
     | 
     | 
     | 
    
    
    465  | 
     | 
     | 
    				if (bSize != 4)  | 
    
    
    466  | 
     | 
     | 
    					dval = (dval & mask) | c->_usage_page;  | 
    
    
    467  | 
     | 
     | 
    				c->usage_maximum = dval;  | 
    
    
    468  | 
     | 
     | 
     | 
    
    
    469  | 
     | 
     | 
    			check_set:  | 
    
    
    470  | 
     | 
     | 
    				if (s->susage != 3)  | 
    
    
    471  | 
     | 
     | 
    					break;  | 
    
    
    472  | 
     | 
     | 
     | 
    
    
    473  | 
     | 
     | 
    				/* sanity check */  | 
    
    
    474  | 
     | 
     | 
    				if ((s->nusage < MAXUSAGE) &&  | 
    
    
    475  | 
     | 
     | 
    				    (c->usage_minimum <= c->usage_maximum)) { | 
    
    
    476  | 
     | 
     | 
    					/* add usage range */  | 
    
    
    477  | 
     | 
     | 
    					s->usages_min[s->nusage] =  | 
    
    
    478  | 
     | 
     | 
    					    c->usage_minimum;  | 
    
    
    479  | 
     | 
     | 
    					s->usages_max[s->nusage] =  | 
    
    
    480  | 
     | 
     | 
    					    c->usage_maximum;  | 
    
    
    481  | 
     | 
     | 
    					s->nusage ++;  | 
    
    
    482  | 
     | 
     | 
    				}  | 
    
    
    483  | 
     | 
     | 
    				/* else XXX */  | 
    
    
    484  | 
     | 
     | 
     | 
    
    
    485  | 
     | 
     | 
    				s->susage = 0;  | 
    
    
    486  | 
     | 
     | 
    				break;  | 
    
    
    487  | 
     | 
     | 
    			case 3:  | 
    
    
    488  | 
     | 
     | 
    				c->designator_index = dval;  | 
    
    
    489  | 
     | 
     | 
    				break;  | 
    
    
    490  | 
     | 
     | 
    			case 4:  | 
    
    
    491  | 
     | 
     | 
    				c->designator_minimum = dval;  | 
    
    
    492  | 
     | 
     | 
    				break;  | 
    
    
    493  | 
     | 
     | 
    			case 5:  | 
    
    
    494  | 
     | 
     | 
    				c->designator_maximum = dval;  | 
    
    
    495  | 
     | 
     | 
    				break;  | 
    
    
    496  | 
     | 
     | 
    			case 7:  | 
    
    
    497  | 
     | 
     | 
    				c->string_index = dval;  | 
    
    
    498  | 
     | 
     | 
    				break;  | 
    
    
    499  | 
     | 
     | 
    			case 8:  | 
    
    
    500  | 
     | 
     | 
    				c->string_minimum = dval;  | 
    
    
    501  | 
     | 
     | 
    				break;  | 
    
    
    502  | 
     | 
     | 
    			case 9:  | 
    
    
    503  | 
     | 
     | 
    				c->string_maximum = dval;  | 
    
    
    504  | 
     | 
     | 
    				break;  | 
    
    
    505  | 
     | 
     | 
    			case 10:  | 
    
    
    506  | 
     | 
     | 
    				c->set_delimiter = dval;  | 
    
    
    507  | 
     | 
     | 
    				break;  | 
    
    
    508  | 
     | 
     | 
    			default:  | 
    
    
    509  | 
     | 
     | 
    				break;  | 
    
    
    510  | 
     | 
     | 
    			}  | 
    
    
    511  | 
     | 
     | 
    			break;  | 
    
    
    512  | 
     | 
     | 
    		default:  | 
    
    
    513  | 
     | 
     | 
    			break;  | 
    
    
    514  | 
     | 
     | 
    		}  | 
    
    
    515  | 
     | 
     | 
    	}  | 
    
    
    516  | 
     | 
     | 
    	return (0);  | 
    
    
    517  | 
     | 
     | 
    }  | 
    
    
    518  | 
     | 
     | 
     | 
    
    
    519  | 
     | 
     | 
    int  | 
    
    
    520  | 
     | 
     | 
    hid_get_item(hid_data_t s, hid_item_t *h)  | 
    
    
    521  | 
     | 
     | 
    { | 
    
    
    522  | 
     | 
     | 
    	int r;  | 
    
    
    523  | 
     | 
     | 
     | 
    
    
    524  | 
     | 
     | 
    	for (;;) { | 
    
    
    525  | 
     | 
     | 
    		r = hid_get_item_raw(s, h);  | 
    
    
    526  | 
     | 
     | 
    		if (r <= 0 || s->reportid == -1 || h->report_ID == s->reportid)  | 
    
    
    527  | 
     | 
     | 
    			break;  | 
    
    
    528  | 
     | 
     | 
    	}  | 
    
    
    529  | 
     | 
     | 
    	return (r);  | 
    
    
    530  | 
     | 
     | 
    }  | 
    
    
    531  | 
     | 
     | 
     | 
    
    
    532  | 
     | 
     | 
    int  | 
    
    
    533  | 
     | 
     | 
    hid_report_size(report_desc_t r, enum hid_kind k, int id)  | 
    
    
    534  | 
     | 
     | 
    { | 
    
    
    535  | 
     | 
     | 
    	struct hid_data *d;  | 
    
    
    536  | 
     | 
     | 
    	struct hid_item h;  | 
    
    
    537  | 
     | 
     | 
    	uint32_t temp;  | 
    
    
    538  | 
     | 
     | 
    	uint32_t hpos;  | 
    
    
    539  | 
     | 
     | 
    	uint32_t lpos;  | 
    
    
    540  | 
     | 
     | 
    	int report_id = 0;  | 
    
    
    541  | 
     | 
     | 
     | 
    
    
    542  | 
     | 
     | 
    	hpos = 0;  | 
    
    
    543  | 
     | 
     | 
    	lpos = 0xFFFFFFFF;  | 
    
    
    544  | 
     | 
     | 
     | 
    
    
    545  | 
     | 
     | 
    	memset(&h, 0, sizeof h);  | 
    
    
    546  | 
     | 
     | 
    	for (d = hid_start_parse(r, 1 << k, id); hid_get_item(d, &h); ) { | 
    
    
    547  | 
     | 
     | 
    		if (h.kind == k) { | 
    
    
    548  | 
     | 
     | 
    			/* compute minimum */  | 
    
    
    549  | 
     | 
     | 
    			if (lpos > h.pos)  | 
    
    
    550  | 
     | 
     | 
    				lpos = h.pos;  | 
    
    
    551  | 
     | 
     | 
    			/* compute end position */  | 
    
    
    552  | 
     | 
     | 
    			temp = h.pos + (h.report_size * h.report_count);  | 
    
    
    553  | 
     | 
     | 
    			/* compute maximum */  | 
    
    
    554  | 
     | 
     | 
    			if (hpos < temp)  | 
    
    
    555  | 
     | 
     | 
    				hpos = temp;  | 
    
    
    556  | 
     | 
     | 
    			if (h.report_ID != 0)  | 
    
    
    557  | 
     | 
     | 
    				report_id = 1;  | 
    
    
    558  | 
     | 
     | 
    		}  | 
    
    
    559  | 
     | 
     | 
    	}  | 
    
    
    560  | 
     | 
     | 
    	hid_end_parse(d);  | 
    
    
    561  | 
     | 
     | 
     | 
    
    
    562  | 
     | 
     | 
    	/* safety check - can happen in case of currupt descriptors */  | 
    
    
    563  | 
     | 
     | 
    	if (lpos > hpos)  | 
    
    
    564  | 
     | 
     | 
    		temp = 0;  | 
    
    
    565  | 
     | 
     | 
    	else  | 
    
    
    566  | 
     | 
     | 
    		temp = hpos - lpos;  | 
    
    
    567  | 
     | 
     | 
     | 
    
    
    568  | 
     | 
     | 
    	/* No extra byte for the reportID because the kernel skips it. */  | 
    
    
    569  | 
     | 
     | 
    	return ((temp + 7) / 8);  | 
    
    
    570  | 
     | 
     | 
    }  | 
    
    
    571  | 
     | 
     | 
     | 
    
    
    572  | 
     | 
     | 
    int  | 
    
    
    573  | 
     | 
     | 
    hid_locate(report_desc_t desc, unsigned int u, enum hid_kind k,  | 
    
    
    574  | 
     | 
     | 
        hid_item_t *h, int id)  | 
    
    
    575  | 
     | 
     | 
    { | 
    
    
    576  | 
     | 
     | 
    	struct hid_data *d;  | 
    
    
    577  | 
     | 
     | 
     | 
    
    
    578  | 
     | 
     | 
    	for (d = hid_start_parse(desc, 1 << k, id); hid_get_item(d, h); ) { | 
    
    
    579  | 
     | 
     | 
    		if (h->kind == k && !(h->flags & HIO_CONST) && h->usage == u) { | 
    
    
    580  | 
     | 
     | 
    			hid_end_parse(d);  | 
    
    
    581  | 
     | 
     | 
    			return (1);  | 
    
    
    582  | 
     | 
     | 
    		}  | 
    
    
    583  | 
     | 
     | 
    	}  | 
    
    
    584  | 
     | 
     | 
    	hid_end_parse(d);  | 
    
    
    585  | 
     | 
     | 
    	h->report_size = 0;  | 
    
    
    586  | 
     | 
     | 
    	return (0);  | 
    
    
    587  | 
     | 
     | 
    }  |