mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-15 21:30:43 +00:00
a9d1b24d91
This is the start of adding hotplug-like support for i2c devices. Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
466 lines
14 KiB
C
466 lines
14 KiB
C
/* Simple code to turn various tables in an ELF file into alias definitions.
|
|
* This deals with kernel datastructures where they should be
|
|
* dealt with: in the kernel source.
|
|
*
|
|
* Copyright 2002-2003 Rusty Russell, IBM Corporation
|
|
* 2003 Kai Germaschewski
|
|
*
|
|
*
|
|
* This software may be used and distributed according to the terms
|
|
* of the GNU General Public License, incorporated herein by reference.
|
|
*/
|
|
|
|
#include "modpost.h"
|
|
|
|
/* We use the ELF typedefs for kernel_ulong_t but bite the bullet and
|
|
* use either stdint.h or inttypes.h for the rest. */
|
|
#if KERNEL_ELFCLASS == ELFCLASS32
|
|
typedef Elf32_Addr kernel_ulong_t;
|
|
#else
|
|
typedef Elf64_Addr kernel_ulong_t;
|
|
#endif
|
|
#ifdef __sun__
|
|
#include <inttypes.h>
|
|
#else
|
|
#include <stdint.h>
|
|
#endif
|
|
|
|
#include <ctype.h>
|
|
|
|
typedef uint32_t __u32;
|
|
typedef uint16_t __u16;
|
|
typedef unsigned char __u8;
|
|
|
|
/* Big exception to the "don't include kernel headers into userspace, which
|
|
* even potentially has different endianness and word sizes, since
|
|
* we handle those differences explicitly below */
|
|
#include "../../include/linux/mod_devicetable.h"
|
|
|
|
#define ADD(str, sep, cond, field) \
|
|
do { \
|
|
strcat(str, sep); \
|
|
if (cond) \
|
|
sprintf(str + strlen(str), \
|
|
sizeof(field) == 1 ? "%02X" : \
|
|
sizeof(field) == 2 ? "%04X" : \
|
|
sizeof(field) == 4 ? "%08X" : "", \
|
|
field); \
|
|
else \
|
|
sprintf(str + strlen(str), "*"); \
|
|
} while(0)
|
|
|
|
/* USB is special because the bcdDevice can be matched against a numeric range */
|
|
/* Looks like "usb:vNpNdNdcNdscNdpNicNiscNipN" */
|
|
static void do_usb_entry(struct usb_device_id *id,
|
|
unsigned int bcdDevice_initial, int bcdDevice_initial_digits,
|
|
unsigned char range_lo, unsigned char range_hi,
|
|
struct module *mod)
|
|
{
|
|
char alias[500];
|
|
strcpy(alias, "usb:");
|
|
ADD(alias, "v", id->match_flags&USB_DEVICE_ID_MATCH_VENDOR,
|
|
id->idVendor);
|
|
ADD(alias, "p", id->match_flags&USB_DEVICE_ID_MATCH_PRODUCT,
|
|
id->idProduct);
|
|
|
|
strcat(alias, "d");
|
|
if (bcdDevice_initial_digits)
|
|
sprintf(alias + strlen(alias), "%0*X",
|
|
bcdDevice_initial_digits, bcdDevice_initial);
|
|
if (range_lo == range_hi)
|
|
sprintf(alias + strlen(alias), "%u", range_lo);
|
|
else if (range_lo > 0 || range_hi < 9)
|
|
sprintf(alias + strlen(alias), "[%u-%u]", range_lo, range_hi);
|
|
if (bcdDevice_initial_digits < (sizeof(id->bcdDevice_lo) * 2 - 1))
|
|
strcat(alias, "*");
|
|
|
|
ADD(alias, "dc", id->match_flags&USB_DEVICE_ID_MATCH_DEV_CLASS,
|
|
id->bDeviceClass);
|
|
ADD(alias, "dsc",
|
|
id->match_flags&USB_DEVICE_ID_MATCH_DEV_SUBCLASS,
|
|
id->bDeviceSubClass);
|
|
ADD(alias, "dp",
|
|
id->match_flags&USB_DEVICE_ID_MATCH_DEV_PROTOCOL,
|
|
id->bDeviceProtocol);
|
|
ADD(alias, "ic",
|
|
id->match_flags&USB_DEVICE_ID_MATCH_INT_CLASS,
|
|
id->bInterfaceClass);
|
|
ADD(alias, "isc",
|
|
id->match_flags&USB_DEVICE_ID_MATCH_INT_SUBCLASS,
|
|
id->bInterfaceSubClass);
|
|
ADD(alias, "ip",
|
|
id->match_flags&USB_DEVICE_ID_MATCH_INT_PROTOCOL,
|
|
id->bInterfaceProtocol);
|
|
|
|
/* Always end in a wildcard, for future extension */
|
|
if (alias[strlen(alias)-1] != '*')
|
|
strcat(alias, "*");
|
|
buf_printf(&mod->dev_table_buf,
|
|
"MODULE_ALIAS(\"%s\");\n", alias);
|
|
}
|
|
|
|
static void do_usb_entry_multi(struct usb_device_id *id, struct module *mod)
|
|
{
|
|
unsigned int devlo, devhi;
|
|
unsigned char chi, clo;
|
|
int ndigits;
|
|
|
|
id->match_flags = TO_NATIVE(id->match_flags);
|
|
id->idVendor = TO_NATIVE(id->idVendor);
|
|
id->idProduct = TO_NATIVE(id->idProduct);
|
|
|
|
devlo = id->match_flags & USB_DEVICE_ID_MATCH_DEV_LO ?
|
|
TO_NATIVE(id->bcdDevice_lo) : 0x0U;
|
|
devhi = id->match_flags & USB_DEVICE_ID_MATCH_DEV_HI ?
|
|
TO_NATIVE(id->bcdDevice_hi) : ~0x0U;
|
|
|
|
/*
|
|
* Some modules (visor) have empty slots as placeholder for
|
|
* run-time specification that results in catch-all alias
|
|
*/
|
|
if (!(id->idVendor | id->bDeviceClass | id->bInterfaceClass))
|
|
return;
|
|
|
|
/* Convert numeric bcdDevice range into fnmatch-able pattern(s) */
|
|
for (ndigits = sizeof(id->bcdDevice_lo) * 2 - 1; devlo <= devhi; ndigits--) {
|
|
clo = devlo & 0xf;
|
|
chi = devhi & 0xf;
|
|
if (chi > 9) /* it's bcd not hex */
|
|
chi = 9;
|
|
devlo >>= 4;
|
|
devhi >>= 4;
|
|
|
|
if (devlo == devhi || !ndigits) {
|
|
do_usb_entry(id, devlo, ndigits, clo, chi, mod);
|
|
break;
|
|
}
|
|
|
|
if (clo > 0)
|
|
do_usb_entry(id, devlo++, ndigits, clo, 9, mod);
|
|
|
|
if (chi < 9)
|
|
do_usb_entry(id, devhi--, ndigits, 0, chi, mod);
|
|
}
|
|
}
|
|
|
|
static void do_usb_table(void *symval, unsigned long size,
|
|
struct module *mod)
|
|
{
|
|
unsigned int i;
|
|
const unsigned long id_size = sizeof(struct usb_device_id);
|
|
|
|
if (size % id_size || size < id_size) {
|
|
fprintf(stderr, "*** Warning: %s ids %lu bad size "
|
|
"(each on %lu)\n", mod->name, size, id_size);
|
|
}
|
|
/* Leave last one: it's the terminator. */
|
|
size -= id_size;
|
|
|
|
for (i = 0; i < size; i += id_size)
|
|
do_usb_entry_multi(symval + i, mod);
|
|
}
|
|
|
|
/* Looks like: ieee1394:venNmoNspNverN */
|
|
static int do_ieee1394_entry(const char *filename,
|
|
struct ieee1394_device_id *id, char *alias)
|
|
{
|
|
id->match_flags = TO_NATIVE(id->match_flags);
|
|
id->vendor_id = TO_NATIVE(id->vendor_id);
|
|
id->model_id = TO_NATIVE(id->model_id);
|
|
id->specifier_id = TO_NATIVE(id->specifier_id);
|
|
id->version = TO_NATIVE(id->version);
|
|
|
|
strcpy(alias, "ieee1394:");
|
|
ADD(alias, "ven", id->match_flags & IEEE1394_MATCH_VENDOR_ID,
|
|
id->vendor_id);
|
|
ADD(alias, "mo", id->match_flags & IEEE1394_MATCH_MODEL_ID,
|
|
id->model_id);
|
|
ADD(alias, "sp", id->match_flags & IEEE1394_MATCH_SPECIFIER_ID,
|
|
id->specifier_id);
|
|
ADD(alias, "ver", id->match_flags & IEEE1394_MATCH_VERSION,
|
|
id->version);
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Looks like: pci:vNdNsvNsdNbcNscNiN. */
|
|
static int do_pci_entry(const char *filename,
|
|
struct pci_device_id *id, char *alias)
|
|
{
|
|
/* Class field can be divided into these three. */
|
|
unsigned char baseclass, subclass, interface,
|
|
baseclass_mask, subclass_mask, interface_mask;
|
|
|
|
id->vendor = TO_NATIVE(id->vendor);
|
|
id->device = TO_NATIVE(id->device);
|
|
id->subvendor = TO_NATIVE(id->subvendor);
|
|
id->subdevice = TO_NATIVE(id->subdevice);
|
|
id->class = TO_NATIVE(id->class);
|
|
id->class_mask = TO_NATIVE(id->class_mask);
|
|
|
|
strcpy(alias, "pci:");
|
|
ADD(alias, "v", id->vendor != PCI_ANY_ID, id->vendor);
|
|
ADD(alias, "d", id->device != PCI_ANY_ID, id->device);
|
|
ADD(alias, "sv", id->subvendor != PCI_ANY_ID, id->subvendor);
|
|
ADD(alias, "sd", id->subdevice != PCI_ANY_ID, id->subdevice);
|
|
|
|
baseclass = (id->class) >> 16;
|
|
baseclass_mask = (id->class_mask) >> 16;
|
|
subclass = (id->class) >> 8;
|
|
subclass_mask = (id->class_mask) >> 8;
|
|
interface = id->class;
|
|
interface_mask = id->class_mask;
|
|
|
|
if ((baseclass_mask != 0 && baseclass_mask != 0xFF)
|
|
|| (subclass_mask != 0 && subclass_mask != 0xFF)
|
|
|| (interface_mask != 0 && interface_mask != 0xFF)) {
|
|
fprintf(stderr,
|
|
"*** Warning: Can't handle masks in %s:%04X\n",
|
|
filename, id->class_mask);
|
|
return 0;
|
|
}
|
|
|
|
ADD(alias, "bc", baseclass_mask == 0xFF, baseclass);
|
|
ADD(alias, "sc", subclass_mask == 0xFF, subclass);
|
|
ADD(alias, "i", interface_mask == 0xFF, interface);
|
|
return 1;
|
|
}
|
|
|
|
/* looks like: "ccw:tNmNdtNdmN" */
|
|
static int do_ccw_entry(const char *filename,
|
|
struct ccw_device_id *id, char *alias)
|
|
{
|
|
id->match_flags = TO_NATIVE(id->match_flags);
|
|
id->cu_type = TO_NATIVE(id->cu_type);
|
|
id->cu_model = TO_NATIVE(id->cu_model);
|
|
id->dev_type = TO_NATIVE(id->dev_type);
|
|
id->dev_model = TO_NATIVE(id->dev_model);
|
|
|
|
strcpy(alias, "ccw:");
|
|
ADD(alias, "t", id->match_flags&CCW_DEVICE_ID_MATCH_CU_TYPE,
|
|
id->cu_type);
|
|
ADD(alias, "m", id->match_flags&CCW_DEVICE_ID_MATCH_CU_MODEL,
|
|
id->cu_model);
|
|
ADD(alias, "dt", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE,
|
|
id->dev_type);
|
|
ADD(alias, "dm", id->match_flags&CCW_DEVICE_ID_MATCH_DEVICE_TYPE,
|
|
id->dev_model);
|
|
return 1;
|
|
}
|
|
|
|
/* Looks like: "serio:tyNprNidNexN" */
|
|
static int do_serio_entry(const char *filename,
|
|
struct serio_device_id *id, char *alias)
|
|
{
|
|
id->type = TO_NATIVE(id->type);
|
|
id->proto = TO_NATIVE(id->proto);
|
|
id->id = TO_NATIVE(id->id);
|
|
id->extra = TO_NATIVE(id->extra);
|
|
|
|
strcpy(alias, "serio:");
|
|
ADD(alias, "ty", id->type != SERIO_ANY, id->type);
|
|
ADD(alias, "pr", id->proto != SERIO_ANY, id->proto);
|
|
ADD(alias, "id", id->id != SERIO_ANY, id->id);
|
|
ADD(alias, "ex", id->extra != SERIO_ANY, id->extra);
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* looks like: "pnp:dD" */
|
|
static int do_pnp_entry(const char *filename,
|
|
struct pnp_device_id *id, char *alias)
|
|
{
|
|
sprintf(alias, "pnp:d%s", id->id);
|
|
return 1;
|
|
}
|
|
|
|
/* looks like: "pnp:cCdD..." */
|
|
static int do_pnp_card_entry(const char *filename,
|
|
struct pnp_card_device_id *id, char *alias)
|
|
{
|
|
int i;
|
|
|
|
sprintf(alias, "pnp:c%s", id->id);
|
|
for (i = 0; i < PNP_MAX_DEVICES; i++) {
|
|
if (! *id->devs[i].id)
|
|
break;
|
|
sprintf(alias + strlen(alias), "d%s", id->devs[i].id);
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
/* Looks like: pcmcia:mNcNfNfnNpfnNvaNvbNvcNvdN. */
|
|
static int do_pcmcia_entry(const char *filename,
|
|
struct pcmcia_device_id *id, char *alias)
|
|
{
|
|
unsigned int i;
|
|
|
|
id->match_flags = TO_NATIVE(id->match_flags);
|
|
id->manf_id = TO_NATIVE(id->manf_id);
|
|
id->card_id = TO_NATIVE(id->card_id);
|
|
id->func_id = TO_NATIVE(id->func_id);
|
|
id->function = TO_NATIVE(id->function);
|
|
id->device_no = TO_NATIVE(id->device_no);
|
|
|
|
for (i=0; i<4; i++) {
|
|
id->prod_id_hash[i] = TO_NATIVE(id->prod_id_hash[i]);
|
|
}
|
|
|
|
strcpy(alias, "pcmcia:");
|
|
ADD(alias, "m", id->match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID,
|
|
id->manf_id);
|
|
ADD(alias, "c", id->match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID,
|
|
id->card_id);
|
|
ADD(alias, "f", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID,
|
|
id->func_id);
|
|
ADD(alias, "fn", id->match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION,
|
|
id->function);
|
|
ADD(alias, "pfn", id->match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO,
|
|
id->device_no);
|
|
ADD(alias, "pa", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1, id->prod_id_hash[0]);
|
|
ADD(alias, "pb", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2, id->prod_id_hash[1]);
|
|
ADD(alias, "pc", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3, id->prod_id_hash[2]);
|
|
ADD(alias, "pd", id->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4, id->prod_id_hash[3]);
|
|
|
|
return 1;
|
|
}
|
|
|
|
|
|
|
|
static int do_of_entry (const char *filename, struct of_device_id *of, char *alias)
|
|
{
|
|
char *tmp;
|
|
sprintf (alias, "of:N%sT%sC%s",
|
|
of->name[0] ? of->name : "*",
|
|
of->type[0] ? of->type : "*",
|
|
of->compatible[0] ? of->compatible : "*");
|
|
|
|
/* Replace all whitespace with underscores */
|
|
for (tmp = alias; tmp && *tmp; tmp++)
|
|
if (isspace (*tmp))
|
|
*tmp = '_';
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int do_vio_entry(const char *filename, struct vio_device_id *vio,
|
|
char *alias)
|
|
{
|
|
char *tmp;
|
|
|
|
sprintf(alias, "vio:T%sS%s", vio->type[0] ? vio->type : "*",
|
|
vio->compat[0] ? vio->compat : "*");
|
|
|
|
/* Replace all whitespace with underscores */
|
|
for (tmp = alias; tmp && *tmp; tmp++)
|
|
if (isspace (*tmp))
|
|
*tmp = '_';
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int do_i2c_entry(const char *filename, struct i2c_device_id *i2c, char *alias)
|
|
{
|
|
strcpy(alias, "i2c:");
|
|
ADD(alias, "id", 1, i2c->id);
|
|
return 1;
|
|
}
|
|
|
|
/* Ignore any prefix, eg. v850 prepends _ */
|
|
static inline int sym_is(const char *symbol, const char *name)
|
|
{
|
|
const char *match;
|
|
|
|
match = strstr(symbol, name);
|
|
if (!match)
|
|
return 0;
|
|
return match[strlen(symbol)] == '\0';
|
|
}
|
|
|
|
static void do_table(void *symval, unsigned long size,
|
|
unsigned long id_size,
|
|
void *function,
|
|
struct module *mod)
|
|
{
|
|
unsigned int i;
|
|
char alias[500];
|
|
int (*do_entry)(const char *, void *entry, char *alias) = function;
|
|
|
|
if (size % id_size || size < id_size) {
|
|
fprintf(stderr, "*** Warning: %s ids %lu bad size "
|
|
"(each on %lu)\n", mod->name, size, id_size);
|
|
}
|
|
/* Leave last one: it's the terminator. */
|
|
size -= id_size;
|
|
|
|
for (i = 0; i < size; i += id_size) {
|
|
if (do_entry(mod->name, symval+i, alias)) {
|
|
/* Always end in a wildcard, for future extension */
|
|
if (alias[strlen(alias)-1] != '*')
|
|
strcat(alias, "*");
|
|
buf_printf(&mod->dev_table_buf,
|
|
"MODULE_ALIAS(\"%s\");\n", alias);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Create MODULE_ALIAS() statements.
|
|
* At this time, we cannot write the actual output C source yet,
|
|
* so we write into the mod->dev_table_buf buffer. */
|
|
void handle_moddevtable(struct module *mod, struct elf_info *info,
|
|
Elf_Sym *sym, const char *symname)
|
|
{
|
|
void *symval;
|
|
|
|
/* We're looking for a section relative symbol */
|
|
if (!sym->st_shndx || sym->st_shndx >= info->hdr->e_shnum)
|
|
return;
|
|
|
|
symval = (void *)info->hdr
|
|
+ info->sechdrs[sym->st_shndx].sh_offset
|
|
+ sym->st_value;
|
|
|
|
if (sym_is(symname, "__mod_pci_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct pci_device_id),
|
|
do_pci_entry, mod);
|
|
else if (sym_is(symname, "__mod_usb_device_table"))
|
|
/* special case to handle bcdDevice ranges */
|
|
do_usb_table(symval, sym->st_size, mod);
|
|
else if (sym_is(symname, "__mod_ieee1394_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct ieee1394_device_id),
|
|
do_ieee1394_entry, mod);
|
|
else if (sym_is(symname, "__mod_ccw_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct ccw_device_id),
|
|
do_ccw_entry, mod);
|
|
else if (sym_is(symname, "__mod_serio_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct serio_device_id),
|
|
do_serio_entry, mod);
|
|
else if (sym_is(symname, "__mod_pnp_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct pnp_device_id),
|
|
do_pnp_entry, mod);
|
|
else if (sym_is(symname, "__mod_pnp_card_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct pnp_card_device_id),
|
|
do_pnp_card_entry, mod);
|
|
else if (sym_is(symname, "__mod_pcmcia_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct pcmcia_device_id),
|
|
do_pcmcia_entry, mod);
|
|
else if (sym_is(symname, "__mod_of_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct of_device_id),
|
|
do_of_entry, mod);
|
|
else if (sym_is(symname, "__mod_vio_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct vio_device_id),
|
|
do_vio_entry, mod);
|
|
else if (sym_is(symname, "__mod_i2c_device_table"))
|
|
do_table(symval, sym->st_size, sizeof(struct i2c_device_id),
|
|
do_i2c_entry, mod);
|
|
|
|
}
|
|
|
|
/* Now add out buffered information to the generated C source */
|
|
void add_moddevtable(struct buffer *buf, struct module *mod)
|
|
{
|
|
buf_printf(buf, "\n");
|
|
buf_write(buf, mod->dev_table_buf.p, mod->dev_table_buf.pos);
|
|
free(mod->dev_table_buf.p);
|
|
}
|