diff options
Diffstat (limited to 'usr.sbin/dumpcis/readcis.c')
-rw-r--r-- | usr.sbin/dumpcis/readcis.c | 377 |
1 files changed, 377 insertions, 0 deletions
diff --git a/usr.sbin/dumpcis/readcis.c b/usr.sbin/dumpcis/readcis.c new file mode 100644 index 0000000..25bd396 --- /dev/null +++ b/usr.sbin/dumpcis/readcis.c @@ -0,0 +1,377 @@ +/* + * Copyright (c) 1995 Andrew McRae. All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES + * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. + * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT + * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, + * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY + * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT + * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF + * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + */ + +#ifndef lint +static const char rcsid[] = + "$FreeBSD$"; +#endif /* not lint */ + +/* + * Code cleanup, bug-fix and extension + * by Tatsumi Hosokawa <hosokawa@mt.cs.keio.ac.jp> + */ + +#include <err.h> +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <unistd.h> + +#include "cardinfo.h" +#include "cis.h" +#include "readcis.h" + +static int ck_linktarget(int, off_t, int); +static struct tuple_list *read_one_tuplelist(int, int, off_t); +static struct tuple_list *read_tuples(int); +static struct tuple *find_tuple_in_list(struct tuple_list *, unsigned char); +static struct tuple_info *get_tuple_info(unsigned char); + +static struct tuple_info tuple_info[] = { + {"Null tuple", CIS_NULL, 0}, + {"Common memory descriptor", CIS_MEM_COMMON, 255}, + {"Long link to next chain for CardBus", CIS_LONGLINK_CB, 255}, + {"Indirect access", CIS_INDIRECT, 255}, + {"Configuration map for CardBus", CIS_CONF_MAP_CB, 255}, + {"Configuration entry for CardBus", CIS_CONFIG_CB, 255}, + {"Long link to next chain for MFC", CIS_LONGLINK_MFC, 255}, + {"Base address register for CardBus", CIS_BAR, 6}, + {"Checksum", CIS_CHECKSUM, 5}, + {"Long link to attribute memory", CIS_LONGLINK_A, 4}, + {"Long link to common memory", CIS_LONGLINK_C, 4}, + {"Link target", CIS_LINKTARGET, 3}, + {"No link", CIS_NOLINK, 0}, + {"Version 1 info", CIS_INFO_V1, 255}, + {"Alternate language string", CIS_ALTSTR, 255}, + {"Attribute memory descriptor", CIS_MEM_ATTR, 255}, + {"JEDEC descr for common memory", CIS_JEDEC_C, 255}, + {"JEDEC descr for attribute memory", CIS_JEDEC_A, 255}, + {"Configuration map", CIS_CONF_MAP, 255}, + {"Configuration entry", CIS_CONFIG, 255}, + {"Other conditions for common memory", CIS_DEVICE_OC, 255}, + {"Other conditions for attribute memory", CIS_DEVICE_OA, 255}, + {"Geometry info for common memory", CIS_DEVICEGEO, 255}, + {"Geometry info for attribute memory", CIS_DEVICEGEO_A, 255}, + {"Manufacturer ID", CIS_MANUF_ID, 4}, + {"Functional ID", CIS_FUNC_ID, 2}, + {"Functional EXT", CIS_FUNC_EXT, 255}, + {"Software interleave", CIS_SW_INTERLV, 2}, + {"Version 2 Info", CIS_VERS_2, 255}, + {"Data format", CIS_FORMAT, 255}, + {"Geometry", CIS_GEOMETRY, 4}, + {"Byte order", CIS_BYTEORDER, 2}, + {"Card init date", CIS_DATE, 4}, + {"Battery replacement", CIS_BATTERY, 4}, + {"Organization", CIS_ORG, 255}, + {"Terminator", CIS_END, 0}, + {0, 0, 0} +}; + +static void * +xmalloc(int sz) +{ + void *p; + + sz = (sz + 7) & ~7; + p = malloc(sz); + if (p) + bzero(p, sz); + else + errx(1, "malloc"); + return (p); +} + +/* + * After reading the tuples, decode the relevant ones. + */ +struct tuple_list * +readcis(int fd) +{ + + return (read_tuples(fd)); +} + +/* + * free_cis - delete cis entry. + */ +void +freecis(struct tuple_list *tlist) +{ + struct tuple_list *tl; + struct tuple *tp; + + while ((tl = tlist) != 0) { + tlist = tl->next; + while ((tp = tl->tuples) != 0) { + tl->tuples = tp->next; + free(tp->data); + free(tp); + } + free(tl); + } +} + +/* + * Parse variable length value. + */ +u_int +parse_num(int sz, u_char *p, u_char **q, int ofs) +{ + u_int num = 0; + + switch (sz) { + case 0: + case 0x10: + break; + case 1: + case 0x11: + num = (*p++) + ofs; + break; + case 2: + case 0x12: + num = tpl16(p) + ofs; + p += 2; + break; + case 0x13: + num = tpl24(p) + ofs; + p += 3; + break; + case 3: + case 0x14: + num = tpl32(p) + ofs; + p += 4; + break; + } + if (q) + *q = p; + return num; +} + +/* + * Read the tuples from the card. + * The processing of tuples is as follows: + * - Read tuples at attribute memory, offset 0. + * - If a CIS_END is the first tuple, look for + * a tuple list at common memory offset 0; this list + * must start with a LINKTARGET. + * - If a long link tuple was encountered, execute the long + * link. + * - If a no-link tuple was seen, terminate processing. + * - If no no-link tuple exists, and no long link tuple + * exists while processing the primary tuple list, + * then look for a LINKTARGET tuple in common memory. + * - If a long link tuple is found in any list, then process + * it. Only one link is allowed per list. + */ +static struct tuple_list *tlist; + +static struct tuple_list * +read_tuples(int fd) +{ + struct tuple_list *tl = 0, *last_tl; + struct tuple *tp; + int flag; + off_t offs; + + tlist = 0; + last_tl = tlist = read_one_tuplelist(fd, MDF_ATTR, (off_t) 0); + + /* Now start processing the links (if any). */ + do { + flag = MDF_ATTR; + tp = find_tuple_in_list(last_tl, CIS_LONGLINK_A); + if (tp == 0) { + flag = 0; + tp = find_tuple_in_list(last_tl, CIS_LONGLINK_C); + } + if (tp && tp->length == 4) { + offs = tpl32(tp->data); +#ifdef DEBUG + printf("Checking long link at %zd (%s memory)\n", + offs, flag ? "Attribute" : "Common"); +#endif + /* If a link was found, read the tuple list from it. */ + if (ck_linktarget(fd, offs, flag)) { + tl = read_one_tuplelist(fd, flag, offs); + last_tl->next = tl; + last_tl = tl; + } + } else + tl = 0; + } while (tl); + + /* + * If the primary list had no NOLINK tuple, and no LINKTARGET, + * then try to read a tuple list at common memory (offset 0). + */ + if (find_tuple_in_list(tlist, CIS_NOLINK) == 0 && + find_tuple_in_list(tlist, CIS_LINKTARGET) == 0 && + ck_linktarget(fd, (off_t) 0, 0)) { + offs = 0; +#ifdef DEBUG + printf("Reading long link at %zd (%s memory)\n", + offs, flag ? "Attribute" : "Common"); +#endif + tlist->next = read_one_tuplelist(fd, 0, offs); + } + return (tlist); +} + +/* + * Read one tuple list from the card. + */ +static struct tuple_list * +read_one_tuplelist(int fd, int flags, off_t offs) +{ + struct tuple *tp, *last_tp = 0; + struct tuple_list *tl; + struct tuple_info *tinfo; + int total = 0; + unsigned char code, length; + + /* Check to see if this memory has already been scanned. */ + for (tl = tlist; tl; tl = tl->next) + if (tl->offs == offs && tl->flags == (flags & MDF_ATTR)) + return (0); + tl = xmalloc(sizeof(*tl)); + tl->offs = offs; + tl->flags = flags & MDF_ATTR; + ioctl(fd, PIOCRWFLAG, &flags); + lseek(fd, offs, SEEK_SET); + do { + if (read(fd, &code, 1) != 1) { + warn("CIS code read"); + break; + } + total++; + if (code == CIS_NULL) + continue; + tp = xmalloc(sizeof(*tp)); + tp->code = code; + if (code == CIS_END) + length = 0; + else { + if (read(fd, &length, 1) != 1) { + warn("CIS len read"); + break; + } + total++; + } + tp->length = length; +#ifdef DEBUG + printf("Tuple code = 0x%x, len = %d\n", code, length); +#endif + if (length == 0xFF) { + length = tp->length = 0; + code = CIS_END; + } + if (length != 0) { + total += length; + tp->data = xmalloc(length); + if (read(fd, tp->data, length) != length) { + warn("CIS read"); + break; + } + } + + /* + * Check the tuple, and ignore it if it isn't in the table + * or the length is illegal. + */ + tinfo = get_tuple_info(code); + if (tinfo != NULL && (tinfo->length != 255 && tinfo->length > length)) { + printf("code %s (%d) ignored\n", tuple_name(code), code); + tp->code = CIS_NULL; + } + if (tl->tuples == NULL) + tl->tuples = tp; + else + last_tp->next = tp; + last_tp = tp; + } while (code != CIS_END && total < 1024); + return (tl); +} + +/* + * return true if the offset points to a LINKTARGET tuple. + */ +static int +ck_linktarget(int fd, off_t offs, int flag) +{ + char blk[5]; + + ioctl(fd, PIOCRWFLAG, &flag); + lseek(fd, offs, SEEK_SET); + if (read(fd, blk, 5) != 5) + return (0); + if (blk[0] == CIS_LINKTARGET && + blk[1] == 0x3 && + blk[2] == 'C' && + blk[3] == 'I' && + blk[4] == 'S') + return (1); + return (0); +} + +/* + * find_tuple_in_list - find a tuple within a + * single tuple list. + */ +static struct tuple * +find_tuple_in_list(struct tuple_list *tl, unsigned char code) +{ + struct tuple *tp; + + for (tp = tl->tuples; tp; tp = tp->next) + if (tp->code == code) + break; + return (tp); +} + +/* + * return table entry for code. + */ +static struct tuple_info * +get_tuple_info(unsigned char code) +{ + struct tuple_info *tp; + + for (tp = tuple_info; tp->name; tp++) + if (tp->code == code) + return (tp); + return (0); +} + +const char * +tuple_name(unsigned char code) +{ + struct tuple_info *tp; + + tp = get_tuple_info(code); + if (tp) + return (tp->name); + return ("Unknown"); +} |