Files
bpfire/src/hwinfo/src/hd/hddb.c
ms a6316ce423 Zwischencommit Installer...
git-svn-id: http://svn.ipfire.org/svn/ipfire/trunk@333 ea5c0bd1-69bd-2848-81d8-4f18e57aeed8
2006-10-30 20:23:28 +00:00

2749 lines
64 KiB
C

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#include <sys/utsname.h>
#include "hd.h"
#include "hd_int.h"
#include "hddb.h"
#include "isdn.h"
#include "hddb_int.h"
extern hddb2_data_t hddb_internal;
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
// #define HDDB_TRACE
// #define HDDB_TEST
// #define HDDB_EXTERNAL_ONLY
static char *hid_tag_names[] = { "", "pci ", "eisa ", "usb ", "special ", "pcmcia " };
// just experimenting...
static char *hid_tag_names2[] = { "", "pci ", "eisa ", "usb ", "int ", "pcmcia " };
typedef enum {
pref_empty, pref_new, pref_and, pref_or, pref_add
} prefix_t;
typedef struct line_s {
prefix_t prefix;
hddb_entry_t key;
char *value;
} line_t;
typedef struct {
int len;
unsigned val[32]; /* arbitrary (approx. max. number of modules/xf86 config lines) */
} tmp_entry_t;
/* except for driver, all strings are static and _must not_ be freed */
typedef struct {
hddb_entry_mask_t key;
hddb_entry_mask_t value;
hddb_entry_mask_t value_mask[he_nomask];
hd_id_t bus;
hd_id_t base_class;
hd_id_t sub_class;
hd_id_t prog_if;
hd_id_t vendor;
hd_id_t device;
hd_id_t sub_vendor;
hd_id_t sub_device;
hd_id_t revision;
hd_id_t cu_model;
char *serial;
str_list_t *driver;
char *requires;
} hddb_search_t;
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
static void hddb_init_pci(hd_data_t *hd_data);
static hddb_pci_t *parse_pcimap(str_list_t *file);
static driver_info_t *hd_pcidb(hd_data_t *hd_data, hddb_pci_t *pci_db, hd_t *hd, driver_info_t *drv_info);
static void hddb_init_external(hd_data_t *hd_data);
static line_t *parse_line(char *str);
static unsigned store_string(hddb2_data_t *x, char *str);
static unsigned store_list(hddb2_data_t *x, hddb_list_t *list);
static unsigned store_value(hddb2_data_t *x, unsigned val);
static unsigned store_entry(hddb2_data_t *x, tmp_entry_t *te);
static void clear_entry(tmp_entry_t *te);
static void add_value(tmp_entry_t *te, hddb_entry_t idx, unsigned val);
static hddb_entry_mask_t add_entry(hddb2_data_t *hddb2, tmp_entry_t *te, hddb_entry_t idx, char *str);
static int compare_ids(hddb2_data_t *hddb, hddb_search_t *hs, hddb_entry_mask_t mask, unsigned key);
static void complete_ids(hddb2_data_t *hddb, hddb_search_t *hs, hddb_entry_mask_t key_mask, hddb_entry_mask_t mask, unsigned val_idx);
static int hddb_search(hd_data_t *hd_data, hddb_search_t *hs, int max_recursions);
#ifdef HDDB_TEST
static void test_db(hd_data_t *hd_data);
#endif
static driver_info_t *hddb_to_device_driver(hd_data_t *hd_data, hddb_search_t *hs);
static driver_info_t *kbd_driver(hd_data_t *hd_data, hd_t *hd);
static driver_info_t *monitor_driver(hd_data_t *hd_data, hd_t *hd);
#if WITH_ISDN
/* static int chk_free_biosmem(hd_data_t *hd_data, unsigned addr, unsigned len); */
/* static isdn_parm_t *new_isdn_parm(isdn_parm_t **ip); */
static driver_info_t *isdn_driver(hd_data_t *hd_data, hd_t *hd, cdb_isdn_card *cic);
static driver_info_t *dsl_driver(hd_data_t *hd_data, hd_t *hd, cdb_isdn_card *cic);
#endif
static hd_res_t *get_res(hd_t *h, enum resource_types t, unsigned index);
static driver_info_t *reorder_x11(driver_info_t *di0, char *info);
static void expand_driver_info(hd_data_t *hd_data, hd_t *hd);
static char *module_cmd(hd_t *hd, char *cmd);
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
void hddb_init_pci(hd_data_t *hd_data)
{
str_list_t *sl = NULL;
char *s = NULL, *r;
struct utsname ubuf;
if(!hd_data->hddb_pci) {
if(!uname(&ubuf)) {
r = getenv("LIBHD_KERNELVERSION");
if(!r || !*r) r = ubuf.release;
str_printf(&s, 0, "/lib/modules/%s/modules.pcimap", r);
sl = read_file(s, 0, 0);
s = free_mem(s);
}
hd_data->hddb_pci = parse_pcimap(sl);
sl = free_str_list(sl);
}
if(!hd_data->hddb_pci_hm) {
sl = read_file("/etc/hotplug/pci.handmap", 0, 0);
hd_data->hddb_pci_hm = parse_pcimap(sl);
sl = free_str_list(sl);
}
}
hddb_pci_t *parse_pcimap(str_list_t *file)
{
str_list_t *sl;
unsigned len;
hddb_pci_t *pci, *p;
char buf[64];
unsigned u0, u1, u2, u3, u4, u5;
for(len = 1, sl = file; sl; sl = sl->next) len++;
pci = new_mem(len * sizeof *pci);
for(p = pci, sl = file; sl; sl = sl->next) {
if(sscanf(sl->str, "%63s %x %x %x %x %x %x", buf, &u0, &u1, &u2, &u3, &u4, &u5) == 7) {
p->module = new_str(buf);
p->vendor = u0;
p->device = u1;
p->subvendor = u2;
p->subdevice = u3;
p->pciclass = u4;
p->classmask = u5;
p++;
}
}
#if 0
fprintf(stderr, "--- pcimap ---\n");
for(p = pci; p->module; p++) {
fprintf(stderr, "%s, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n",
p->module, p->vendor, p->device, p->subvendor, p->subdevice,
p->pciclass, p->classmask
);
}
#endif
return pci;
}
driver_info_t *hd_pcidb(hd_data_t *hd_data, hddb_pci_t *pci_db, hd_t *hd, driver_info_t *drv_info)
{
unsigned vendor, device, subvendor, subdevice, pciclass;
driver_info_t **di = NULL, *di2;
pci_t *pci;
char *mod_list[16 /* arbitrary */];
int mod_prio[sizeof mod_list / sizeof *mod_list];
int i, prio, mod_list_len;
if(!pci_db) return drv_info;
if(ID_TAG(hd->vendor.id) != TAG_PCI) return drv_info;
/* don't add module info if driver info of some other type exists */
for(di = &drv_info; *di; di = &(*di)->next) {
if((*di)->any.type != di_module) return drv_info;
}
vendor = ID_VALUE(hd->vendor.id);
device = ID_VALUE(hd->device.id);
subvendor = ID_VALUE(hd->sub_vendor.id);
subdevice = ID_VALUE(hd->sub_device.id);
pciclass = (hd->base_class.id << 16) + ((hd->sub_class.id & 0xff) << 8) + (hd->prog_if.id & 0xff);
if(
hd->detail &&
hd->detail->type == hd_detail_pci &&
(pci = hd->detail->pci.data)
) {
pciclass = (pci->base_class << 16) + ((pci->sub_class & 0xff) << 8) + (pci->prog_if & 0xff);
}
for(mod_list_len = 0; pci_db->module; pci_db++) {
if(
(pci_db->vendor == 0xffffffff || pci_db->vendor == vendor) &&
(pci_db->device == 0xffffffff || pci_db->device == device) &&
(pci_db->subvendor == 0xffffffff || pci_db->subvendor == subvendor) &&
(pci_db->subdevice == 0xffffffff || pci_db->subdevice == subdevice) &&
!((pci_db->pciclass ^ pciclass) & pci_db->classmask)
) {
for(di2 = drv_info; di2; di2 = di2->next) {
if(
di2->any.type == di_module &&
di2->any.hddb0 &&
di2->any.hddb0->str &&
!strcmp(di2->any.hddb0->str, pci_db->module)
) break;
}
if(di2) continue;
prio = 0;
if(pci_db->vendor == vendor) prio = 1;
if(pci_db->device == device) prio = 2;
if(pci_db->subvendor == subvendor) prio = 3;
if(pci_db->subdevice == subdevice) prio = 4;
mod_prio[mod_list_len] = prio;
mod_list[mod_list_len++] = pci_db->module;
if(mod_list_len >= sizeof mod_list / sizeof *mod_list) break;
}
}
for(prio = 4; prio >= 0; prio--) {
for(i = 0; i < mod_list_len; i++) {
if(mod_prio[i] == prio) {
*di = new_mem(sizeof **di);
(*di)->any.type = di_module;
(*di)->module.modprobe = 1;
add_str_list(&(*di)->any.hddb0, mod_list[i]);
di = &(*di)->next;
}
}
}
return drv_info;
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
void hddb_init(hd_data_t *hd_data)
{
hddb_init_pci(hd_data);
hddb_init_external(hd_data);
#ifndef HDDB_EXTERNAL_ONLY
hd_data->hddb2[1] = &hddb_internal;
#endif
#ifdef HDDB_TEST
test_db(hd_data);
#endif
}
void hddb_init_external(hd_data_t *hd_data)
{
str_list_t *sl, *sl0;
line_t *l;
unsigned l_start, l_end /* end points _past_ last element */;
unsigned u, ent, l_nr = 1;
tmp_entry_t tmp_entry[he_nomask /* _must_ be he_nomask! */];
hddb_entry_mask_t entry_mask = 0;
int state;
hddb_list_t dbl = {};
hddb2_data_t *hddb2;
if(hd_data->hddb2[0]) return;
hddb2 = hd_data->hddb2[0] = new_mem(sizeof *hd_data->hddb2[0]);
sl0 = read_file(ID_LIST, 0, 0);
l_start = l_end = 0;
state = 0;
for(sl = sl0; sl; sl = sl->next, l_nr++) {
l = parse_line(sl->str);
if(!l) {
ADD2LOG("hd.ids line %d: invalid line\n", l_nr);
state = 4;
break;
};
if(l->prefix == pref_empty) continue;
switch(l->prefix) {
case pref_new:
if((state == 2 && !entry_mask) || state == 1) {
ADD2LOG("hd.ids line %d: new item not allowed\n", l_nr);
state = 4;
break;
}
if(state == 2 && entry_mask) {
ent = store_entry(hddb2, tmp_entry);
if(ent == -1u) {
ADD2LOG("hd.ids line %d: internal hddb oops 1\n", l_nr);
state = 4;
break;
}
if(l_end && l_end > l_start) {
for(u = l_start; u < l_end; u++) {
hddb2->list[u].value_mask = entry_mask;
hddb2->list[u].value = ent;
}
}
}
entry_mask = 0;
clear_entry(tmp_entry);
state = 1;
l_start = store_list(hddb2, &dbl);
l_end = l_start + 1;
break;
case pref_and:
if(state != 1) {
ADD2LOG("hd.ids line %d: must start item first\n", l_nr);
state = 4;
break;
}
break;
case pref_or:
if(state != 1 || !entry_mask || l_end <= l_start || l_end < 1) {
ADD2LOG("hd.ids line %d: must start item first\n", l_nr);
state = 4;
break;
}
ent = store_entry(hddb2, tmp_entry);
if(ent == -1u) {
ADD2LOG("hd.ids line %d: internal hddb oops 2\n", l_nr);
state = 4;
break;
}
hddb2->list[l_end - 1].key_mask = entry_mask;
hddb2->list[l_end - 1].key = ent;
entry_mask = 0;
clear_entry(tmp_entry);
u = store_list(hddb2, &dbl);
if(u != l_end) {
ADD2LOG("hd.ids line %d: internal hddb oops 2\n", l_nr);
state = 4;
break;
}
l_end++;
break;
case pref_add:
if(state == 1 && !entry_mask) {
ADD2LOG("hd.ids line %d: driver info not allowed\n", l_nr);
state = 4;
break;
}
if(state == 1 && l_end > l_start) {
ent = store_entry(hddb2, tmp_entry);
if(ent == -1u) {
ADD2LOG("hd.ids line %d: internal hddb oops 3\n", l_nr);
state = 4;
break;
}
hddb2->list[l_end - 1].key_mask = entry_mask;
hddb2->list[l_end - 1].key = ent;
entry_mask = 0;
clear_entry(tmp_entry);
state = 2;
}
if(state != 2 || l_end == 0) {
ADD2LOG("hd.ids line %d: driver info not allowed\n", l_nr);
state = 4;
break;
}
break;
default:
state = 4;
}
if(state != 4) {
u = add_entry(hddb2, tmp_entry, l->key, l->value);
if(u) {
entry_mask |= u;
}
else {
ADD2LOG("hd.ids line %d: invalid info\n", l_nr);
state = 4;
}
}
if(state == 4) break; /* error */
}
/* finalize last item */
if(state == 2 && entry_mask) {
ent = store_entry(hddb2, tmp_entry);
if(ent == -1u) {
ADD2LOG("hd.ids line %d: internal hddb oops 4\n", l_nr);
state = 4;
}
else if(l_end && l_end > l_start) {
for(u = l_start; u < l_end; u++) {
hddb2->list[u].value_mask = entry_mask;
hddb2->list[u].value = ent;
}
}
}
sl0 = free_str_list(sl0);
if(state == 4) {
/* there was an error */
free_mem(hddb2->list);
free_mem(hddb2->ids);
free_mem(hddb2->strings);
hd_data->hddb2[0] = free_mem(hd_data->hddb2[0]);
}
}
line_t *parse_line(char *str)
{
static line_t l;
char *s;
int i;
/* drop leading spaces */
while(isspace(*str)) str++;
/* skip emtpy lines and comments */
if(!*str || *str == ';' || *str == '#') {
l.prefix = pref_empty;
return &l;
}
l.prefix = pref_new;
switch(*str) {
case '&':
l.prefix = pref_and;
str++;
break;
case '|':
l.prefix = pref_or;
str++;
break;
case '+':
l.prefix = pref_add;
str++;
break;
}
/* skip spaces */
while(isspace(*str)) str++;
s = str;
while(*str && !isspace(*str)) str++;
if(*str) *str++ = 0;
while(isspace(*str)) str++;
for(i = 0; (unsigned) i < sizeof hddb_entry_strings / sizeof *hddb_entry_strings; i++) {
if(!strcmp(s, hddb_entry_strings[i])) {
l.key = i;
break;
}
}
if((unsigned) i >= sizeof hddb_entry_strings / sizeof *hddb_entry_strings) return NULL;
l.value = str;
/* drop trailing white space */
i = strlen(str);
while(i > 0) {
if(isspace(str[i - 1]))
str[--i] = 0;
else
break;
}
/* special case: drop leading and final double quotes, if any */
i = strlen(l.value);
if(i >= 2 && l.value[0] == '"' && l.value[i - 1] == '"') {
l.value[i - 1] = 0;
l.value++;
}
// fprintf(stderr, "pre = %d, key = %d, val = \"%s\"\n", l.prefix, l.key, l.value);
return &l;
}
unsigned store_string(hddb2_data_t *x, char *str)
{
unsigned l = strlen(str), u;
if(x->strings_len + l >= x->strings_max) {
x->strings_max += l + 0x1000; /* >4k steps */
x->strings = resize_mem(x->strings, x->strings_max * sizeof *x->strings);
}
/* make sure the 1st byte is 0 */
if(x->strings_len == 0) {
*x->strings = 0; /* resize_mem does _not_ clear memory */
x->strings_len = 1;
}
if(l == 0) return 0; /* 1st byte is always 0 */
strcpy(x->strings + (u = x->strings_len), str);
x->strings_len += l + 1;
return u;
}
unsigned store_list(hddb2_data_t *x, hddb_list_t *list)
{
if(x->list_len == x->list_max) {
x->list_max += 0x100; /* 4k steps */
x->list = resize_mem(x->list, x->list_max * sizeof *x->list);
}
x->list[x->list_len++] = *list;
return x->list_len - 1;
}
unsigned store_value(hddb2_data_t *x, unsigned val)
{
if(x->ids_len == x->ids_max) {
x->ids_max += 0x400; /* 4k steps */
x->ids = resize_mem(x->ids, x->ids_max * sizeof *x->ids);
}
x->ids[x->ids_len++] = val;
return x->ids_len - 1;
}
/* returns index in hddb2->ids */
unsigned store_entry(hddb2_data_t *x, tmp_entry_t *te)
{
int i, j;
unsigned ent = -1, u, v;
for(i = 0; i < he_nomask; i++) {
if(te[i].len) {
for(j = 0; j < te[i].len; j++) {
v = te[i].val[j] | (1 << 31);
if(j == te[i].len - 1) v &= ~(1 << 31);
u = store_value(x, v);
if(ent == -1u) ent = u;
}
}
}
return ent;
}
void clear_entry(tmp_entry_t *te)
{
memset(te, 0, he_nomask * sizeof *te);
}
void add_value(tmp_entry_t *te, hddb_entry_t idx, unsigned val)
{
if(idx >= he_nomask) return;
te += idx;
if((unsigned) te->len >= sizeof te->val / sizeof *te->val) return;
te->val[te->len++] = val;
}
int parse_id(char *str, unsigned *id, unsigned *range, unsigned *mask)
{
static unsigned id0, val;
unsigned tag = 0;
char c = 0, *s, *t = NULL;
*id = *range = *mask = 0;
if(!str || !*str) return 0;
for(s = str; *str && !isspace(*str); str++);
if(*str) {
c = *(t = str); /* remember for later */
*str++ = 0;
}
while(isspace(*str)) str++;
if(*s) {
if(!strcmp(s, "pci")) tag = TAG_PCI;
else if(!strcmp(s, "usb")) tag = TAG_USB;
else if(!strcmp(s, "special")) tag = TAG_SPECIAL;
else if(!strcmp(s, "eisa")) tag = TAG_EISA;
else if(!strcmp(s, "isapnp")) tag = TAG_EISA;
else if(!strcmp(s, "pcmcia")) tag = TAG_PCMCIA;
else {
str = s;
if(t) *t = c; /* restore */
}
}
id0 = strtoul(str, &s, 0);
if(s == str) {
id0 = name2eisa_id(str);
if(!id0) return 0;
s = str + 3;
id0 = ID_VALUE(id0);
if(!tag) tag = TAG_EISA;
}
while(isspace(*s)) s++;
if(*s && *s != '&' && *s != '+') return 0;
*id = MAKE_ID(tag, id0);
if(!*s) return 1;
c = *s++;
while(isspace(*s)) s++;
val = strtoul(s, &str, 0);
if(s == str) return 0;
while(isspace(*str)) str++;
if(*str) return 0;
if(c == '+') *range = val; else *mask = val;
return c == '+' ? 2 : 3;
}
hddb_entry_mask_t add_entry(hddb2_data_t *hddb2, tmp_entry_t *te, hddb_entry_t idx, char *str)
{
hddb_entry_mask_t mask = 0;
int i;
unsigned u, u0, u1, u2;
char *s, c;
for(i = 0; (unsigned) i < sizeof hddb_is_numeric / sizeof *hddb_is_numeric; i++) {
if(idx == hddb_is_numeric[i]) break;
}
if((unsigned) i < sizeof hddb_is_numeric / sizeof *hddb_is_numeric) {
/* numeric id */
mask |= 1 << idx;
i = parse_id(str, &u0, &u1, &u2);
switch(i) {
case 1:
add_value(te, idx, MAKE_DATA(FLAG_ID, u0));
break;
case 2:
add_value(te, idx, MAKE_DATA(FLAG_RANGE, u1));
add_value(te, idx, MAKE_DATA(FLAG_ID, u0));
break;
case 3:
add_value(te, idx, MAKE_DATA(FLAG_MASK, u2));
add_value(te, idx, MAKE_DATA(FLAG_ID, u0));
break;
default:
return 0;
}
}
else {
if(idx < he_nomask) {
/* strings */
mask |= 1 << idx;
u = store_string(hddb2, str);
// fprintf(stderr, ">>> %s\n", str);
add_value(te, idx, MAKE_DATA(FLAG_STRING, u));
}
else {
/* special */
if(idx == he_class_id) {
i = parse_id(str, &u0, &u1, &u2);
if(i != 1) return 0;
u = ID_VALUE(u0) >> 8;
add_value(te, he_baseclass_id, MAKE_DATA(FLAG_ID, u));
u = u0 & 0xff;
add_value(te, he_subclass_id, MAKE_DATA(FLAG_ID, u));
/* add_value(te, he_progif_id, MAKE_DATA(FLAG_ID, 0)); */
mask |= (1 << he_baseclass_id) + (1 << he_subclass_id) /* + (1 << he_progif_id) */;
}
else {
switch(idx) {
case he_driver_module_insmod:
c = 'i';
break;
case he_driver_module_modprobe:
c = 'm';
break;
case he_driver_module_config:
c = 'M';
break;
case he_driver_xfree:
c = 'x';
break;
case he_driver_xfree_config:
c = 'X';
break;
case he_driver_mouse:
c = 'p';
break;
case he_driver_display:
c = 'd';
break;
case he_driver_any:
c = 'a';
break;
default:
c = 0;
break;
}
if(c) {
s = new_mem(strlen(str) + 3);
s[0] = c;
s[1] = '\t';
strcpy(s + 2, str);
mask |= add_entry(hddb2, te, he_driver, s);
s = free_mem(s);
}
}
}
}
return mask;
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
void hddb_dump_raw(hddb2_data_t *hddb, FILE *f)
{
int i;
unsigned u, fl, v, t, id;
char *s;
if(!hddb) return;
fprintf(f, "=== strings 0x%05x/0x%05x ===\n", hddb->strings_len, hddb->strings_max);
for(s = hddb->strings, i = 0, u = 0; u < hddb->strings_len; u++) {
if(!hddb->strings[u]) {
fprintf(f, "%4d (0x%05x): \"%s\"\n", i, (unsigned) (s - hddb->strings), s);
i++;
s = hddb->strings + u + 1;
}
}
fprintf(f, "\n=== ids 0x%05x/0x%05x ===\n", hddb->ids_len, hddb->ids_max);
for(u = 0; u < hddb->ids_len; u++) {
fprintf(f, "0x%05x: 0x%08x ", u, hddb->ids[u]);
if(hddb->ids[u] & (1 << 31)) fprintf(f, " ");
fl = DATA_FLAG(hddb->ids[u]) & 0x7;
v = DATA_VALUE(hddb->ids[u]);
if(fl == FLAG_STRING && v < hddb->strings_len) {
fprintf(f, "\"%s\"", hddb->strings + v);
}
else if(fl == FLAG_MASK) {
fprintf(f, "&0x%04x", v);
}
else if(fl == FLAG_RANGE) {
fprintf(f, "+0x%04x", v);
}
else if(fl == FLAG_ID) {
t = ID_TAG(v);
id = ID_VALUE(v);
fprintf(f, "%s0x%04x", hid_tag_name(t), id);
if(t == TAG_EISA) {
fprintf(f, " (%s)", eisa_vendor_str(id));
}
}
fprintf(f, "\n");
}
fprintf(f, "\n=== search list 0x%05x/0x%05x ===\n", hddb->list_len, hddb->list_max);
for(u = 0; u < hddb->list_len; u++) {
fprintf(f,
"%4d: 0x%08x 0x%08x 0x%05x 0x%05x\n",
u, hddb->list[u].key_mask, hddb->list[u].value_mask,
hddb->list[u].key, hddb->list[u].value
);
}
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
void hddb_dump_ent_name(hddb2_data_t *hddb, FILE *f, char pre, hddb_entry_t ent)
{
int len, tab_ind = 24;
if(ent >= sizeof hddb_entry_strings / sizeof *hddb_entry_strings) return;
fprintf(f, "%c%s\t", pre, hddb_entry_strings[ent]);
len = strlen(hddb_entry_strings[ent]) + 1;
for(len = (len & ~7) + 8; len < tab_ind; len += 8) {
fputc('\t', f);
}
}
void hddb_dump_skey(hddb2_data_t *hddb, FILE *f, prefix_t pre, hddb_entry_mask_t key_mask, unsigned key)
{
static char pref_char[5] = { ' ', ' ', '&', '|', '+' };
hddb_entry_t ent;
unsigned rm_val = 0, r_or_m = 0;
unsigned fl, val, *ids, id, tag, u;
char *str_val;
int i;
if(pre >= sizeof pref_char) return;
if(key >= hddb->ids_len) return;
ids = hddb->ids + key;
for(ent = 0; ent < he_nomask && key_mask; ent++, key_mask >>= 1) {
if(!(key_mask & 1)) continue;
fl = DATA_FLAG(*ids);
val = DATA_VALUE(*ids);
r_or_m = 0;
while((fl & FLAG_CONT)) {
if(fl == (FLAG_CONT | FLAG_RANGE)) {
rm_val = val;
r_or_m = 1;
}
else if(fl == (FLAG_CONT | FLAG_MASK)) {
rm_val = val;
r_or_m = 2;
}
else {
break;
}
ids++;
fl = DATA_FLAG(*ids);
val = DATA_VALUE(*ids);
}
fl &= ~FLAG_CONT;
if(ent != he_driver) {
hddb_dump_ent_name(hddb, f, pref_char[pre], ent);
if(fl == FLAG_ID) {
tag = ID_TAG(val);
id = ID_VALUE(val);
if(tag == TAG_EISA && (ent == he_vendor_id || ent == he_subvendor_id)) {
fprintf(f, "%s", eisa_vendor_str(id));
}
else {
u = 4;
if(ent == he_bus_id || ent == he_subclass_id || ent == he_progif_id) {
u = 2;
}
else if(ent == he_baseclass_id) {
u = 3;
}
fprintf(f, "%s0x%0*x", hid_tag_name(tag), u, id);
}
if(r_or_m) {
fprintf(f, "%c0x%04x", r_or_m == 1 ? '+' : '&', rm_val);
}
}
else if(fl == FLAG_STRING) {
if(val < hddb->strings_len) {
str_val = hddb->strings + val;
fprintf(f, "%s", str_val);
}
}
fputc('\n', f);
}
else {
ids--;
do {
ids++;
fl = DATA_FLAG(*ids) & ~FLAG_CONT;
val = DATA_VALUE(*ids);
if(fl != FLAG_STRING) break;
str_val = NULL;
if(val < hddb->strings_len) str_val = hddb->strings + val;
if(!str_val) break;
if(!*str_val && !str_val[1] == '\t') break;
switch(*str_val) {
case 'x':
i = he_driver_xfree;
break;
case 'X':
i = he_driver_xfree_config;
break;
case 'i':
i = he_driver_module_insmod;
break;
case 'm':
i = he_driver_module_modprobe;
break;
case 'M':
i = he_driver_module_config;
break;
case 'p':
i = he_driver_mouse;
break;
case 'd':
i = he_driver_display;
break;
case 'a':
i = he_driver_any;
break;
default:
i = -1;
break;
}
if(i == -1) break;
hddb_dump_ent_name(hddb, f, pref_char[pre], i);
fprintf(f, "%s\n", str_val + 2);
}
while((*ids & (1 << 31)));
}
/* at this point 'ids' must be the _current_ entry (_not_ the next) */
/* skip potential garbage/unhandled entries */
while((*ids & (1 << 31))) ids++;
ids++;
if(pre != pref_add) pre = pref_and;
}
}
void hddb_dump(hddb2_data_t *hddb, FILE *f)
{
unsigned u;
if(!hddb) return;
for(u = 0; u < hddb->list_len; u++) {
hddb_dump_skey(hddb, f, pref_new, hddb->list[u].key_mask, hddb->list[u].key);
hddb_dump_skey(hddb, f, pref_add, hddb->list[u].value_mask, hddb->list[u].value);
fputc('\n', f);
}
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
int compare_ids(hddb2_data_t *hddb, hddb_search_t *hs, hddb_entry_mask_t mask, unsigned key)
{
hddb_entry_t ent;
unsigned rm_val = 0, r_or_m = 0, res = 0;
unsigned fl, val, ok, *ids, id;
char *str, *str_val;
if(key >= hddb->ids_len) return 1;
ids = hddb->ids + key;
for(ent = 0; ent < he_nomask && mask && !res; ent++, mask >>= 1) {
if(!(mask & 1)) continue;
fl = DATA_FLAG(*ids);
val = DATA_VALUE(*ids);
r_or_m = 0;
while((fl & FLAG_CONT)) {
if(fl == (FLAG_CONT | FLAG_RANGE)) {
rm_val = val;
r_or_m = 1;
}
else if(fl == (FLAG_CONT | FLAG_MASK)) {
rm_val = val;
r_or_m = 2;
}
else {
break;
}
ids++;
fl = DATA_FLAG(*ids);
val = DATA_VALUE(*ids);
}
fl &= ~FLAG_CONT;
id = 0;
str = str_val = NULL;
ok = 0;
if(fl == FLAG_ID) {
ok = 1;
switch(ent) {
case he_bus_id:
id = hs->bus.id;
break;
case he_baseclass_id:
id = hs->base_class.id;
break;
case he_subclass_id:
id = hs->sub_class.id;
break;
case he_progif_id:
id = hs->prog_if.id;
break;
case he_vendor_id:
id = hs->vendor.id;
break;
case he_device_id:
id = hs->device.id;
break;
case he_subvendor_id:
id = hs->sub_vendor.id;
break;
case he_subdevice_id:
id = hs->sub_device.id;
break;
case he_rev_id:
id = hs->revision.id;
break;
case he_detail_ccw_data_cu_model:
id = hs->cu_model.id;
break;
default:
ok = 0;
break;
}
}
else if(fl == FLAG_STRING) {
if(val < hddb->strings_len) str_val = hddb->strings + val;
ok = 2;
switch(ent) {
case he_bus_name:
str = hs->bus.name;
break;
case he_baseclass_name:
str = hs->base_class.name;
break;
case he_subclass_name:
str = hs->sub_class.name;
break;
case he_progif_name:
str = hs->prog_if.name;
break;
case he_vendor_name:
str = hs->vendor.name;
break;
case he_device_name:
str = hs->device.name;
break;
case he_subvendor_name:
str = hs->sub_vendor.name;
break;
case he_subdevice_name:
str = hs->sub_device.name;
break;
case he_rev_name:
str = hs->revision.name;
break;
case he_serial:
str = hs->serial;
break;
case he_requires:
str = hs->requires;
break;
default:
ok = 0;
}
}
switch(ok) {
case 1:
switch(r_or_m) {
case 1:
if(id < val || id >= val + rm_val) res = 1;
break;
case 2:
if((id & ~rm_val) != val) res = 1;
break;
default:
if(id != val) res = 1;
}
break;
case 2:
if(str && str_val) {
if(strcmp(str, str_val)) res = 1;
}
else {
res = 1;
}
break;
default:
res = 1;
}
#ifdef HDDB_TRACE
switch(ok) {
case 1:
if(r_or_m) {
printf(
"cmp: 0x%05x: (ent = %2d, id = 0x%x, val = 0x%x%c0x%x) = %d\n",
key, ent, id, val, r_or_m == 1 ? '+' : '&', rm_val, res
);
}
else {
printf(
"cmp: 0x%05x: (ent = %2d, id = 0x%x, val = 0x%x) = %d\n",
key, ent, id, val, res
);
}
break;
case 2:
printf(
"cmp: 0x%05x: (ent = %2d, id = \"%s\", val = \"%s\") = %d\n",
key, ent, str, str_val, res
);
break;
default:
printf("cmp: 0x%05x: (ent = %2d, *** unhandled key ***) = %d\n", key, ent, res);
}
#endif
/* at this point 'ids' must be the _current_ entry (_not_ the next) */
/* skip potential garbage/unhandled entries */
while((*ids & (1 << 31))) ids++;
ids++;
}
return res;
}
void complete_ids(
hddb2_data_t *hddb, hddb_search_t *hs,
hddb_entry_mask_t key_mask, hddb_entry_mask_t mask, unsigned val_idx
)
{
hddb_entry_t ent;
unsigned *ids, *id;
unsigned fl, val, ok;
char **str, *str_val;
if(val_idx >= hddb->ids_len) return;
ids = hddb->ids + val_idx;
for(ent = 0; ent < he_nomask && mask; ent++, mask >>= 1) {
if(!(mask & 1)) continue;
fl = DATA_FLAG(*ids);
val = DATA_VALUE(*ids);
fl &= ~FLAG_CONT;
id = NULL;
str = NULL;
str_val = NULL;
ok = 0;
if(fl == FLAG_ID) {
ok = 1;
switch(ent) {
case he_bus_id:
id = &hs->bus.id;
break;
case he_baseclass_id:
id = &hs->base_class.id;
break;
case he_subclass_id:
id = &hs->sub_class.id;
break;
case he_progif_id:
id = &hs->prog_if.id;
break;
case he_vendor_id:
id = &hs->vendor.id;
break;
case he_device_id:
id = &hs->device.id;
break;
case he_subvendor_id:
id = &hs->sub_vendor.id;
break;
case he_subdevice_id:
id = &hs->sub_device.id;
break;
case he_rev_id:
id = &hs->revision.id;
break;
case he_detail_ccw_data_cu_model:
id = &hs->cu_model.id;
break;
default:
ok = 0;
break;
}
}
else if(fl == FLAG_STRING) {
if(val < hddb->strings_len) str_val = hddb->strings + val;
ok = 2;
switch(ent) {
case he_bus_name:
str = &hs->bus.name;
break;
case he_baseclass_name:
str = &hs->base_class.name;
break;
case he_subclass_name:
str = &hs->sub_class.name;
break;
case he_progif_name:
str = &hs->prog_if.name;
break;
case he_vendor_name:
str = &hs->vendor.name;
break;
case he_device_name:
str = &hs->device.name;
break;
case he_subvendor_name:
str = &hs->sub_vendor.name;
break;
case he_subdevice_name:
str = &hs->sub_device.name;
break;
case he_rev_name:
str = &hs->revision.name;
break;
case he_serial:
str = &hs->serial;
break;
case he_driver:
ok = 3;
break;
case he_requires:
str = &hs->requires;
break;
default:
ok = 0;
}
}
if(ok) {
if(
(hs->value_mask[ent] & key_mask) == hs->value_mask[ent] &&
key_mask != hs->value_mask[ent]
) {
hs->value_mask[ent] = key_mask;
hs->value |= 1 << ent;
}
else {
/* don't change if already set */
ok = 4;
}
#if 0
if((hs->value & (1 << ent))) {
/* don't change if already set */
ok = 4;
}
else if(ent != he_driver) {
hs->value |= 1 << ent;
}
#endif
}
switch(ok) {
case 1:
*id = val;
#ifdef HDDB_TRACE
printf("add: 0x%05x: (ent = %2d, val = 0x%08x)\n", val_idx, ent, val);
#endif
break;
case 2:
*str = str_val;
#ifdef HDDB_TRACE
printf("add: 0x%05x: (ent = %2d, val = \"%s\")\n", val_idx, ent, str_val);
#endif
break;
case 3:
ids--;
hs->driver = free_str_list(hs->driver);
do {
ids++;
fl = DATA_FLAG(*ids) & ~FLAG_CONT;
val = DATA_VALUE(*ids);
if(fl != FLAG_STRING) break;
str_val = NULL;
if(val < hddb->strings_len) str_val = hddb->strings + val;
if(!str_val) break;
#ifdef HDDB_TRACE
printf("add: 0x%05x: (ent = %2d, val = \"%s\")\n", val_idx, ent, str_val);
#endif
add_str_list(&hs->driver, str_val);
}
while((*ids & (1 << 31)));
break;
case 4:
break;
#ifdef HDDB_TRACE
default:
printf("add: 0x%05x: (ent = %2d, *** unhandled value ***)\n", val_idx, ent);
#endif
}
/* at this point 'ids' must be the _current_ entry (_not_ the next) */
/* skip potential garbage/unhandled entries */
while((*ids & (1 << 31))) ids++;
ids++;
}
}
int hddb_search(hd_data_t *hd_data, hddb_search_t *hs, int max_recursions)
{
unsigned u;
int i;
hddb2_data_t *hddb;
int db_idx;
hddb_entry_mask_t all_values = 0;
if(!hs) return 0;
if(!max_recursions) max_recursions = 2;
while(max_recursions--) {
for(db_idx = 0; (unsigned) db_idx < sizeof hd_data->hddb2 / sizeof *hd_data->hddb2; db_idx++) {
if(!(hddb = hd_data->hddb2[db_idx])) continue;
for(u = 0; u < hddb->list_len; u++) {
if(
(hs->key & hddb->list[u].key_mask) == hddb->list[u].key_mask
/* && (hs->value & hddb->list[u].value_mask) != hddb->list[u].value_mask */
) {
i = compare_ids(hddb, hs, hddb->list[u].key_mask, hddb->list[u].key);
if(!i) {
complete_ids(hddb, hs,
hddb->list[u].key_mask,
hddb->list[u].value_mask, hddb->list[u].value
);
}
}
}
}
all_values |= hs->value;
if(!max_recursions) break;
hs->key |= hs->value;
hs->value = 0;
memset(hs->value_mask, 0, sizeof hs->value_mask);
}
hs->value = all_values;
return 1;
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
#ifdef HDDB_TEST
void test_db(hd_data_t *hd_data)
{
hddb_search_t hs = {};
int i;
hs.bus.id = 4;
hs.key |= (1 << he_bus_id) + (1 << he_serial);
hs.serial = "ser 0123";
i = hddb_search(hd_data, &hs, 0);
printf("%d, >%s<\n", i, hs.bus.name);
}
#endif
str_list_t *get_hddb_packages(hd_data_t *hd_data)
{
return NULL;
}
unsigned device_class(hd_data_t *hd_data, unsigned vendor, unsigned device)
{
hddb_search_t hs = {};
hs.vendor.id = vendor;
hs.device.id = device;
hs.key |= (1 << he_vendor_id) + (1 << he_device_id);
hddb_search(hd_data, &hs, 1);
if(
(hs.value & ((1 << he_baseclass_id) + (1 << he_subclass_id))) ==
((1 << he_baseclass_id) + (1 << he_subclass_id))
) {
return (hs.base_class.id << 8) + (hs.sub_class.id & 0xff);
}
return 0;
}
unsigned sub_device_class(hd_data_t *hd_data, unsigned vendor, unsigned device, unsigned sub_vendor, unsigned sub_device)
{
hddb_search_t hs = {};
hs.vendor.id = vendor;
hs.device.id = device;
hs.sub_vendor.id = sub_vendor;
hs.sub_device.id = sub_device;
hs.key |= (1 << he_vendor_id) + (1 << he_device_id) + (1 << he_subvendor_id) + (1 << he_subdevice_id);
hddb_search(hd_data, &hs, 1);
if(
(hs.value & ((1 << he_baseclass_id) + (1 << he_subclass_id))) ==
((1 << he_baseclass_id) + (1 << he_subclass_id))
) {
return (hs.base_class.id << 8) + (hs.sub_class.id & 0xff);
}
return 0;
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
void hddb_add_info(hd_data_t *hd_data, hd_t *hd)
{
hddb_search_t hs = {};
driver_info_t *new_driver_info = NULL;
#if WITH_ISDN
cdb_isdn_card *cic;
#endif
if(hd->tag.fixed) return;
hs.bus.id = hd->bus.id;
hs.key |= 1 << he_bus_id;
hs.base_class.id = hd->base_class.id;
hs.key |= 1 << he_baseclass_id;
hs.sub_class.id = hd->sub_class.id;
hs.key |= 1 << he_subclass_id;
hs.prog_if.id = hd->prog_if.id;
hs.key |= 1 << he_progif_id;
if(hd->vendor.id) {
hs.vendor.id = hd->vendor.id;
hs.key |= 1 << he_vendor_id;
}
if(hd->vendor.name) {
hs.vendor.name = hd->vendor.name;
hs.key |= 1 << he_vendor_name;
}
if(hd->device.id) {
hs.device.id = hd->device.id;
hs.key |= 1 << he_device_id;
}
if(hd->device.name) {
hs.device.name = hd->device.name;
hs.key |= 1 << he_device_name;
}
if(hd->sub_vendor.id) {
hs.sub_vendor.id = hd->sub_vendor.id;
hs.key |= 1 << he_subvendor_id;
}
if(hd->sub_device.id) {
hs.sub_device.id = hd->sub_device.id;
hs.key |= 1 << he_subdevice_id;
}
hs.revision.id = hd->revision.id;
hs.key |= 1 << he_rev_id;
if(hd->revision.name) {
hs.revision.name = hd->revision.name;
hs.key |= 1 << he_rev_name;
}
if(hd->serial) {
hs.serial = hd->serial;
hs.key |= 1 << he_serial;
}
if(hd->detail && hd->detail->ccw.data) {
hs.cu_model.id=hd->detail->ccw.data->cu_model;
hs.key |= 1 << he_detail_ccw_data_cu_model;
}
hddb_search(hd_data, &hs, 0);
if((hs.value & (1 << he_bus_id))) {
hd->bus.id = hs.bus.id;
}
if((hs.value & (1 << he_bus_name))) {
if(!hd->ref) free_mem(hd->bus.name);
hd->bus.name = new_str(hs.bus.name);
}
if((hs.value & (1 << he_baseclass_id))) {
hd->base_class.id = hs.base_class.id;
}
if((hs.value & (1 << he_baseclass_name))) {
if(!hd->ref) free_mem(hd->base_class.name);
hd->base_class.name = new_str(hs.base_class.name);
}
if((hs.value & (1 << he_subclass_id))) {
hd->sub_class.id = hs.sub_class.id;
}
if((hs.value & (1 << he_subclass_name))) {
if(!hd->ref) free_mem(hd->sub_class.name);
hd->sub_class.name = new_str(hs.sub_class.name);
}
if((hs.value & (1 << he_progif_id))) {
hd->prog_if.id = hs.prog_if.id;
}
if((hs.value & (1 << he_progif_name))) {
if(!hd->ref) free_mem(hd->prog_if.name);
hd->prog_if.name = new_str(hs.prog_if.name);
}
if((hs.value & (1 << he_requires))) {
if(!hd->ref) hd->requires = free_str_list(hd->requires);
hd->requires = hd_split('|', hs.requires);
}
if((hs.value & (1 << he_vendor_id))) {
hd->vendor.id = hs.vendor.id;
}
if((hs.value & (1 << he_vendor_name))) {
if(!hd->ref) free_mem(hd->vendor.name);
hd->vendor.name = new_str(hs.vendor.name);
}
if((hs.value & (1 << he_device_id))) {
hd->device.id = hs.device.id;
}
if((hs.value & (1 << he_device_name))) {
if(!hd->ref) free_mem(hd->device.name);
hd->device.name = new_str(hs.device.name);
}
if((hs.value & (1 << he_subvendor_id))) {
hd->sub_vendor.id = hs.sub_vendor.id;
}
if((hs.value & (1 << he_subvendor_name))) {
if(!hd->ref) free_mem(hd->sub_vendor.name);
hd->sub_vendor.name = new_str(hs.sub_vendor.name);
}
if((hs.value & (1 << he_subdevice_id))) {
hd->sub_device.id = hs.sub_device.id;
}
if((hs.value & (1 << he_subdevice_name))) {
if(!hd->ref) free_mem(hd->sub_device.name);
hd->sub_device.name = new_str(hs.sub_device.name);
}
if((hs.value & (1 << he_detail_ccw_data_cu_model))) {
if(hd->detail && hd->detail->ccw.data)
hd->detail->ccw.data->cu_model=hs.cu_model.id;
}
/* look for sub vendor again */
if(!hd->sub_vendor.name && hd->sub_vendor.id) {
hddb_search_t hs2 = {};
hs2.vendor.id = hd->sub_vendor.id;
hs2.key |= 1 << he_vendor_id;
hddb_search(hd_data, &hs2, 1);
if((hs2.value & (1 << he_vendor_name))) {
hd->sub_vendor.name = new_str(hs2.vendor.name);
}
}
/* look for compat device name */
if(
hd->compat_vendor.id &&
hd->compat_device.id &&
!hd->compat_vendor.name &&
!hd->compat_device.name
) {
hddb_search_t hs2 = {};
hs2.vendor.id = hd->compat_vendor.id;
hs2.key |= 1 << he_vendor_id;
hs2.device.id = hd->compat_device.id;
hs2.key |= 1 << he_device_id;
hddb_search(hd_data, &hs2, 1);
if((hs2.value & (1 << he_vendor_name))) {
hd->compat_vendor.name = new_str(hs2.vendor.name);
}
if((hs2.value & (1 << he_device_name))) {
hd->compat_device.name = new_str(hs2.device.name);
}
}
/* get package info for compat device id */
if(!hd->requires) {
hddb_search_t hs2 = {};
hs2.vendor.id = hd->compat_vendor.id;
hs2.key |= 1 << he_vendor_id;
hs2.device.id = hd->compat_device.id;
hs2.key |= 1 << he_device_id;
hddb_search(hd_data, &hs2, 1);
if((hs2.value & (1 << he_requires))) {
hd->requires = hd_split('|', hs2.requires);
}
}
/* get driver info */
#if WITH_ISDN
if((cic = get_isdn_info(hd))) {
new_driver_info = isdn_driver(hd_data, hd, cic);
if(!hd->model && cic->lname && *cic->lname) {
hd->model = new_str(cic->lname);
}
free_mem(cic);
}
if (!new_driver_info && ((cic = get_dsl_info(hd)))) {
new_driver_info = dsl_driver(hd_data, hd, cic);
if(!hd->model && cic->lname && *cic->lname) {
hd->model = new_str(cic->lname);
}
free_mem(cic);
}
#endif
if(!new_driver_info) {
new_driver_info = hd_pcidb(hd_data, hd_data->hddb_pci_hm, hd, new_driver_info);
}
if(!new_driver_info && (hs.value & (1 << he_driver))) {
new_driver_info = hddb_to_device_driver(hd_data, &hs);
}
if(!new_driver_info && (hd->compat_vendor.id || hd->compat_device.id)) {
memset(&hs, 0, sizeof hs);
if(hd->compat_vendor.id) {
hs.vendor.id = hd->compat_vendor.id;
hs.key |= 1 << he_vendor_id;
}
if(hd->compat_device.id) {
hs.device.id = hd->compat_device.id;
hs.key |= 1 << he_device_id;
}
hddb_search(hd_data, &hs, 1);
if((hs.value & (1 << he_driver))) {
new_driver_info = hddb_to_device_driver(hd_data, &hs);
}
}
if(!new_driver_info && hd->base_class.id == bc_keyboard) {
new_driver_info = kbd_driver(hd_data, hd);
}
if(!new_driver_info && hd->base_class.id == bc_monitor) {
new_driver_info = monitor_driver(hd_data, hd);
}
new_driver_info = hd_pcidb(hd_data, hd_data->hddb_pci, hd, new_driver_info);
if(new_driver_info) {
if(!hd->ref) {
hd->driver_info = free_driver_info(hd->driver_info);
}
hd->driver_info = new_driver_info;
expand_driver_info(hd_data, hd);
}
free_str_list(hs.driver);
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
driver_info_t *hddb_to_device_driver(hd_data_t *hd_data, hddb_search_t *hs)
{
char *s, *t, *t0;
driver_info_t *di = NULL, *di0 = NULL;
str_list_t *sl;
for(sl = hs->driver; sl; sl = sl->next) {
if(!sl->str || !*sl->str || sl->str[1] != '\t') return NULL;
if(di && (*sl->str == 'M' || *sl->str == 'X')) {
add_str_list(&di->any.hddb1, sl->str + 2);
continue;
}
if(di)
di = di->next = new_mem(sizeof *di);
else
di = di0 = new_mem(sizeof *di);
switch(*sl->str) {
case 'd':
di->any.type = di_display;
break;
case 'm':
di->module.modprobe = 1;
case 'i':
di->any.type = di_module;
break;
case 'p':
di->any.type = di_mouse;
break;
case 'x':
di->any.type = di_x11;
break;
default:
di->any.type = di_any;
}
s = new_str(sl->str + 2);
for(t0 = s; (t = strsep(&t0, "|")); ) {
add_str_list(&di->any.hddb0, t);
}
free_mem(s);
}
return di0;
}
driver_info_t *kbd_driver(hd_data_t *hd_data, hd_t *hd)
{
driver_info_t *di;
driver_info_kbd_t *ki;
int arch = hd_cpu_arch(hd_data);
unsigned u;
char *s1, *s2;
hd_t *hd_tmp;
usb_t *usb;
/* country codes
1 Arabic
2 Belgian
3 Canadian-Bilingual
4 Canadian-French
5 Czech Republic
6 Danish
7 Finnish
8 French
9 German
10 Greek
11 Hebrew
12 Hungary
13 International (ISO)
14 Italian
15 Japan (Katakana)
16 Korean
17 Latin American
18 Netherlands/Dutch
19 Norwegian
20 Persian (Farsi)
21 Poland
22 Portuguese
23 Russia
24 Slovakia
25 Spanish
26 Swedish
27 Swiss/French
28 Swiss/German
29 Switzerland
30 Taiwan
31 Turkish
32 UK
33 US
34 Yugoslavia
*/
static struct {
unsigned country;
char *layout;
char *keymap;
} country_code[] = {
{ 5, "cs", "cz-us-qwertz" },
{ 8, "fr", "fr-latin1" },
{ 9, "de", "de-latin1-nodeadkeys" },
{ 10, "gr", "gr" },
{ 14, "it", "it" },
{ 18, "nl", "us" },
{ 23, "ru", "ru1" },
{ 25, "es", "es" },
{ 32, "uk", "uk" },
{ 33, "us", "us" }
};
if(hd->sub_class.id == sc_keyboard_console) return NULL;
di = new_mem(sizeof *di);
di->kbd.type = di_kbd;
ki = &(di->kbd);
switch(arch) {
case arch_intel:
case arch_x86_64:
case arch_alpha:
ki->XkbRules = new_str("xfree86");
ki->XkbModel = new_str("pc104");
break;
case arch_ppc:
case arch_ppc64:
ki->XkbRules = new_str("xfree86");
ki->XkbModel = new_str("macintosh");
for(hd_tmp = hd_data->hd; hd_tmp; hd_tmp = hd_tmp->next) {
if(
hd_tmp->base_class.id == bc_internal &&
hd_tmp->sub_class.id == sc_int_cpu &&
hd_tmp->detail &&
hd_tmp->detail->type == hd_detail_cpu &&
hd_tmp->detail->cpu.data
) {
s1 = hd_tmp->detail->cpu.data->vend_name;
if(s1 && (strstr(s1, "CHRP ") == s1 || strstr(s1, "PReP ") == s1)) {
free_mem(ki->XkbModel);
ki->XkbModel = new_str("pc104");
}
}
}
break;
case arch_sparc:
case arch_sparc64:
if(hd->vendor.id == MAKE_ID(TAG_SPECIAL, 0x0202)) {
ki->XkbRules = new_str("sun");
u = ID_VALUE(hd->device.id);
if(u == 4) ki->XkbModel = new_str("type4");
if(u == 5) {
ki->XkbModel = new_str(ID_VALUE(hd->sub_device.id) == 2 ? "type5_euro" : "type5");
}
s1 = s2 = NULL;
switch(hd->prog_if.id) {
case 0: case 1: case 33: case 34: case 80: case 81:
default:
s1 = "us"; s2 = "sunkeymap";
break;
case 2:
s1 = "fr"; s2 = "sunt5-fr-latin1"; // fr_BE?
break;
case 3:
s1 = "ca";
break;
case 4: case 36: case 83:
s1 = "dk";
break;
case 5: case 37: case 84:
s1 = "de"; s2 = "sunt5-de-latin1";
break;
case 6: case 38: case 85:
s1 = "it";
break;
case 7: case 39: case 86:
s1 = "nl";
break;
case 8: case 40: case 87:
s1 = "no";
if(u == 4) s2 = "sunt4-no-latin1";
break;
case 9: case 41: case 88:
s1 = "pt";
break;
case 10: case 42: case 89:
s1 = "es";
s2 = u == 4 ? "sunt4-es" : "sunt5-es";
break;
case 11: case 43: case 90:
s1 = "se"; s2 = "sunt5-fi-latin1"; // se is swedish, not fi
break;
case 12: case 44: case 91:
s1 = "fr"; s2 = "sunt5-fr-latin1"; // fr_CH
break;
case 13: case 45: case 92:
s1 = "de"; s2 = "sunt5-de-latin1"; // de_CH
break;
case 14: case 46: case 93:
s1 = "gb"; s2 = "sunt5-uk";
break;
case 16: case 47: case 94:
s1 = "ko";
break;
case 17: case 48: case 95:
s1 = "tw";
break;
case 32: case 49: case 96:
s1 = "jp";
break;
case 50: case 97:
s1 = "fr"; s2 = "sunt5-fr-latin1"; // fr_CA
break;
case 51:
s1 = "hu";
break;
case 52:
s1 = "pl"; s2 = "sun-pl";
break;
case 53:
s1 = "cs";
break;
case 54:
s1 = "ru"; s2 = "sunt5-ru";
break;
}
ki->XkbLayout = new_str(s1);
ki->keymap = new_str(s2);
}
else {
ki->XkbRules = new_str("xfree86");
ki->XkbModel = new_str("pc104");
}
break;
default:
ki->XkbRules = new_str("xfree86");
}
if(
hd->bus.id == bus_usb &&
hd->detail &&
hd->detail->type == hd_detail_usb &&
(usb = hd->detail->usb.data) &&
usb->country
) {
for(u = 0; u < sizeof country_code / sizeof *country_code; u++) {
if(country_code[u].country == usb->country) {
if(!ki->XkbLayout) ki->XkbLayout = new_str(country_code[u].layout);
if(!ki->keymap) ki->keymap = new_str(country_code[u].keymap);
break;
}
}
}
return di;
}
driver_info_t *monitor_driver(hd_data_t *hd_data, hd_t *hd)
{
driver_info_t *di = NULL;
driver_info_display_t *ddi;
monitor_info_t *mi;
hd_res_t *res;
unsigned width = 640, height = 480;
if(
hd->detail &&
hd->detail->type == hd_detail_monitor &&
(mi = hd->detail->monitor.data) &&
mi->min_hsync
) {
di = new_mem(sizeof *di);
di->display.type = di_display;
ddi = &(di->display);
ddi->min_vsync = mi->min_vsync;
ddi->max_vsync = mi->max_vsync;
ddi->min_hsync = mi->min_hsync;
ddi->max_hsync = mi->max_hsync;
for(res = hd->res; res; res = res->next) {
if(res->any.type == res_monitor) {
if(res->monitor.width * res->monitor.height > width * height ) {
width = res->monitor.width;
height = res->monitor.height;
}
}
}
ddi->width = width;
ddi->height = height;
}
return di;
}
#if WITH_ISDN
#if 0
int chk_free_biosmem(hd_data_t *hd_data, unsigned addr, unsigned len)
{
unsigned u;
unsigned char c;
addr -= hd_data->bios_rom.start;
if(
!hd_data->bios_rom.data ||
addr >= hd_data->bios_rom.size ||
addr + len > hd_data->bios_rom.size
) return 0;
for(c = 0xff, u = addr; u < addr + len; u++) {
c &= hd_data->bios_rom.data[u];
}
return c == 0xff ? 1 : 0;
}
isdn_parm_t *new_isdn_parm(isdn_parm_t **ip)
{
while(*ip) ip = &(*ip)->next;
return *ip = new_mem(sizeof **ip);
}
#endif
driver_info_t *isdn_driver(hd_data_t *hd_data, hd_t *hd, cdb_isdn_card *cic)
{
driver_info_t *di0, *di;
cdb_isdn_vario *civ;
/* hd_res_t *res;
uint64_t i, irqs, irqs2;
int irq_val, pnr;
*/
int drv;
str_list_t *sl, *sl0;
if(!cic) return NULL;
di0 = new_mem(sizeof *di0);
drv = cic->vario;
di = NULL;
while((civ = hd_cdbisdn_get_vario(drv))) {
drv = civ->next_vario;
if (di) {
di->next = new_mem(sizeof *di);
di = di->next;
} else {
di = di0;
}
di->isdn.type = di_isdn;
di->isdn.i4l_type = civ->typ;
di->isdn.i4l_subtype = civ->subtyp;
di->isdn.i4l_name = new_str(cic->lname);
if(civ->need_pkg && *civ->need_pkg) {
sl0 = hd_split(',', (char *) civ->need_pkg);
for(sl = sl0; sl; sl = sl->next) {
if(!search_str_list(hd->requires, sl->str)) {
add_str_list(&hd->requires, sl->str);
}
}
free_str_list(sl0);
}
if(hd->bus.id == bus_pci) continue;
#if 0
pnr = 1;
civ = hd_cdbisdn_get_vario(cic->vario);
if (!civ) continue;
if (civ->irq && civ->irq[0]) {
ip = new_isdn_parm(&di->isdn.params);
ip->name = new_str("IRQ");
ip->type = CDBISDN_P_IRQ;
}
if (civ->io && civ->io[0]) {
ip = new_isdn_parm(&di->isdn.params);
ip->name = new_str("IO");
ip->type = CDBISDN_P_IO;
}
if (civ->membase && civ->membase[0]) {
ip = new_isdn_parm(&di->isdn.params);
ip->name = new_str("MEMBASE");
ip->type = CDBISDN_P_MEM;
}
while((ipi = hd_ihw_get_parameter(ici->handle, pnr++))) {
ip = new_isdn_parm(&di->isdn.params);
ip->name = new_str(ipi->name);
ip->type = ipi->type & P_TYPE_MASK;
ip->flags = ipi->flags & P_PROPERTY_MASK;
ip->def_value = ipi->def_value;
if(ipi->list) ip->alt_values = *ipi->list;
ip->alt_value = new_mem(ip->alt_values * sizeof *ip->alt_value);
for(i = 0; i < ip->alt_values; i++) {
ip->alt_value[i] = ipi->list[i + 1];
}
ip->valid = 1;
if((ip->flags & P_SOFTSET)) {
switch(ip->type) {
case P_IRQ:
update_irq_usage(hd_data);
irqs = 0;
for(i = 0; i < ip->alt_values; i++) {
irqs |= 1ull << ip->alt_value[i];
}
irqs &= ~(hd_data->used_irqs | hd_data->assigned_irqs);
#ifdef __i386__
irqs &= 0xffffull; /* max. 16 on intel */
/*
* The point is, that this is relevant for isa boards only
* and those have irq values < 16 anyway. So it really
* doesn't matter if we mask with 0xffff or not.
*/
#endif
if(!irqs) {
ip->conflict = 1;
ip->valid = 0;
}
else {
irqs2 = irqs & ~0xc018ull;
/* see if we can avoid irqs 3,4,14,15 */
if(irqs2) irqs = irqs2;
irq_val = -1;
/* try default value first */
if(ip->def_value && (irqs & (1ull << ip->def_value))) {
irq_val = ip->def_value;
}
else {
for(i = 0; i < 64 && irqs; i++, irqs >>= 1) {
if((irqs & 1)) irq_val = i;
}
}
if(irq_val >= 0) {
ip->value = irq_val;
hd_data->assigned_irqs |= 1ull << irq_val;
}
else {
ip->valid = 0;
}
}
break;
case P_MEM:
if(!hd_data->bios_rom.data) {
if(ip->def_value) {
ip->value = ip->def_value;
}
}
else {
/* ###### 0x2000 is just guessing -> should be provided by libihw */
if(ip->def_value && chk_free_biosmem(hd_data, ip->def_value, 0x2000)) {
ip->value = ip->def_value;
}
else {
for(i = ip->alt_values - 1; i >= 0; i--) {
if(chk_free_biosmem(hd_data, ip->alt_value[i], 0x2000)) {
ip->value = ip->alt_value[i];
break;
}
}
}
}
if(!ip->value) ip->conflict = 1;
break;
default:
ip->valid = 0;
}
}
else if((ip->flags & P_DEFINE)) {
res = NULL;
switch(ip->type) {
case P_IRQ:
res = get_res(hd, res_irq, 0);
if(res) ip->value = res->irq.base;
break;
case P_MEM:
res = get_res(hd, res_mem, 0);
if(res) ip->value = res->mem.base;
break;
case P_IO:
res = get_res(hd, res_io, 0);
if(res) ip->value = res->io.base;
break;
case P_IO0:
case P_IO1:
case P_IO2:
res = get_res(hd, res_io, ip->type - P_IO0);
if(res) ip->value = res->io.base;
break;
// ##### might break for 64bit pci entries?
case P_BASE0:
case P_BASE1:
case P_BASE2:
case P_BASE3:
case P_BASE4:
case P_BASE5:
res = get_res(hd, res_mem, ip->type - P_BASE0);
if(res) ip->value = res->mem.base;
break;
default:
ip->valid = 0;
}
if(!res) ip->valid = 0;
}
}
#endif
}
if(!di) di0 = free_mem(di0);
return di0;
}
driver_info_t *dsl_driver(hd_data_t *hd_data, hd_t *hd, cdb_isdn_card *cic)
{
driver_info_t *di0, *di;
cdb_isdn_vario *civ;
int drv;
str_list_t *sl, *sl0;
if(!cic) return NULL;
di0 = new_mem(sizeof *di0);
drv = cic->vario;
di = NULL;
while((civ = hd_cdbisdn_get_vario(drv))) {
drv = civ->next_vario;
if (di) {
di->next = new_mem(sizeof *di);
di = di->next;
} else {
di = di0;
}
di->dsl.type = di_dsl;
if(civ->interface && *civ->interface) {
if (!strcmp(civ->interface, "CAPI20")) {
di->dsl.mode = new_str("capiadsl");
if(civ->mod_name && *civ->mod_name)
di->dsl.name = new_str(civ->mod_name);
else
di->dsl.name = new_str("unknown");
} else if (!strcmp(civ->interface, "pppoe")) {
di->dsl.mode = new_str("pppoe");
if(civ->mod_name && *civ->mod_name)
di->dsl.name = new_str(civ->mod_name);
else
di->dsl.name = new_str("none");
} else {
di->dsl.mode = new_str("unknown");
di->dsl.name = new_str("unknown");
}
} else {
di->dsl.mode = new_str("unknown");
di->dsl.name = new_str("unknown");
}
if(civ->need_pkg && *civ->need_pkg) {
sl0 = hd_split(',', (char *) civ->need_pkg);
for(sl = sl0; sl; sl = sl->next) {
if(!search_str_list(hd->requires, sl->str)) {
add_str_list(&hd->requires, sl->str);
}
}
free_str_list(sl0);
}
if(hd->bus.id == bus_pci) continue;
}
if(!di) di0 = free_mem(di0);
return di0;
}
#endif /* WITH_ISDN */
hd_res_t *get_res(hd_t *hd, enum resource_types t, unsigned index)
{
hd_res_t *res;
for(res = hd->res; res; res = res->next) {
if(res->any.type == t) {
if(!index) return res;
index--;
}
}
return NULL;
}
driver_info_t *reorder_x11(driver_info_t *di0, char *info)
{
driver_info_t *di, *di_new, **di_list;
int i, dis, found;
for(dis = 0, di = di0; di; di = di->next) dis++;
di_list = new_mem(dis * sizeof *di_list);
for(i = 0, di = di0; di; di = di->next) {
di_list[i++] = di;
}
di = di_new = NULL;
for(i = found = 0; i < dis; i++) {
if(
!strcmp(di_list[i]->x11.xf86_ver, info) ||
!strcmp(di_list[i]->x11.server, info)
) {
found = 1;
if(di) {
di = di->next = di_list[i];
}
else {
di = di_new = di_list[i];
}
di->next = NULL;
di_list[i] = NULL;
}
}
for(i = 0; i < dis; i++) {
if(di_list[i]) {
if(di) {
di = di->next = di_list[i];
}
else {
di = di_new = di_list[i];
}
di->next = NULL;
di_list[i] = NULL;
}
}
free_mem(di_list);
if(!found && strlen(info) > 1) {
free_driver_info(di_new);
di_new = new_mem(sizeof *di_new);
di_new->any.type = di_x11;
di_new->x11.server = new_str(info);
di_new->x11.xf86_ver = new_str(*info >= 'A' && *info <= 'Z' ? "3" : "4");
}
return di_new;
}
void expand_driver_info(hd_data_t *hd_data, hd_t *hd)
{
int i;
unsigned u1, u2;
char *s, *t, *t0;
driver_info_t *di;
str_list_t *sl, *sl1, *sl2, *cmd;
if(!hd || !hd->driver_info) return;
for(di = hd->driver_info; di; di = di->next) {
switch(di->any.type) {
case di_display:
for(i = 0, sl = di->display.hddb0; sl; sl = sl->next, i++) {
if(i == 0 && sscanf(sl->str, "%ux%u", &u1, &u2) == 2) {
di->display.width = u1;
di->display.height = u2;
}
else if(i == 1 && sscanf(sl->str, "%u-%u", &u1, &u2) == 2) {
di->display.min_vsync = u1;
di->display.max_vsync = u2;
}
else if(i == 2 && sscanf(sl->str, "%u-%u", &u1, &u2) == 2) {
di->display.min_hsync = u1;
di->display.max_hsync = u2;
}
else if(i == 3 && sscanf(sl->str, "%u", &u1) == 1) {
di->display.bandwidth = u1;
}
}
break;
case di_module:
for(di->module.active = 1, sl = di->module.hddb0; sl; sl = sl->next) {
t0 = s = new_str(sl->str);
t = strsep(&t0, " ");
add_str_list(&di->module.names, t);
di->module.active &= (
hd_module_is_active(hd_data, t) |
(search_str_list(hd->drivers, t) ? 1 : 0)
);
if(t0) {
add_str_list(&di->module.mod_args, module_cmd(hd, t0));
}
else {
add_str_list(&di->module.mod_args, NULL);
}
free_mem(s);
}
for(sl = di->module.hddb1; sl; sl = sl->next) {
s = module_cmd(hd, sl->str);
if(s) str_printf(&di->module.conf, -1, "%s\n", s);
}
break;
case di_mouse:
di->mouse.buttons = di->mouse.wheels = -1;
u1 = 0;
if(
hd->compat_vendor.id == MAKE_ID(TAG_SPECIAL, 0x0210) &&
ID_TAG(hd->compat_device.id) == TAG_SPECIAL
) {
u1 = hd->compat_device.id;
}
if(
hd->vendor.id == MAKE_ID(TAG_SPECIAL, 0x0210) &&
ID_TAG(hd->device.id) == TAG_SPECIAL
) {
u1 = hd->device.id;
}
if(u1) {
di->mouse.wheels = ID_VALUE(u1) >> 4;
di->mouse.buttons = ID_VALUE(u1) & 15;
}
for(i = 0, sl = di->mouse.hddb0; sl; sl = sl->next, i++) {
if(i == 0) {
di->mouse.xf86 = new_str(sl->str);
}
else if(i == 1) {
di->mouse.gpm = new_str(sl->str);
}
else if(i == 2 && *sl->str) {
di->mouse.buttons = strtol(sl->str, NULL, 10);
}
else if(i == 3 && *sl->str) {
di->mouse.wheels = strtol(sl->str, NULL, 10);
}
}
break;
case di_x11:
for(i = 0, sl = di->x11.hddb0; sl; sl = sl->next, i++) {
if(i == 0) {
di->x11.xf86_ver = new_str(sl->str);
}
else if(i == 1) {
di->x11.server = new_str(sl->str);
}
else if(i == 2) {
if(!strcmp(sl->str, "3d")) di->x11.x3d = 1;
}
#if 0
else if(i == 3) {
s = new_str(sl->str);
for(t0 = s; (t = strsep(&t0, ",")); ) {
add_str_list(&di->x11.packages, t);
}
free_mem(s);
}
#endif
else if(i == 4) {
s = new_str(sl->str);
for(t0 = s; (t = strsep(&t0, ",")); ) {
add_str_list(&di->x11.extensions, t);
}
free_mem(s);
}
else if(i == 5) {
s = new_str(sl->str);
for(t0 = s; (t = strsep(&t0, ",")); ) {
add_str_list(&di->x11.options, t);
}
free_mem(s);
}
else if(i == 6) {
for(sl2 = sl1 = hd_split(',', sl->str); sl2; sl2 = sl2->next) {
u1 = strtoul(sl2->str, NULL, 0);
switch(u1) {
case 8:
di->x11.colors.c8 = 1;
di->x11.colors.all |= (1 << 0);
break;
case 15:
di->x11.colors.c15 = 1;
di->x11.colors.all |= (1 << 1);
break;
case 16:
di->x11.colors.c16 = 1;
di->x11.colors.all |= (1 << 2);
break;
case 24:
di->x11.colors.c24 = 1;
di->x11.colors.all |= (1 << 3);
break;
case 32:
di->x11.colors.c32 = 1;
di->x11.colors.all |= (1 << 4);
break;
}
}
free_str_list(sl1);
}
else if(i == 7) {
di->x11.dacspeed = strtol(sl->str, NULL, 10);
}
else if(i == 8) {
di->x11.script = new_str(sl->str);
}
}
for(i = 0, sl = di->x11.hddb1; sl; sl = sl->next, i++) {
add_str_list(&di->x11.raw, sl->str);
}
#if 0
// ######## for compatibility
for(sl = hd->requires; sl; sl = sl->next) {
add_str_list(&di->x11.packages, sl->str);
}
#endif
break;
default:
break;
}
}
di = hd->driver_info;
if(di && di->any.type == di_x11 && !hd_probe_feature(hd_data, pr_ignx11)) {
cmd = get_cmdline(hd_data, "x11");
if(cmd && *cmd->str) {
hd->driver_info = reorder_x11(di, cmd->str);
}
free_str_list(cmd);
}
}
char *module_cmd(hd_t *hd, char *cmd)
{
static char buf[256];
char *s = buf;
int idx, ofs;
hd_res_t *res;
// skip inactive PnP cards
// ##### Really necessary here?
if(
hd->is.isapnp &&
hd->detail &&
hd->detail->isapnp.data &&
!(hd->detail->isapnp.data->flags & (1 << isapnp_flag_act))
) return NULL;
*buf = 0;
while(*cmd) {
if(sscanf(cmd, "<io%u>%n", &idx, &ofs) >= 1) {
if((res = get_res(hd, res_io, idx))) {
s += sprintf(s, "0x%02"PRIx64, res->io.base);
cmd += ofs;
}
else {
return NULL;
}
}
else if(sscanf(cmd, "<irq%u>%n", &idx, &ofs) >= 1) {
if((res = get_res(hd, res_irq, idx))) {
s += sprintf(s, "%u", res->irq.base);
cmd += ofs;
}
else {
return NULL;
}
}
else {
*s++ = *cmd++;
}
if(s - buf > (int) sizeof buf - 20) return NULL;
}
*s = 0;
return buf;
}
/* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
char *hid_tag_name(int tag)
{
return (unsigned) tag < sizeof hid_tag_names / sizeof *hid_tag_names ? hid_tag_names[tag] : "";
}
char *hid_tag_name2(int tag)
{
return (unsigned) tag < sizeof hid_tag_names2 / sizeof *hid_tag_names2 ? hid_tag_names2[tag] : "";
}