[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / i386 / kernel / dmi_scan.c

#include <linux/types.h>
#include <linux/string.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/dmi.h>
#include <linux/bootmem.h>


static char * __init dmi_string(struct dmi_header *dm, u8 s)
{
	u8 *bp = ((u8 *) dm) + dm->length;
	char *str = "";

	if (s) {
		s--;
		while (s > 0 && *bp) {
			bp += strlen(bp) + 1;
			s--;
		}

		if (*bp != 0) {
			str = alloc_bootmem(strlen(bp) + 1);
			if (str != NULL)
				strcpy(str, bp);
			else
				printk(KERN_ERR "dmi_string: out of memory.\n");
		}
 	}

	return str;
}

/*
 *	We have to be cautious here. We have seen BIOSes with DMI pointers
 *	pointing to completely the wrong place for example
 */
static int __init dmi_table(u32 base, int len, int num,
			    void (*decode)(struct dmi_header *))
{
	u8 *buf, *data;
	int i = 0;
		
	buf = bt_ioremap(base, len);
	if (buf == NULL)
		return -1;

	data = buf;

	/*
 	 *	Stop when we see all the items the table claimed to have
 	 *	OR we run off the end of the table (also happens)
 	 */
	while ((i < num) && (data - buf + sizeof(struct dmi_header)) <= len) {
		struct dmi_header *dm = (struct dmi_header *)data;
		/*
		 *  We want to know the total length (formated area and strings)
		 *  before decoding to make sure we won't run off the table in
		 *  dmi_decode or dmi_string
		 */
		data += dm->length;
		while ((data - buf < len - 1) && (data[0] || data[1]))
			data++;
		if (data - buf < len - 1)
			decode(dm);
		data += 2;
		i++;
	}
	bt_iounmap(buf, len);
	return 0;
}

static int __init dmi_checksum(u8 *buf)
{
	u8 sum = 0;
	int a;
	
	for (a = 0; a < 15; a++)
		sum += buf[a];

	return sum == 0;
}

static char *dmi_ident[DMI_STRING_MAX];
static LIST_HEAD(dmi_devices);

/*
 *	Save a DMI string
 */
static void __init dmi_save_ident(struct dmi_header *dm, int slot, int string)
{
	char *p, *d = (char*) dm;

	if (dmi_ident[slot])
		return;

	p = dmi_string(dm, d[string]);
	if (p == NULL)
		return;

	dmi_ident[slot] = p;
}

static void __init dmi_save_devices(struct dmi_header *dm)
{
	int i, count = (dm->length - sizeof(struct dmi_header)) / 2;
	struct dmi_device *dev;

	for (i = 0; i < count; i++) {
		char *d = ((char *) dm) + (i * 2);

		/* Skip disabled device */
		if ((*d & 0x80) == 0)
			continue;

		dev = alloc_bootmem(sizeof(*dev));
		if (!dev) {
			printk(KERN_ERR "dmi_save_devices: out of memory.\n");
			break;
		}

		dev->type = *d++ & 0x7f;
		dev->name = dmi_string(dm, *d);
		dev->device_data = NULL;

		list_add(&dev->list, &dmi_devices);
	}
}

static void __init dmi_save_ipmi_device(struct dmi_header *dm)
{
	struct dmi_device *dev;
	void * data;

	data = alloc_bootmem(dm->length);
	if (data == NULL) {
		printk(KERN_ERR "dmi_save_ipmi_device: out of memory.\n");
		return;
	}

	memcpy(data, dm, dm->length);

	dev = alloc_bootmem(sizeof(*dev));
	if (!dev) {
		printk(KERN_ERR "dmi_save_ipmi_device: out of memory.\n");
		return;
	}

	dev->type = DMI_DEV_TYPE_IPMI;
	dev->name = "IPMI controller";
	dev->device_data = data;

	list_add(&dev->list, &dmi_devices);
}

/*
 *	Process a DMI table entry. Right now all we care about are the BIOS
 *	and machine entries. For 2.5 we should pull the smbus controller info
 *	out of here.
 */
static void __init dmi_decode(struct dmi_header *dm)
{
	switch(dm->type) {
	case 0:		/* BIOS Information */
		dmi_save_ident(dm, DMI_BIOS_VENDOR, 4);
		dmi_save_ident(dm, DMI_BIOS_VERSION, 5);
		dmi_save_ident(dm, DMI_BIOS_DATE, 8);
		break;
	case 1:		/* System Information */
		dmi_save_ident(dm, DMI_SYS_VENDOR, 4);
		dmi_save_ident(dm, DMI_PRODUCT_NAME, 5);
		dmi_save_ident(dm, DMI_PRODUCT_VERSION, 6);
		dmi_save_ident(dm, DMI_PRODUCT_SERIAL, 7);
		break;
	case 2:		/* Base Board Information */
		dmi_save_ident(dm, DMI_BOARD_VENDOR, 4);
		dmi_save_ident(dm, DMI_BOARD_NAME, 5);
		dmi_save_ident(dm, DMI_BOARD_VERSION, 6);
		break;
	case 10:	/* Onboard Devices Information */
		dmi_save_devices(dm);
		break;
	case 38:	/* IPMI Device Information */
		dmi_save_ipmi_device(dm);
	}
}

void __init dmi_scan_machine(void)
{
	u8 buf[15];
	char __iomem *p, *q;

	/*
	 * no iounmap() for that ioremap(); it would be a no-op, but it's
	 * so early in setup that sucker gets confused into doing what
	 * it shouldn't if we actually call it.
	 */
	p = ioremap(0xF0000, 0x10000);
	if (p == NULL)
		goto out;

	for (q = p; q < p + 0x10000; q += 16) {
		memcpy_fromio(buf, q, 15);
		if ((memcmp(buf, "_DMI_", 5) == 0) && dmi_checksum(buf)) {
			u16 num = (buf[13] << 8) | buf[12];
			u16 len = (buf[7] << 8) | buf[6];
			u32 base = (buf[11] << 24) | (buf[10] << 16) |
				   (buf[9] << 8) | buf[8];

			/*
			 * DMI version 0.0 means that the real version is taken from
			 * the SMBIOS version, which we don't know at this point.
			 */
			if (buf[14] != 0)
				printk(KERN_INFO "DMI %d.%d present.\n",
					buf[14] >> 4, buf[14] & 0xF);
			else
				printk(KERN_INFO "DMI present.\n");

			if (dmi_table(base,len, num, dmi_decode) == 0)
				return;
		}
	}

out:	printk(KERN_INFO "DMI not present.\n");
}


/**
 *	dmi_check_system - check system DMI data
 *	@list: array of dmi_system_id structures to match against
 *
 *	Walk the blacklist table running matching functions until someone
 *	returns non zero or we hit the end. Callback function is called for
 *	each successfull match. Returns the number of matches.
 */
int dmi_check_system(struct dmi_system_id *list)
{
	int i, count = 0;
	struct dmi_system_id *d = list;

	while (d->ident) {
		for (i = 0; i < ARRAY_SIZE(d->matches); i++) {
			int s = d->matches[i].slot;
			if (s == DMI_NONE)
				continue;
			if (dmi_ident[s] && strstr(dmi_ident[s], d->matches[i].substr))
				continue;
			/* No match */
			goto fail;
		}
		count++;
		if (d->callback && d->callback(d))
			break;
fail:		d++;
	}

	return count;
}
EXPORT_SYMBOL(dmi_check_system);

/**
 *	dmi_get_system_info - return DMI data value
 *	@field: data index (see enum dmi_filed)
 *
 *	Returns one DMI data value, can be used to perform
 *	complex DMI data checks.
 */
char *dmi_get_system_info(int field)
{
	return dmi_ident[field];
}
EXPORT_SYMBOL(dmi_get_system_info);

/**
 *	dmi_find_device - find onboard device by type/name
 *	@type: device type or %DMI_DEV_TYPE_ANY to match all device types
 *	@desc: device name string or %NULL to match all
 *	@from: previous device found in search, or %NULL for new search.
 *
 *	Iterates through the list of known onboard devices. If a device is
 *	found with a matching @vendor and @device, a pointer to its device
 *	structure is returned.  Otherwise, %NULL is returned.
 *	A new search is initiated by passing %NULL to the @from argument.
 *	If @from is not %NULL, searches continue from next device.
 */
struct dmi_device * dmi_find_device(int type, const char *name,
				    struct dmi_device *from)
{
	struct list_head *d, *head = from ? &from->list : &dmi_devices;

	for(d = head->next; d != &dmi_devices; d = d->next) {
		struct dmi_device *dev = list_entry(d, struct dmi_device, list);

		if (((type == DMI_DEV_TYPE_ANY) || (dev->type == type)) &&
		    ((name == NULL) || (strcmp(dev->name, name) == 0)))
			return dev;
	}

	return NULL;
}
EXPORT_SYMBOL(dmi_find_device);
Commit	Line	Data
1da177e4	1	#include <linux/types.h>
1da177e4 LT	2	#include <linux/string.h>
	3	#include <linux/init.h>
	4	#include <linux/module.h>
1da177e4 LT	5	#include <linux/dmi.h>
	6	#include <linux/bootmem.h>
	7
	8
1da177e4 LT	9	static char * __init dmi_string(struct dmi_header *dm, u8 s)
1da177e4 LT	10	{
1249c513	11	u8 bp = ((u8 ) dm) + dm->length;
c3c7120d	12	char *str = "";
1249c513	13
c3c7120d	14	if (s) {
1da177e4	15	s--;
c3c7120d AP	16	while (s > 0 && *bp) {
	17	bp += strlen(bp) + 1;
	18	s--;
	19	}
	20
	21	if (*bp != 0) {
	22	str = alloc_bootmem(strlen(bp) + 1);
	23	if (str != NULL)
	24	strcpy(str, bp);
	25	else
	26	printk(KERN_ERR "dmi_string: out of memory.\n");
	27	}
	28	}
	29
	30	return str;
1da177e4 LT	31	}
	32
	33	/*
	34	* We have to be cautious here. We have seen BIOSes with DMI pointers
	35	* pointing to completely the wrong place for example
	36	*/
1249c513 AP	37	static int __init dmi_table(u32 base, int len, int num,
1249c513 AP	38	void (decode)(struct dmi_header ))
1da177e4	39	{
1249c513 AP	40	u8 buf, data;
1249c513 AP	41	int i = 0;
1da177e4 LT	42
1da177e4 LT	43	buf = bt_ioremap(base, len);
1249c513	44	if (buf == NULL)
1da177e4 LT	45	return -1;
	46
	47	data = buf;
	48
	49	/*
	50	* Stop when we see all the items the table claimed to have
	51	* OR we run off the end of the table (also happens)
	52	*/
1249c513 AP	53	while ((i < num) && (data - buf + sizeof(struct dmi_header)) <= len) {
1249c513 AP	54	struct dmi_header dm = (struct dmi_header )data;
1da177e4 LT	55	/*
	56	* We want to know the total length (formated area and strings)
	57	* before decoding to make sure we won't run off the table in
	58	* dmi_decode or dmi_string
	59	*/
1249c513 AP	60	data += dm->length;
1249c513 AP	61	while ((data - buf < len - 1) && (data[0] \|\| data[1]))
1da177e4	62	data++;
1249c513	63	if (data - buf < len - 1)
1da177e4	64	decode(dm);
1249c513	65	data += 2;
1da177e4 LT	66	i++;
	67	}
	68	bt_iounmap(buf, len);
	69	return 0;
	70	}
	71
1249c513	72	static int __init dmi_checksum(u8 *buf)
1da177e4	73	{
1249c513	74	u8 sum = 0;
1da177e4 LT	75	int a;
1da177e4 LT	76
1249c513 AP	77	for (a = 0; a < 15; a++)
	78	sum += buf[a];
	79
	80	return sum == 0;
1da177e4 LT	81	}
1da177e4 LT	82
1da177e4	83	static char *dmi_ident[DMI_STRING_MAX];
ebad6a42	84	static LIST_HEAD(dmi_devices);
1da177e4 LT	85
	86	/*
	87	* Save a DMI string
	88	*/
1da177e4 LT	89	static void __init dmi_save_ident(struct dmi_header *dm, int slot, int string)
1da177e4 LT	90	{
c3c7120d	91	char p, d = (char*) dm;
1249c513	92
1da177e4 LT	93	if (dmi_ident[slot])
1da177e4 LT	94	return;
1249c513	95
c3c7120d AP	96	p = dmi_string(dm, d[string]);
	97	if (p == NULL)
	98	return;
	99
	100	dmi_ident[slot] = p;
1da177e4 LT	101	}
1da177e4 LT	102
ebad6a42 AP	103	static void __init dmi_save_devices(struct dmi_header *dm)
	104	{
	105	int i, count = (dm->length - sizeof(struct dmi_header)) / 2;
	106	struct dmi_device *dev;
	107
	108	for (i = 0; i < count; i++) {
	109	char d = ((char ) dm) + (i * 2);
	110
	111	/* Skip disabled device */
	112	if ((*d & 0x80) == 0)
	113	continue;
	114
	115	dev = alloc_bootmem(sizeof(*dev));
	116	if (!dev) {
	117	printk(KERN_ERR "dmi_save_devices: out of memory.\n");
	118	break;
	119	}
	120
	121	dev->type = *d++ & 0x7f;
	122	dev->name = dmi_string(dm, *d);
	123	dev->device_data = NULL;
	124
	125	list_add(&dev->list, &dmi_devices);
	126	}
	127	}
	128
	129	static void __init dmi_save_ipmi_device(struct dmi_header *dm)
	130	{
	131	struct dmi_device *dev;
	132	void * data;
	133
	134	data = alloc_bootmem(dm->length);
	135	if (data == NULL) {
	136	printk(KERN_ERR "dmi_save_ipmi_device: out of memory.\n");
	137	return;
	138	}
	139
	140	memcpy(data, dm, dm->length);
	141
	142	dev = alloc_bootmem(sizeof(*dev));
	143	if (!dev) {
	144	printk(KERN_ERR "dmi_save_ipmi_device: out of memory.\n");
	145	return;
	146	}
	147
	148	dev->type = DMI_DEV_TYPE_IPMI;
	149	dev->name = "IPMI controller";
	150	dev->device_data = data;
	151
	152	list_add(&dev->list, &dmi_devices);
	153	}
	154
1da177e4 LT	155	/*
	156	* Process a DMI table entry. Right now all we care about are the BIOS
	157	* and machine entries. For 2.5 we should pull the smbus controller info
	158	* out of here.
	159	*/
1da177e4 LT	160	static void __init dmi_decode(struct dmi_header *dm)
1da177e4 LT	161	{
1249c513	162	switch(dm->type) {
ebad6a42	163	case 0: /* BIOS Information */
1249c513	164	dmi_save_ident(dm, DMI_BIOS_VENDOR, 4);
1249c513	165	dmi_save_ident(dm, DMI_BIOS_VERSION, 5);
1249c513 AP	166	dmi_save_ident(dm, DMI_BIOS_DATE, 8);
1249c513 AP	167	break;
ebad6a42	168	case 1: /* System Information */
1249c513	169	dmi_save_ident(dm, DMI_SYS_VENDOR, 4);
1249c513	170	dmi_save_ident(dm, DMI_PRODUCT_NAME, 5);
1249c513	171	dmi_save_ident(dm, DMI_PRODUCT_VERSION, 6);
1249c513 AP	172	dmi_save_ident(dm, DMI_PRODUCT_SERIAL, 7);
1249c513 AP	173	break;
ebad6a42	174	case 2: /* Base Board Information */
1249c513	175	dmi_save_ident(dm, DMI_BOARD_VENDOR, 4);
1249c513	176	dmi_save_ident(dm, DMI_BOARD_NAME, 5);
1249c513 AP	177	dmi_save_ident(dm, DMI_BOARD_VERSION, 6);
1249c513 AP	178	break;
ebad6a42 AP	179	case 10: /* Onboard Devices Information */
	180	dmi_save_devices(dm);
	181	break;
	182	case 38: /* IPMI Device Information */
	183	dmi_save_ipmi_device(dm);
1da177e4 LT	184	}
	185	}
	186
	187	void __init dmi_scan_machine(void)
	188	{
61e032fa AP	189	u8 buf[15];
	190	char __iomem p, q;
	191
	192	/*
	193	* no iounmap() for that ioremap(); it would be a no-op, but it's
	194	* so early in setup that sucker gets confused into doing what
	195	* it shouldn't if we actually call it.
	196	*/
	197	p = ioremap(0xF0000, 0x10000);
	198	if (p == NULL)
	199	goto out;
	200
	201	for (q = p; q < p + 0x10000; q += 16) {
	202	memcpy_fromio(buf, q, 15);
	203	if ((memcmp(buf, "_DMI_", 5) == 0) && dmi_checksum(buf)) {
	204	u16 num = (buf[13] << 8) \| buf[12];
	205	u16 len = (buf[7] << 8) \| buf[6];
	206	u32 base = (buf[11] << 24) \| (buf[10] << 16) \|
	207	(buf[9] << 8) \| buf[8];
	208
	209	/*
	210	* DMI version 0.0 means that the real version is taken from
	211	* the SMBIOS version, which we don't know at this point.
	212	*/
	213	if (buf[14] != 0)
	214	printk(KERN_INFO "DMI %d.%d present.\n",
	215	buf[14] >> 4, buf[14] & 0xF);
	216	else
	217	printk(KERN_INFO "DMI present.\n");
	218
61e032fa AP	219	if (dmi_table(base,len, num, dmi_decode) == 0)
	220	return;
	221	}
	222	}
	223
	224	out: printk(KERN_INFO "DMI not present.\n");
1da177e4 LT	225	}
	226
	227
	228	/**
	229	* dmi_check_system - check system DMI data
	230	* @list: array of dmi_system_id structures to match against
	231	*
	232	* Walk the blacklist table running matching functions until someone
	233	* returns non zero or we hit the end. Callback function is called for
	234	* each successfull match. Returns the number of matches.
	235	*/
	236	int dmi_check_system(struct dmi_system_id *list)
	237	{
	238	int i, count = 0;
	239	struct dmi_system_id *d = list;
	240
	241	while (d->ident) {
	242	for (i = 0; i < ARRAY_SIZE(d->matches); i++) {
	243	int s = d->matches[i].slot;
	244	if (s == DMI_NONE)
	245	continue;
	246	if (dmi_ident[s] && strstr(dmi_ident[s], d->matches[i].substr))
	247	continue;
	248	/* No match */
	249	goto fail;
	250	}
640e8033	251	count++;
1da177e4 LT	252	if (d->callback && d->callback(d))
1da177e4 LT	253	break;
1da177e4 LT	254	fail: d++;
	255	}
	256
	257	return count;
	258	}
1da177e4 LT	259	EXPORT_SYMBOL(dmi_check_system);
	260
	261	/**
	262	* dmi_get_system_info - return DMI data value
	263	* @field: data index (see enum dmi_filed)
	264	*
	265	* Returns one DMI data value, can be used to perform
	266	* complex DMI data checks.
	267	*/
e70c9d5e	268	char *dmi_get_system_info(int field)
1da177e4 LT	269	{
	270	return dmi_ident[field];
	271	}
e70c9d5e	272	EXPORT_SYMBOL(dmi_get_system_info);
ebad6a42 AP	273
	274	/**
	275	* dmi_find_device - find onboard device by type/name
	276	* @type: device type or %DMI_DEV_TYPE_ANY to match all device types
	277	* @desc: device name string or %NULL to match all
	278	* @from: previous device found in search, or %NULL for new search.
	279	*
	280	* Iterates through the list of known onboard devices. If a device is
	281	* found with a matching @vendor and @device, a pointer to its device
	282	* structure is returned. Otherwise, %NULL is returned.
	283	* A new search is initiated by passing %NULL to the @from argument.
	284	* If @from is not %NULL, searches continue from next device.
	285	*/
	286	struct dmi_device * dmi_find_device(int type, const char *name,
	287	struct dmi_device *from)
	288	{
	289	struct list_head d, head = from ? &from->list : &dmi_devices;
	290
	291	for(d = head->next; d != &dmi_devices; d = d->next) {
	292	struct dmi_device *dev = list_entry(d, struct dmi_device, list);
	293
	294	if (((type == DMI_DEV_TYPE_ANY) \|\| (dev->type == type)) &&
	295	((name == NULL) \|\| (strcmp(dev->name, name) == 0)))
	296	return dev;
	297	}
	298
	299	return NULL;
	300	}
	301	EXPORT_SYMBOL(dmi_find_device);