632 lines
13 KiB
C
632 lines
13 KiB
C
/* set tab=4
|
|
* Read/dump CIS tuples.
|
|
*/
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/ioctl.h>
|
|
|
|
#include <pccard/card.h>
|
|
#include <pccard/cis.h>
|
|
|
|
#include "readcis.h"
|
|
|
|
static int read_attr(int fd, char *bp, int len);
|
|
struct tuple_list *read_one_tuplelist(int, int, off_t);
|
|
int ck_linktarget(int, off_t, int);
|
|
void cis_info(struct cis *cp, unsigned char *p, int len);
|
|
void device_desc(unsigned char *p, int len, struct dev_mem *dp);
|
|
void config_map(struct cis *cp, unsigned char *p, int len);
|
|
void cis_config(struct cis *cp, unsigned char *p, int len);
|
|
|
|
struct tuple_info tuple_info[] =
|
|
{
|
|
{ "Null tuple", 0x00, 0 },
|
|
{ "Common memory descriptor", 0x01, 255 },
|
|
{ "Checksum", 0x10, 5 },
|
|
{ "Long link to attribute memory", 0x11, 4 },
|
|
{ "Long link to common memory", 0x12, 4 },
|
|
{ "Link target", 0x13, 3 },
|
|
{ "No link", 0x14, 0 },
|
|
{ "Version 1 info", 0x15, 255 },
|
|
{ "Alternate language string", 0x16, 255 },
|
|
{ "Attribute memory descriptor", 0x17, 255 },
|
|
{ "JEDEC descr for common memory", 0x18, 255 },
|
|
{ "JEDEC descr for attribute memory", 0x19, 255 },
|
|
{ "Configuration map", 0x1A, 255 },
|
|
{ "Configuration entry", 0x1B, 255 },
|
|
{ "Other conditions for common memory", 0x1C, 255 },
|
|
{ "Other conditions for attribute memory", 0x1D, 255 },
|
|
{ "Geometry info for common memory", 0x1E, 255 },
|
|
{ "Geometry info for attribute memory", 0x1F, 255 },
|
|
{ "Manufacturer ID", 0x20, 4 },
|
|
{ "Functional ID", 0x21, 255 },
|
|
{ "Functional EXT", 0x22, 255 },
|
|
{ "Software interleave", 0x23, 2 },
|
|
{ "Version 2 Info", 0x40, 255 },
|
|
{ "Data format", 0x41, 255 },
|
|
{ "Geometry", 0x42, 4 },
|
|
{ "Byte order", 0x43, 2 },
|
|
{ "Card init date", 0x44, 4 },
|
|
{ "Battery replacement", 0x45, 4 },
|
|
{ "Organisation", 0x46, 255 },
|
|
{ "Terminator", 0xFF, 255 },
|
|
{ 0, 0, 0 }
|
|
};
|
|
|
|
/*
|
|
* After reading the tuples, decode the relevant ones.
|
|
*/
|
|
struct cis *
|
|
readcis(int fd)
|
|
{
|
|
struct tuple_list *tl;
|
|
struct tuple *tp;
|
|
struct cis *cp;
|
|
|
|
cp = xmalloc(sizeof(*cp));
|
|
cp->tlist = read_tuples(fd);
|
|
if (cp->tlist == 0)
|
|
return(NULL);
|
|
|
|
for (tl = cp->tlist; tl; tl = tl->next)
|
|
for (tp = tl->tuples; tp; tp = tp->next)
|
|
{
|
|
#if 0
|
|
printf("tuple code = 0x%02x, data is\n", tp->code);
|
|
dump(tp->data, tp->length);
|
|
#endif
|
|
switch(tp->code)
|
|
{
|
|
case CIS_MEM_COMMON: /* 0x01 */
|
|
device_desc(tp->data, tp->length, &cp->common_mem);
|
|
break;
|
|
case CIS_INFO_V1: /* 0x15 */
|
|
cis_info(cp, tp->data, tp->length);
|
|
break;
|
|
case CIS_MEM_ATTR: /* 0x17 */
|
|
device_desc(tp->data, tp->length, &cp->attr_mem);
|
|
break;
|
|
case CIS_CONF_MAP: /* 0x1A */
|
|
config_map(cp, tp->data, tp->length);
|
|
break;
|
|
case CIS_CONFIG: /* 0x1B */
|
|
cis_config(cp, tp->data, tp->length);
|
|
break;
|
|
}
|
|
}
|
|
return(cp);
|
|
}
|
|
/*
|
|
* free_cis - delete cis entry.
|
|
*/
|
|
void
|
|
freecis(struct cis *cp)
|
|
{
|
|
struct cis_ioblk *io;
|
|
struct cis_memblk *mem;
|
|
struct cis_config *conf;
|
|
struct tuple *tp;
|
|
struct tuple_list *tl;
|
|
|
|
while ((tl = cp->tlist) != 0)
|
|
{
|
|
cp->tlist = tl->next;
|
|
while ((tp = tl->tuples) != 0)
|
|
{
|
|
tl->tuples = tp->next;
|
|
if (tp->data)
|
|
free(tp->data);
|
|
}
|
|
}
|
|
|
|
while ((conf = cp->conf) != 0)
|
|
{
|
|
cp->conf = conf->next;
|
|
while ((io = conf->io) != 0)
|
|
{
|
|
conf->io = io->next;
|
|
free(io);
|
|
}
|
|
while ((mem = conf->mem) != 0)
|
|
{
|
|
conf->mem = mem->next;
|
|
free(mem);
|
|
}
|
|
free(conf);
|
|
}
|
|
free(cp);
|
|
}
|
|
/*
|
|
* Fills in CIS version data.
|
|
*/
|
|
void
|
|
cis_info(struct cis *cp, unsigned char *p, int len)
|
|
{
|
|
cp->maj_v = *p++;
|
|
cp->min_v = *p++;
|
|
strncpy(cp->manuf, p, MAXSTR-1);
|
|
while (*p++)
|
|
;
|
|
strncpy(cp->vers, p, MAXSTR-1);
|
|
while (*p++)
|
|
;
|
|
strncpy(cp->add_info1, p, MAXSTR-1);
|
|
while (*p++)
|
|
;
|
|
strncpy(cp->add_info2, p, MAXSTR-1);
|
|
}
|
|
/*
|
|
* device_desc - decode device descriptor.
|
|
*/
|
|
void
|
|
device_desc(unsigned char *p, int len, struct dev_mem *dp)
|
|
{
|
|
while (len > 0 && *p != 0xFF)
|
|
{
|
|
dp->valid = 1;
|
|
dp->type = (*p & 0xF0) >> 4;
|
|
dp->wps = !!(*p & 0x8);
|
|
dp->speed = *p & 7;
|
|
p++;
|
|
if (*p != 0xFF)
|
|
{
|
|
dp->addr = *p >> 3;
|
|
dp->units = *p & 7;
|
|
}
|
|
p++;
|
|
len -= 2;
|
|
}
|
|
}
|
|
/*
|
|
* configuration map of card control register.
|
|
*/
|
|
void
|
|
config_map(struct cis *cp, unsigned char *p, int len)
|
|
{
|
|
unsigned char *p1;
|
|
int i;
|
|
union {
|
|
unsigned long l;
|
|
unsigned char b[4];
|
|
}u;
|
|
|
|
p1 = p + 1;
|
|
cp->last_config = *p1++ & 0x3F;
|
|
u.l = 0;
|
|
for (i = 0 ; i <= (*p & 3); i++)
|
|
u.b[i] = *p1++;
|
|
cp->reg_addr = u.l;
|
|
cp->ccrs = *p1;
|
|
}
|
|
/*
|
|
* CIS config entry - Decode and build configuration entry.
|
|
*/
|
|
void
|
|
cis_config(struct cis *cp, unsigned char *p, int len)
|
|
{
|
|
int x;
|
|
int i, j;
|
|
union {
|
|
unsigned long l;
|
|
unsigned char b[4];
|
|
}u;
|
|
struct cis_config *conf, *last;
|
|
struct cis_memblk *mem;
|
|
unsigned char feat;
|
|
struct cis_memblk *lastmem = 0;
|
|
|
|
conf = xmalloc(sizeof(*conf));
|
|
if ((last = cp->conf) !=0)
|
|
{
|
|
while (last->next)
|
|
last = last->next;
|
|
last->next = conf;
|
|
}
|
|
else
|
|
cp->conf = conf;
|
|
conf->id = *p & 0x3F;
|
|
if (*p & 0x40)
|
|
cp->def_config = conf;
|
|
if (*p++ & 0x80)
|
|
p++;
|
|
feat = *p++;
|
|
for (i = 0; i < CIS_FEAT_POWER(feat); i++)
|
|
{
|
|
unsigned char parms = *p++;
|
|
|
|
conf->pwr = 1;
|
|
for (j = 0; j < 8; j++)
|
|
if (parms & (1 << j))
|
|
while (*p++ & 0x80)
|
|
;
|
|
}
|
|
if (feat & CIS_FEAT_TIMING)
|
|
{
|
|
conf->timing = 1;
|
|
i = *p++;
|
|
if (CIS_WAIT_SCALE(i) != 3)
|
|
p++;
|
|
if (CIS_READY_SCALE(i) != 7)
|
|
p++;
|
|
if (CIS_RESERVED_SCALE(i) != 7)
|
|
p++;
|
|
}
|
|
if (feat & CIS_FEAT_I_O)
|
|
{
|
|
conf->iospace = 1;
|
|
if (CIS_IO_RANGE & *p)
|
|
conf->io_blks = CIS_IO_BLKS(p[1])+1;
|
|
conf->io_addr = CIS_IO_ADDR(*p);
|
|
conf->io_bus = (*p >> 5) & 3;
|
|
if (*p++ & CIS_IO_RANGE)
|
|
{
|
|
struct cis_ioblk *io, *last = 0;
|
|
i = CIS_IO_ADSZ(*p);
|
|
j = CIS_IO_BLKSZ(*p++);
|
|
for (x = 0; x < conf->io_blks; x++)
|
|
{
|
|
io = xmalloc(sizeof(*io));
|
|
if (last)
|
|
last->next = io;
|
|
else
|
|
conf->io = io;
|
|
last = io;
|
|
u.l = 0;
|
|
switch(i)
|
|
{
|
|
case 0:
|
|
break;
|
|
case 1:
|
|
u.b[0] = *p++;
|
|
break;
|
|
case 2:
|
|
u.b[0] = *p++;
|
|
u.b[1] = *p++;
|
|
break;
|
|
case 3:
|
|
u.b[0] = *p++;
|
|
u.b[1] = *p++;
|
|
u.b[2] = *p++;
|
|
u.b[3] = *p++;
|
|
break;
|
|
}
|
|
io->addr = u.l;
|
|
u.l = 0;
|
|
switch(j)
|
|
{
|
|
case 0:
|
|
break;
|
|
case 1:
|
|
u.b[0] = *p++;
|
|
u.l++;
|
|
break;
|
|
case 2:
|
|
u.b[0] = *p++;
|
|
u.b[1] = *p++;
|
|
u.l++;
|
|
break;
|
|
case 3:
|
|
u.b[0] = *p++;
|
|
u.b[1] = *p++;
|
|
u.b[2] = *p++;
|
|
u.b[3] = *p++;
|
|
u.l++;
|
|
break;
|
|
}
|
|
io->size = u.l;
|
|
}
|
|
}
|
|
}
|
|
if (feat & CIS_FEAT_IRQ)
|
|
{
|
|
conf->irq = 1;
|
|
conf->irqlevel = *p & 0xF;
|
|
conf->irq_flags = *p & 0xF0;
|
|
if (*p++ & CIS_IRQ_MASK)
|
|
{
|
|
conf->irq_mask = (p[1] << 8) | p[0];
|
|
p += 2;
|
|
}
|
|
}
|
|
switch(CIS_FEAT_MEMORY(feat))
|
|
{
|
|
case 0:
|
|
break;
|
|
case 1:
|
|
conf->memspace = 1;
|
|
conf->mem = xmalloc(sizeof(*conf->mem));
|
|
conf->mem->length = ((p[1] << 8) | p[0])<<8;
|
|
break;
|
|
case 2:
|
|
conf->memspace = 1;
|
|
conf->mem = xmalloc(sizeof(*conf->mem));
|
|
conf->mem->length = ((p[1] << 8) | p[0]) << 8;
|
|
conf->mem->address = ((p[3] << 8) | p[2]) << 8;
|
|
break;
|
|
case 3:
|
|
conf->memspace = 1;
|
|
x = *p++;
|
|
conf->memwins = CIS_MEM_WINS(x);
|
|
for (i = 0; i < conf->memwins; i++)
|
|
{
|
|
mem = xmalloc(sizeof(*mem));
|
|
if (i == 0)
|
|
conf->mem = mem;
|
|
else
|
|
lastmem->next = mem;
|
|
lastmem = mem;
|
|
u.l = 0;
|
|
for (j = 0 ; j < CIS_MEM_LENSZ(x); j++)
|
|
u.b[j] = *p++;
|
|
mem->length = u.l << 8;
|
|
u.l = 0;
|
|
for (j = 0 ; j < CIS_MEM_ADDRSZ(x); j++)
|
|
u.b[j] = *p++;
|
|
mem->address = u.l << 8;
|
|
if (x & CIS_MEM_HOST)
|
|
{
|
|
u.l = 0;
|
|
for (j = 0 ; j < CIS_MEM_ADDRSZ(x); j++)
|
|
u.b[j] = *p++;
|
|
mem->host_address = u.l << 8;
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
if (feat & 0x80)
|
|
{
|
|
conf->misc_valid = 1;
|
|
conf->misc = *p++;
|
|
}
|
|
}
|
|
/*
|
|
* 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;
|
|
|
|
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 = tp->data[0] |
|
|
(tp->data[1] << 8) |
|
|
(tp->data[2] << 16) |
|
|
(tp->data[3] << 24);
|
|
#ifdef DEBUG
|
|
printf("Checking long link at %ld (%s memory)\n",
|
|
offs, flag ? "Attribute" : "Common");
|
|
#endif
|
|
if (ck_linktarget(fd, offs, flag))
|
|
{
|
|
/*
|
|
* If a link was found, then read the tuple list from it.
|
|
*/
|
|
tl = read_one_tuplelist(fd, flag, offs);
|
|
last_tl->next = tl;
|
|
last_tl = tl;
|
|
}
|
|
}
|
|
} 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 && tlist->next == 0 &&
|
|
ck_linktarget(fd, (off_t)0, 0))
|
|
{
|
|
#ifdef DEBUG
|
|
printf("Reading long link at %ld (%s memory)\n",
|
|
offs, flag ? "Attribute" : "Common");
|
|
#endif
|
|
tlist->next = read_one_tuplelist(fd, 0, (off_t)0);
|
|
}
|
|
return(tlist);
|
|
}
|
|
/*
|
|
* Read one tuple list from the card.
|
|
*/
|
|
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_attr(fd, &code, 1) != 1)
|
|
{
|
|
perror("CIS code read");
|
|
break;
|
|
}
|
|
total++;
|
|
if (code == CIS_NULL)
|
|
continue;
|
|
tp = xmalloc(sizeof(*tp));
|
|
tp->code = code;
|
|
if (read_attr(fd, &length, 1) != 1)
|
|
{
|
|
perror("CIS len read");
|
|
break;
|
|
}
|
|
total++;
|
|
tp->length = length;
|
|
#ifdef DEBUG
|
|
fprintf(stderr, "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_attr(fd, tp->data, length) != length)
|
|
{
|
|
perror("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 == 0 || (tinfo->length != 255 && tinfo->length != length))
|
|
{
|
|
printf("code %s ignored\n", tuple_name(code));
|
|
tp->code = CIS_NULL;
|
|
}
|
|
if (tl->tuples==0)
|
|
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.
|
|
*/
|
|
int
|
|
ck_linktarget(int fd, off_t offs, int flag)
|
|
{
|
|
char blk[5];
|
|
|
|
ioctl(fd, PIOCRWFLAG, &flag);
|
|
lseek(fd, offs, SEEK_SET);
|
|
if (read_attr(fd, blk, 5) != 5)
|
|
return(0);
|
|
if (blk[0] == 0x13 &&
|
|
blk[1] == 0x3 &&
|
|
blk[2] == 'C' &&
|
|
blk[3] == 'I' &&
|
|
blk[4] == 'S')
|
|
return(1);
|
|
return(0);
|
|
}
|
|
/*
|
|
* find_tuple - find the indicated tuple in the CIS
|
|
*/
|
|
struct tuple *
|
|
find_tuple(struct cis *sp, unsigned char code)
|
|
{
|
|
struct tuple_list *tl;
|
|
struct tuple *tp;
|
|
|
|
for (tl = sp->tlist; tl; tl = tl->next)
|
|
if ((tp = find_tuple_in_list(tl, code)) != 0)
|
|
return(tp);
|
|
return(0);
|
|
}
|
|
/*
|
|
* find_tuple_in_list - find a tuple within a
|
|
* single tuple list.
|
|
*/
|
|
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);
|
|
}
|
|
static int
|
|
read_attr(int fd, char *bp, int len)
|
|
{
|
|
char blk[1024], *p = blk;
|
|
int i,l;
|
|
|
|
if (len > sizeof(blk)/2)
|
|
len = sizeof(blk)/2;
|
|
l = i = read(fd, blk, len*2);
|
|
if (i <= 0)
|
|
{
|
|
printf("Read return %d bytes (expected %d)\n", i, len*2);
|
|
return(i);
|
|
}
|
|
while (i > 0)
|
|
{
|
|
*bp++ = *p++;
|
|
p++;
|
|
i -= 2;
|
|
}
|
|
return(l/2);
|
|
}
|
|
/*
|
|
* return table entry for code.
|
|
*/
|
|
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);
|
|
printf("Code %d not found\n", code);
|
|
return(0);
|
|
}
|
|
char *
|
|
tuple_name(unsigned char code)
|
|
{
|
|
struct tuple_info *tp;
|
|
|
|
tp = get_tuple_info(code);
|
|
if (tp)
|
|
return(tp->name);
|
|
return("Unknown");
|
|
}
|