blob: cca2f9f9f3e30e6f8a1201ac0fd03774a980a8bc [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * rsparser.c - parses and encodes pnpbios resource data streams
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 */
4
Linus Torvalds1da177e2005-04-16 15:20:36 -07005#include <linux/ctype.h>
6#include <linux/pnp.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -08007#include <linux/string.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -07008
9#ifdef CONFIG_PCI
10#include <linux/pci.h>
11#else
Bjorn Helgaas9dd78462007-07-26 10:41:20 -070012inline void pcibios_penalize_isa_irq(int irq, int active)
13{
14}
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -070015#endif /* CONFIG_PCI */
Linus Torvalds1da177e2005-04-16 15:20:36 -070016
Bjorn Helgaas772defc2008-04-28 16:33:52 -060017#include "../base.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include "pnpbios.h"
19
20/* standard resource tags */
21#define SMALL_TAG_PNPVERNO 0x01
22#define SMALL_TAG_LOGDEVID 0x02
23#define SMALL_TAG_COMPATDEVID 0x03
24#define SMALL_TAG_IRQ 0x04
25#define SMALL_TAG_DMA 0x05
26#define SMALL_TAG_STARTDEP 0x06
27#define SMALL_TAG_ENDDEP 0x07
28#define SMALL_TAG_PORT 0x08
29#define SMALL_TAG_FIXEDPORT 0x09
30#define SMALL_TAG_VENDOR 0x0e
31#define SMALL_TAG_END 0x0f
32#define LARGE_TAG 0x80
33#define LARGE_TAG_MEM 0x81
34#define LARGE_TAG_ANSISTR 0x82
35#define LARGE_TAG_UNICODESTR 0x83
36#define LARGE_TAG_VENDOR 0x84
37#define LARGE_TAG_MEM32 0x85
38#define LARGE_TAG_FIXEDMEM32 0x86
39
40/*
41 * Resource Data Stream Format:
42 *
43 * Allocated Resources (required)
44 * end tag ->
45 * Resource Configuration Options (optional)
46 * end tag ->
47 * Compitable Device IDs (optional)
48 * final end tag ->
49 */
50
51/*
52 * Allocated Resources
53 */
54
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -060055static void pnpbios_parse_allocated_ioresource(struct pnp_dev *dev,
Bjorn Helgaascc8c2e32008-04-28 16:34:36 -060056 int start, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -070057{
Bjorn Helgaascc8c2e32008-04-28 16:34:36 -060058 int flags = 0;
59 int end = start + len - 1;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -070060
Bjorn Helgaascc8c2e32008-04-28 16:34:36 -060061 if (len <= 0 || end >= 0x10003)
62 flags |= IORESOURCE_DISABLED;
Bjorn Helgaas06cb58a2008-04-28 16:34:29 -060063
Bjorn Helgaascc8c2e32008-04-28 16:34:36 -060064 pnp_add_io_resource(dev, start, end, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -070065}
66
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -060067static void pnpbios_parse_allocated_memresource(struct pnp_dev *dev,
Bjorn Helgaasd6180f32008-04-28 16:34:37 -060068 int start, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -070069{
Bjorn Helgaasd6180f32008-04-28 16:34:37 -060070 int flags = 0;
71 int end = start + len - 1;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -070072
Bjorn Helgaasd6180f32008-04-28 16:34:37 -060073 if (len <= 0)
74 flags |= IORESOURCE_DISABLED;
Bjorn Helgaas06cb58a2008-04-28 16:34:29 -060075
Bjorn Helgaasd6180f32008-04-28 16:34:37 -060076 pnp_add_mem_resource(dev, start, end, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077}
78
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -060079static unsigned char *pnpbios_parse_allocated_resource_data(struct pnp_dev *dev,
80 unsigned char *p,
81 unsigned char *end)
Linus Torvalds1da177e2005-04-16 15:20:36 -070082{
83 unsigned int len, tag;
Bjorn Helgaasdbddd032008-04-28 16:34:34 -060084 int io, size, mask, i, flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -070085
86 if (!p)
87 return NULL;
88
Bjorn Helgaas2f534322008-08-19 16:53:47 -060089 pnp_dbg(&dev->dev, "parse allocated resources\n");
Bjorn Helgaas72dcc882008-04-28 16:34:07 -060090
Bjorn Helgaasf4490002008-04-28 16:34:09 -060091 pnp_init_resources(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070092
93 while ((char *)p < (char *)end) {
94
95 /* determine the type of tag */
Bjorn Helgaas9dd78462007-07-26 10:41:20 -070096 if (p[0] & LARGE_TAG) { /* large tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -070097 len = (p[2] << 8) | p[1];
98 tag = p[0];
Bjorn Helgaas9dd78462007-07-26 10:41:20 -070099 } else { /* small tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100 len = p[0] & 0x07;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700101 tag = ((p[0] >> 3) & 0x0f);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 }
103
104 switch (tag) {
105
106 case LARGE_TAG_MEM:
107 if (len != 9)
108 goto len_err;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700109 io = *(short *)&p[4];
110 size = *(short *)&p[10];
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600111 pnpbios_parse_allocated_memresource(dev, io, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 break;
113
114 case LARGE_TAG_ANSISTR:
115 /* ignore this for now */
116 break;
117
118 case LARGE_TAG_VENDOR:
119 /* do nothing */
120 break;
121
122 case LARGE_TAG_MEM32:
123 if (len != 17)
124 goto len_err;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700125 io = *(int *)&p[4];
126 size = *(int *)&p[16];
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600127 pnpbios_parse_allocated_memresource(dev, io, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 break;
129
130 case LARGE_TAG_FIXEDMEM32:
131 if (len != 9)
132 goto len_err;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700133 io = *(int *)&p[4];
134 size = *(int *)&p[8];
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600135 pnpbios_parse_allocated_memresource(dev, io, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136 break;
137
138 case SMALL_TAG_IRQ:
139 if (len < 2 || len > 3)
140 goto len_err;
Bjorn Helgaasdbddd032008-04-28 16:34:34 -0600141 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 io = -1;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700143 mask = p[1] + p[2] * 256;
144 for (i = 0; i < 16; i++, mask = mask >> 1)
145 if (mask & 0x01)
146 io = i;
Bjorn Helgaasdbddd032008-04-28 16:34:34 -0600147 if (io != -1)
148 pcibios_penalize_isa_irq(io, 1);
149 else
150 flags = IORESOURCE_DISABLED;
151 pnp_add_irq_resource(dev, io, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 break;
153
154 case SMALL_TAG_DMA:
155 if (len != 2)
156 goto len_err;
Bjorn Helgaasdc16f5f2008-04-28 16:34:35 -0600157 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158 io = -1;
159 mask = p[1];
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700160 for (i = 0; i < 8; i++, mask = mask >> 1)
161 if (mask & 0x01)
162 io = i;
Bjorn Helgaasdc16f5f2008-04-28 16:34:35 -0600163 if (io == -1)
164 flags = IORESOURCE_DISABLED;
165 pnp_add_dma_resource(dev, io, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166 break;
167
168 case SMALL_TAG_PORT:
169 if (len != 7)
170 goto len_err;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700171 io = p[2] + p[3] * 256;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 size = p[7];
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600173 pnpbios_parse_allocated_ioresource(dev, io, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174 break;
175
176 case SMALL_TAG_VENDOR:
177 /* do nothing */
178 break;
179
180 case SMALL_TAG_FIXEDPORT:
181 if (len != 3)
182 goto len_err;
183 io = p[1] + p[2] * 256;
184 size = p[3];
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600185 pnpbios_parse_allocated_ioresource(dev, io, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 break;
187
188 case SMALL_TAG_END:
189 p = p + 2;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700190 return (unsigned char *)p;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191 break;
192
André Goddard Rosaaf901ca2009-11-14 13:09:05 -0200193 default: /* an unknown tag */
Bjorn Helgaas1e0aa9a2007-08-15 10:32:08 -0600194len_err:
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600195 dev_err(&dev->dev, "unknown tag %#x length %d\n",
196 tag, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 break;
198 }
199
200 /* continue to the next tag */
201 if (p[0] & LARGE_TAG)
202 p += len + 3;
203 else
204 p += len + 1;
205 }
206
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600207 dev_err(&dev->dev, "no end tag in resource structure\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208
209 return NULL;
210}
211
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212/*
213 * Resource Configuration Options
214 */
215
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600216static __init void pnpbios_parse_mem_option(struct pnp_dev *dev,
217 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600218 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219{
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600220 resource_size_t min, max, align, len;
221 unsigned char flags;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700222
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600223 min = ((p[5] << 8) | p[4]) << 8;
224 max = ((p[7] << 8) | p[6]) << 8;
225 align = (p[9] << 8) | p[8];
226 len = ((p[11] << 8) | p[10]) << 8;
227 flags = p[3];
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600228 pnp_register_mem_resource(dev, option_flags, min, max, align, len,
229 flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230}
231
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600232static __init void pnpbios_parse_mem32_option(struct pnp_dev *dev,
233 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600234 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235{
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600236 resource_size_t min, max, align, len;
237 unsigned char flags;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700238
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600239 min = (p[7] << 24) | (p[6] << 16) | (p[5] << 8) | p[4];
240 max = (p[11] << 24) | (p[10] << 16) | (p[9] << 8) | p[8];
241 align = (p[15] << 24) | (p[14] << 16) | (p[13] << 8) | p[12];
242 len = (p[19] << 24) | (p[18] << 16) | (p[17] << 8) | p[16];
243 flags = p[3];
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600244 pnp_register_mem_resource(dev, option_flags, min, max, align, len,
245 flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246}
247
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600248static __init void pnpbios_parse_fixed_mem32_option(struct pnp_dev *dev,
249 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600250 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251{
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600252 resource_size_t base, len;
253 unsigned char flags;
Bjorn Helgaas1e0aa9a2007-08-15 10:32:08 -0600254
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600255 base = (p[7] << 24) | (p[6] << 16) | (p[5] << 8) | p[4];
256 len = (p[11] << 24) | (p[10] << 16) | (p[9] << 8) | p[8];
257 flags = p[3];
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600258 pnp_register_mem_resource(dev, option_flags, base, base, 0, len, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259}
260
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600261static __init void pnpbios_parse_irq_option(struct pnp_dev *dev,
262 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600263 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 unsigned long bits;
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600266 pnp_irq_mask_t map;
267 unsigned char flags = IORESOURCE_IRQ_HIGHEDGE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 bits = (p[2] << 8) | p[1];
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600270
271 bitmap_zero(map.bits, PNP_IRQ_NR);
272 bitmap_copy(map.bits, &bits, 16);
273
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 if (size > 2)
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600275 flags = p[3];
276
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600277 pnp_register_irq_resource(dev, option_flags, &map, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700278}
279
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600280static __init void pnpbios_parse_dma_option(struct pnp_dev *dev,
281 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600282 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283{
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600284 pnp_register_dma_resource(dev, option_flags, p[1], p[2]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285}
286
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600287static __init void pnpbios_parse_port_option(struct pnp_dev *dev,
288 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600289 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290{
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600291 resource_size_t min, max, align, len;
292 unsigned char flags;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700293
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600294 min = (p[3] << 8) | p[2];
295 max = (p[5] << 8) | p[4];
296 align = p[6];
297 len = p[7];
298 flags = p[1] ? IORESOURCE_IO_16BIT_ADDR : 0;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600299 pnp_register_port_resource(dev, option_flags, min, max, align, len,
300 flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301}
302
Bjorn Helgaasc1caf062008-04-28 16:34:04 -0600303static __init void pnpbios_parse_fixed_port_option(struct pnp_dev *dev,
304 unsigned char *p, int size,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600305 unsigned int option_flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306{
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600307 resource_size_t base, len;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700308
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600309 base = (p[2] << 8) | p[1];
310 len = p[3];
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600311 pnp_register_port_resource(dev, option_flags, base, base, 0, len,
Bjorn Helgaasc2275362008-06-27 16:57:11 -0600312 IORESOURCE_IO_FIXED);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313}
314
Thomas Renninger2bb9a6b2008-02-06 01:40:03 -0800315static __init unsigned char *
316pnpbios_parse_resource_option_data(unsigned char *p, unsigned char *end,
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600317 struct pnp_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318{
319 unsigned int len, tag;
Bjorn Helgaase2a1a6f2008-06-27 16:57:15 -0600320 int priority;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600321 unsigned int option_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322
323 if (!p)
324 return NULL;
325
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600326 pnp_dbg(&dev->dev, "parse resource options\n");
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600327 option_flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328 while ((char *)p < (char *)end) {
329
330 /* determine the type of tag */
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700331 if (p[0] & LARGE_TAG) { /* large tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332 len = (p[2] << 8) | p[1];
333 tag = p[0];
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700334 } else { /* small tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 len = p[0] & 0x07;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700336 tag = ((p[0] >> 3) & 0x0f);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 }
338
339 switch (tag) {
340
341 case LARGE_TAG_MEM:
342 if (len != 9)
343 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600344 pnpbios_parse_mem_option(dev, p, len, option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 break;
346
347 case LARGE_TAG_MEM32:
348 if (len != 17)
349 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600350 pnpbios_parse_mem32_option(dev, p, len, option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 break;
352
353 case LARGE_TAG_FIXEDMEM32:
354 if (len != 9)
355 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600356 pnpbios_parse_fixed_mem32_option(dev, p, len,
357 option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 break;
359
360 case SMALL_TAG_IRQ:
361 if (len < 2 || len > 3)
362 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600363 pnpbios_parse_irq_option(dev, p, len, option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364 break;
365
366 case SMALL_TAG_DMA:
367 if (len != 2)
368 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600369 pnpbios_parse_dma_option(dev, p, len, option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 break;
371
372 case SMALL_TAG_PORT:
373 if (len != 7)
374 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600375 pnpbios_parse_port_option(dev, p, len, option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 break;
377
378 case SMALL_TAG_VENDOR:
379 /* do nothing */
380 break;
381
382 case SMALL_TAG_FIXEDPORT:
383 if (len != 3)
384 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600385 pnpbios_parse_fixed_port_option(dev, p, len,
386 option_flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 break;
388
389 case SMALL_TAG_STARTDEP:
390 if (len > 1)
391 goto len_err;
Bjorn Helgaase2a1a6f2008-06-27 16:57:15 -0600392 priority = PNP_RES_PRIORITY_ACCEPTABLE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393 if (len > 0)
Bjorn Helgaase2a1a6f2008-06-27 16:57:15 -0600394 priority = p[1];
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600395 option_flags = pnp_new_dependent_set(dev, priority);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 break;
397
398 case SMALL_TAG_ENDDEP:
399 if (len != 0)
400 goto len_err;
Bjorn Helgaas1f32ca32008-06-27 16:57:17 -0600401 option_flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402 break;
403
404 case SMALL_TAG_END:
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700405 return p + 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406
André Goddard Rosaaf901ca2009-11-14 13:09:05 -0200407 default: /* an unknown tag */
Bjorn Helgaas1e0aa9a2007-08-15 10:32:08 -0600408len_err:
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600409 dev_err(&dev->dev, "unknown tag %#x length %d\n",
410 tag, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 break;
412 }
413
414 /* continue to the next tag */
415 if (p[0] & LARGE_TAG)
416 p += len + 3;
417 else
418 p += len + 1;
419 }
420
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600421 dev_err(&dev->dev, "no end tag in resource structure\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422
423 return NULL;
424}
425
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426/*
427 * Compatible Device IDs
428 */
429
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700430static unsigned char *pnpbios_parse_compatible_ids(unsigned char *p,
431 unsigned char *end,
432 struct pnp_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433{
434 int len, tag;
Bjorn Helgaas25eb8462008-04-28 16:33:53 -0600435 u32 eisa_id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 char id[8];
437 struct pnp_id *dev_id;
438
439 if (!p)
440 return NULL;
441
442 while ((char *)p < (char *)end) {
443
444 /* determine the type of tag */
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700445 if (p[0] & LARGE_TAG) { /* large tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446 len = (p[2] << 8) | p[1];
447 tag = p[0];
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700448 } else { /* small tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 len = p[0] & 0x07;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700450 tag = ((p[0] >> 3) & 0x0f);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 }
452
453 switch (tag) {
454
455 case LARGE_TAG_ANSISTR:
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700456 strncpy(dev->name, p + 3,
457 len >= PNP_NAME_LEN ? PNP_NAME_LEN - 2 : len);
458 dev->name[len >=
459 PNP_NAME_LEN ? PNP_NAME_LEN - 1 : len] = '\0';
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460 break;
461
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700462 case SMALL_TAG_COMPATDEVID: /* compatible ID */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463 if (len != 4)
464 goto len_err;
Bjorn Helgaas25eb8462008-04-28 16:33:53 -0600465 eisa_id = p[1] | p[2] << 8 | p[3] << 16 | p[4] << 24;
466 pnp_eisa_id_to_string(eisa_id & PNP_EISA_ID_MASK, id);
Bjorn Helgaas772defc2008-04-28 16:33:52 -0600467 dev_id = pnp_add_id(dev, id);
468 if (!dev_id)
469 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700470 break;
471
472 case SMALL_TAG_END:
473 p = p + 2;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700474 return (unsigned char *)p;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 break;
476
André Goddard Rosaaf901ca2009-11-14 13:09:05 -0200477 default: /* an unknown tag */
Bjorn Helgaas1e0aa9a2007-08-15 10:32:08 -0600478len_err:
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600479 dev_err(&dev->dev, "unknown tag %#x length %d\n",
480 tag, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 break;
482 }
483
484 /* continue to the next tag */
485 if (p[0] & LARGE_TAG)
486 p += len + 3;
487 else
488 p += len + 1;
489 }
490
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600491 dev_err(&dev->dev, "no end tag in resource structure\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492
493 return NULL;
494}
495
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496/*
497 * Allocated Resource Encoding
498 */
499
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600500static void pnpbios_encode_mem(struct pnp_dev *dev, unsigned char *p,
501 struct resource *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502{
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600503 unsigned long base;
504 unsigned long len;
505
506 if (pnp_resource_enabled(res)) {
507 base = res->start;
Joe Perches28f65c112011-06-09 09:13:32 -0700508 len = resource_size(res);
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600509 } else {
510 base = 0;
511 len = 0;
512 }
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700513
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 p[4] = (base >> 8) & 0xff;
515 p[5] = ((base >> 8) >> 8) & 0xff;
516 p[6] = (base >> 8) & 0xff;
517 p[7] = ((base >> 8) >> 8) & 0xff;
518 p[10] = (len >> 8) & 0xff;
519 p[11] = ((len >> 8) >> 8) & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600520
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600521 pnp_dbg(&dev->dev, " encode mem %#lx-%#lx\n", base, base + len - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522}
523
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600524static void pnpbios_encode_mem32(struct pnp_dev *dev, unsigned char *p,
525 struct resource *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526{
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600527 unsigned long base;
528 unsigned long len;
529
530 if (pnp_resource_enabled(res)) {
531 base = res->start;
Joe Perches28f65c112011-06-09 09:13:32 -0700532 len = resource_size(res);
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600533 } else {
534 base = 0;
535 len = 0;
536 }
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700537
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 p[4] = base & 0xff;
539 p[5] = (base >> 8) & 0xff;
540 p[6] = (base >> 16) & 0xff;
541 p[7] = (base >> 24) & 0xff;
542 p[8] = base & 0xff;
543 p[9] = (base >> 8) & 0xff;
544 p[10] = (base >> 16) & 0xff;
545 p[11] = (base >> 24) & 0xff;
546 p[16] = len & 0xff;
547 p[17] = (len >> 8) & 0xff;
548 p[18] = (len >> 16) & 0xff;
549 p[19] = (len >> 24) & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600550
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600551 pnp_dbg(&dev->dev, " encode mem32 %#lx-%#lx\n", base, base + len - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552}
553
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600554static void pnpbios_encode_fixed_mem32(struct pnp_dev *dev, unsigned char *p,
555 struct resource *res)
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700556{
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600557 unsigned long base;
558 unsigned long len;
559
560 if (pnp_resource_enabled(res)) {
561 base = res->start;
Joe Perches28f65c112011-06-09 09:13:32 -0700562 len = resource_size(res);
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600563 } else {
564 base = 0;
565 len = 0;
566 }
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700567
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568 p[4] = base & 0xff;
569 p[5] = (base >> 8) & 0xff;
570 p[6] = (base >> 16) & 0xff;
571 p[7] = (base >> 24) & 0xff;
572 p[8] = len & 0xff;
573 p[9] = (len >> 8) & 0xff;
574 p[10] = (len >> 16) & 0xff;
575 p[11] = (len >> 24) & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600576
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600577 pnp_dbg(&dev->dev, " encode fixed_mem32 %#lx-%#lx\n", base,
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600578 base + len - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579}
580
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600581static void pnpbios_encode_irq(struct pnp_dev *dev, unsigned char *p,
582 struct resource *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583{
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600584 unsigned long map;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700585
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600586 if (pnp_resource_enabled(res))
587 map = 1 << res->start;
588 else
589 map = 0;
590
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591 p[1] = map & 0xff;
592 p[2] = (map >> 8) & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600593
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600594 pnp_dbg(&dev->dev, " encode irq mask %#lx\n", map);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595}
596
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600597static void pnpbios_encode_dma(struct pnp_dev *dev, unsigned char *p,
598 struct resource *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599{
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600600 unsigned long map;
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700601
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600602 if (pnp_resource_enabled(res))
603 map = 1 << res->start;
604 else
605 map = 0;
606
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607 p[1] = map & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600608
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600609 pnp_dbg(&dev->dev, " encode dma mask %#lx\n", map);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610}
611
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600612static void pnpbios_encode_port(struct pnp_dev *dev, unsigned char *p,
613 struct resource *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614{
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600615 unsigned long base;
616 unsigned long len;
617
618 if (pnp_resource_enabled(res)) {
619 base = res->start;
Joe Perches28f65c112011-06-09 09:13:32 -0700620 len = resource_size(res);
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600621 } else {
622 base = 0;
623 len = 0;
624 }
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700625
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 p[2] = base & 0xff;
627 p[3] = (base >> 8) & 0xff;
628 p[4] = base & 0xff;
629 p[5] = (base >> 8) & 0xff;
630 p[7] = len & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600631
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600632 pnp_dbg(&dev->dev, " encode io %#lx-%#lx\n", base, base + len - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633}
634
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600635static void pnpbios_encode_fixed_port(struct pnp_dev *dev, unsigned char *p,
636 struct resource *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637{
638 unsigned long base = res->start;
Joe Perches28f65c112011-06-09 09:13:32 -0700639 unsigned long len = resource_size(res);
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700640
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600641 if (pnp_resource_enabled(res)) {
642 base = res->start;
Joe Perches28f65c112011-06-09 09:13:32 -0700643 len = resource_size(res);
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600644 } else {
645 base = 0;
646 len = 0;
647 }
648
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649 p[1] = base & 0xff;
650 p[2] = (base >> 8) & 0xff;
651 p[3] = len & 0xff;
Bjorn Helgaas72dcc882008-04-28 16:34:07 -0600652
Bjorn Helgaas2f534322008-08-19 16:53:47 -0600653 pnp_dbg(&dev->dev, " encode fixed_io %#lx-%#lx\n", base,
Bjorn Helgaasaee3ad82008-06-27 16:56:57 -0600654 base + len - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655}
656
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600657static unsigned char *pnpbios_encode_allocated_resource_data(struct pnp_dev
658 *dev,
659 unsigned char *p,
660 unsigned char *end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661{
662 unsigned int len, tag;
663 int port = 0, irq = 0, dma = 0, mem = 0;
664
665 if (!p)
666 return NULL;
667
668 while ((char *)p < (char *)end) {
669
670 /* determine the type of tag */
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700671 if (p[0] & LARGE_TAG) { /* large tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700672 len = (p[2] << 8) | p[1];
673 tag = p[0];
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700674 } else { /* small tag */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675 len = p[0] & 0x07;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700676 tag = ((p[0] >> 3) & 0x0f);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677 }
678
679 switch (tag) {
680
681 case LARGE_TAG_MEM:
682 if (len != 9)
683 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600684 pnpbios_encode_mem(dev, p,
685 pnp_get_resource(dev, IORESOURCE_MEM, mem));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686 mem++;
687 break;
688
689 case LARGE_TAG_MEM32:
690 if (len != 17)
691 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600692 pnpbios_encode_mem32(dev, p,
693 pnp_get_resource(dev, IORESOURCE_MEM, mem));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700694 mem++;
695 break;
696
697 case LARGE_TAG_FIXEDMEM32:
698 if (len != 9)
699 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600700 pnpbios_encode_fixed_mem32(dev, p,
701 pnp_get_resource(dev, IORESOURCE_MEM, mem));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 mem++;
703 break;
704
705 case SMALL_TAG_IRQ:
706 if (len < 2 || len > 3)
707 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600708 pnpbios_encode_irq(dev, p,
709 pnp_get_resource(dev, IORESOURCE_IRQ, irq));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710 irq++;
711 break;
712
713 case SMALL_TAG_DMA:
714 if (len != 2)
715 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600716 pnpbios_encode_dma(dev, p,
717 pnp_get_resource(dev, IORESOURCE_DMA, dma));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718 dma++;
719 break;
720
721 case SMALL_TAG_PORT:
722 if (len != 7)
723 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600724 pnpbios_encode_port(dev, p,
725 pnp_get_resource(dev, IORESOURCE_IO, port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726 port++;
727 break;
728
729 case SMALL_TAG_VENDOR:
730 /* do nothing */
731 break;
732
733 case SMALL_TAG_FIXEDPORT:
734 if (len != 3)
735 goto len_err;
Bjorn Helgaas7e2cf312008-04-28 16:34:24 -0600736 pnpbios_encode_fixed_port(dev, p,
737 pnp_get_resource(dev, IORESOURCE_IO, port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700738 port++;
739 break;
740
741 case SMALL_TAG_END:
742 p = p + 2;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700743 return (unsigned char *)p;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744 break;
745
André Goddard Rosaaf901ca2009-11-14 13:09:05 -0200746 default: /* an unknown tag */
Bjorn Helgaas1e0aa9a2007-08-15 10:32:08 -0600747len_err:
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600748 dev_err(&dev->dev, "unknown tag %#x length %d\n",
749 tag, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750 break;
751 }
752
753 /* continue to the next tag */
754 if (p[0] & LARGE_TAG)
755 p += len + 3;
756 else
757 p += len + 1;
758 }
759
Bjorn Helgaasaf11cb22008-04-28 16:34:12 -0600760 dev_err(&dev->dev, "no end tag in resource structure\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761
762 return NULL;
763}
764
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765/*
766 * Core Parsing Functions
767 */
768
Thomas Renninger2bb9a6b2008-02-06 01:40:03 -0800769int __init pnpbios_parse_data_stream(struct pnp_dev *dev,
770 struct pnp_bios_node *node)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771{
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700772 unsigned char *p = (char *)node->data;
773 unsigned char *end = (char *)(node->data + node->size);
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700774
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600775 p = pnpbios_parse_allocated_resource_data(dev, p, end);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700776 if (!p)
777 return -EIO;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700778 p = pnpbios_parse_resource_option_data(p, end, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779 if (!p)
780 return -EIO;
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700781 p = pnpbios_parse_compatible_ids(p, end, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 if (!p)
783 return -EIO;
784 return 0;
785}
786
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600787int pnpbios_read_resources_from_node(struct pnp_dev *dev,
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700788 struct pnp_bios_node *node)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789{
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700790 unsigned char *p = (char *)node->data;
791 unsigned char *end = (char *)(node->data + node->size);
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700792
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600793 p = pnpbios_parse_allocated_resource_data(dev, p, end);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700794 if (!p)
795 return -EIO;
796 return 0;
797}
798
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600799int pnpbios_write_resources_to_node(struct pnp_dev *dev,
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700800 struct pnp_bios_node *node)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700801{
Bjorn Helgaas9dd78462007-07-26 10:41:20 -0700802 unsigned char *p = (char *)node->data;
803 unsigned char *end = (char *)(node->data + node->size);
Bjorn Helgaas07d4e9a2007-07-26 10:41:21 -0700804
Bjorn Helgaas4ab55d82008-04-28 16:34:06 -0600805 p = pnpbios_encode_allocated_resource_data(dev, p, end);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806 if (!p)
807 return -EIO;
808 return 0;
809}