^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * rsparser.c - parses and encodes pnpbios resource data streams
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/ctype.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/pnp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #ifdef CONFIG_PCI
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) inline void pcibios_penalize_isa_irq(int irq, int active)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #endif /* CONFIG_PCI */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include "../base.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include "pnpbios.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) /* standard resource tags */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define SMALL_TAG_PNPVERNO 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define SMALL_TAG_LOGDEVID 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define SMALL_TAG_COMPATDEVID 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define SMALL_TAG_IRQ 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define SMALL_TAG_DMA 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define SMALL_TAG_STARTDEP 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define SMALL_TAG_ENDDEP 0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define SMALL_TAG_PORT 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define SMALL_TAG_FIXEDPORT 0x09
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define SMALL_TAG_VENDOR 0x0e
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define SMALL_TAG_END 0x0f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define LARGE_TAG 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define LARGE_TAG_MEM 0x81
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define LARGE_TAG_ANSISTR 0x82
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define LARGE_TAG_UNICODESTR 0x83
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define LARGE_TAG_VENDOR 0x84
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define LARGE_TAG_MEM32 0x85
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define LARGE_TAG_FIXEDMEM32 0x86
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) * Resource Data Stream Format:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) * Allocated Resources (required)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) * end tag ->
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) * Resource Configuration Options (optional)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) * end tag ->
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) * Compitable Device IDs (optional)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) * final end tag ->
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) * Allocated Resources
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) static void pnpbios_parse_allocated_ioresource(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) int start, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) int flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) int end = start + len - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) if (len <= 0 || end >= 0x10003)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) flags |= IORESOURCE_DISABLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) pnp_add_io_resource(dev, start, end, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static void pnpbios_parse_allocated_memresource(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) int start, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) int flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) int end = start + len - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) if (len <= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) flags |= IORESOURCE_DISABLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) pnp_add_mem_resource(dev, start, end, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) static unsigned char *pnpbios_parse_allocated_resource_data(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) unsigned char *end)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) unsigned int len, tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) int io, size, mask, i, flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) pnp_dbg(&dev->dev, "parse allocated resources\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) pnp_init_resources(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) while ((char *)p < (char *)end) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) /* determine the type of tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) if (p[0] & LARGE_TAG) { /* large tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) len = (p[2] << 8) | p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) tag = p[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) } else { /* small tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) len = p[0] & 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) tag = ((p[0] >> 3) & 0x0f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) switch (tag) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) case LARGE_TAG_MEM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) if (len != 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) io = *(short *)&p[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) size = *(short *)&p[10];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) pnpbios_parse_allocated_memresource(dev, io, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) case LARGE_TAG_ANSISTR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) /* ignore this for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) case LARGE_TAG_VENDOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) /* do nothing */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) case LARGE_TAG_MEM32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) if (len != 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) io = *(int *)&p[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) size = *(int *)&p[16];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) pnpbios_parse_allocated_memresource(dev, io, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) case LARGE_TAG_FIXEDMEM32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) if (len != 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) io = *(int *)&p[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) size = *(int *)&p[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) pnpbios_parse_allocated_memresource(dev, io, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) case SMALL_TAG_IRQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) if (len < 2 || len > 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) io = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) mask = p[1] + p[2] * 256;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) for (i = 0; i < 16; i++, mask = mask >> 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) if (mask & 0x01)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) io = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (io != -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) pcibios_penalize_isa_irq(io, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) flags = IORESOURCE_DISABLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) pnp_add_irq_resource(dev, io, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) case SMALL_TAG_DMA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) if (len != 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) io = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) mask = p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) for (i = 0; i < 8; i++, mask = mask >> 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) if (mask & 0x01)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) io = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) if (io == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) flags = IORESOURCE_DISABLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) pnp_add_dma_resource(dev, io, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) case SMALL_TAG_PORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (len != 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) io = p[2] + p[3] * 256;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) size = p[7];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) pnpbios_parse_allocated_ioresource(dev, io, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) case SMALL_TAG_VENDOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) /* do nothing */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) case SMALL_TAG_FIXEDPORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) if (len != 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) io = p[1] + p[2] * 256;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) size = p[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) pnpbios_parse_allocated_ioresource(dev, io, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) case SMALL_TAG_END:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) p = p + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) return (unsigned char *)p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) default: /* an unknown tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) len_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) dev_err(&dev->dev, "unknown tag %#x length %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) tag, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) /* continue to the next tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) if (p[0] & LARGE_TAG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) p += len + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) p += len + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) dev_err(&dev->dev, "no end tag in resource structure\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) * Resource Configuration Options
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) static __init void pnpbios_parse_mem_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) resource_size_t min, max, align, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) unsigned char flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) min = ((p[5] << 8) | p[4]) << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) max = ((p[7] << 8) | p[6]) << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) align = (p[9] << 8) | p[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) len = ((p[11] << 8) | p[10]) << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) flags = p[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) pnp_register_mem_resource(dev, option_flags, min, max, align, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) static __init void pnpbios_parse_mem32_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) resource_size_t min, max, align, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) unsigned char flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) min = (p[7] << 24) | (p[6] << 16) | (p[5] << 8) | p[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) max = (p[11] << 24) | (p[10] << 16) | (p[9] << 8) | p[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) align = (p[15] << 24) | (p[14] << 16) | (p[13] << 8) | p[12];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) len = (p[19] << 24) | (p[18] << 16) | (p[17] << 8) | p[16];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) flags = p[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) pnp_register_mem_resource(dev, option_flags, min, max, align, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) static __init void pnpbios_parse_fixed_mem32_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) resource_size_t base, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) unsigned char flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) base = (p[7] << 24) | (p[6] << 16) | (p[5] << 8) | p[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) len = (p[11] << 24) | (p[10] << 16) | (p[9] << 8) | p[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) flags = p[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) pnp_register_mem_resource(dev, option_flags, base, base, 0, len, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) static __init void pnpbios_parse_irq_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) unsigned long bits;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) pnp_irq_mask_t map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) unsigned char flags = IORESOURCE_IRQ_HIGHEDGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) bits = (p[2] << 8) | p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) bitmap_zero(map.bits, PNP_IRQ_NR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) bitmap_copy(map.bits, &bits, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) if (size > 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) flags = p[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) pnp_register_irq_resource(dev, option_flags, &map, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) static __init void pnpbios_parse_dma_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) pnp_register_dma_resource(dev, option_flags, p[1], p[2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) static __init void pnpbios_parse_port_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) resource_size_t min, max, align, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) unsigned char flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) min = (p[3] << 8) | p[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) max = (p[5] << 8) | p[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) align = p[6];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) len = p[7];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) flags = p[1] ? IORESOURCE_IO_16BIT_ADDR : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) pnp_register_port_resource(dev, option_flags, min, max, align, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) static __init void pnpbios_parse_fixed_port_option(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) unsigned char *p, int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) unsigned int option_flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) resource_size_t base, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) base = (p[2] << 8) | p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) len = p[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) pnp_register_port_resource(dev, option_flags, base, base, 0, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) IORESOURCE_IO_FIXED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) static __init unsigned char *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) pnpbios_parse_resource_option_data(unsigned char *p, unsigned char *end,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) unsigned int len, tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) int priority;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) unsigned int option_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) pnp_dbg(&dev->dev, "parse resource options\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) option_flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) while ((char *)p < (char *)end) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) /* determine the type of tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) if (p[0] & LARGE_TAG) { /* large tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) len = (p[2] << 8) | p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) tag = p[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) } else { /* small tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) len = p[0] & 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) tag = ((p[0] >> 3) & 0x0f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) switch (tag) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) case LARGE_TAG_MEM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) if (len != 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) pnpbios_parse_mem_option(dev, p, len, option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) case LARGE_TAG_MEM32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) if (len != 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) pnpbios_parse_mem32_option(dev, p, len, option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) case LARGE_TAG_FIXEDMEM32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) if (len != 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) pnpbios_parse_fixed_mem32_option(dev, p, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) case SMALL_TAG_IRQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (len < 2 || len > 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) pnpbios_parse_irq_option(dev, p, len, option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) case SMALL_TAG_DMA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) if (len != 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) pnpbios_parse_dma_option(dev, p, len, option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) case SMALL_TAG_PORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) if (len != 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) pnpbios_parse_port_option(dev, p, len, option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) case SMALL_TAG_VENDOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) /* do nothing */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) case SMALL_TAG_FIXEDPORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) if (len != 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) pnpbios_parse_fixed_port_option(dev, p, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) option_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) case SMALL_TAG_STARTDEP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) if (len > 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) priority = PNP_RES_PRIORITY_ACCEPTABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) if (len > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) priority = p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) option_flags = pnp_new_dependent_set(dev, priority);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) case SMALL_TAG_ENDDEP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) if (len != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) option_flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) case SMALL_TAG_END:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) return p + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) default: /* an unknown tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) len_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) dev_err(&dev->dev, "unknown tag %#x length %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) tag, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) /* continue to the next tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) if (p[0] & LARGE_TAG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) p += len + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) p += len + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) dev_err(&dev->dev, "no end tag in resource structure\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) * Compatible Device IDs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) static unsigned char *pnpbios_parse_compatible_ids(unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) unsigned char *end,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) int len, tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) u32 eisa_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) char id[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) struct pnp_id *dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) while ((char *)p < (char *)end) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) /* determine the type of tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) if (p[0] & LARGE_TAG) { /* large tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) len = (p[2] << 8) | p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) tag = p[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) } else { /* small tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) len = p[0] & 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) tag = ((p[0] >> 3) & 0x0f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) switch (tag) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) case LARGE_TAG_ANSISTR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) strncpy(dev->name, p + 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) len >= PNP_NAME_LEN ? PNP_NAME_LEN - 2 : len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) dev->name[len >=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) PNP_NAME_LEN ? PNP_NAME_LEN - 1 : len] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) case SMALL_TAG_COMPATDEVID: /* compatible ID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) if (len != 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) eisa_id = p[1] | p[2] << 8 | p[3] << 16 | p[4] << 24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) pnp_eisa_id_to_string(eisa_id & PNP_EISA_ID_MASK, id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) dev_id = pnp_add_id(dev, id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) if (!dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) case SMALL_TAG_END:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) p = p + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) return (unsigned char *)p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) default: /* an unknown tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) len_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) dev_err(&dev->dev, "unknown tag %#x length %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) tag, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) /* continue to the next tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) if (p[0] & LARGE_TAG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) p += len + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) p += len + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) dev_err(&dev->dev, "no end tag in resource structure\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) * Allocated Resource Encoding
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) static void pnpbios_encode_mem(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) unsigned long base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) unsigned long len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) if (pnp_resource_enabled(res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) base = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) len = resource_size(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) base = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) p[4] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) p[5] = ((base >> 8) >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) p[6] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) p[7] = ((base >> 8) >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) p[10] = (len >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) p[11] = ((len >> 8) >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) pnp_dbg(&dev->dev, " encode mem %#lx-%#lx\n", base, base + len - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) static void pnpbios_encode_mem32(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) unsigned long base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) unsigned long len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) if (pnp_resource_enabled(res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) base = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) len = resource_size(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) base = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) p[4] = base & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) p[5] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) p[6] = (base >> 16) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) p[7] = (base >> 24) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) p[8] = base & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) p[9] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) p[10] = (base >> 16) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) p[11] = (base >> 24) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) p[16] = len & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) p[17] = (len >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) p[18] = (len >> 16) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) p[19] = (len >> 24) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) pnp_dbg(&dev->dev, " encode mem32 %#lx-%#lx\n", base, base + len - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) static void pnpbios_encode_fixed_mem32(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) unsigned long base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) unsigned long len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) if (pnp_resource_enabled(res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) base = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) len = resource_size(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) base = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) p[4] = base & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) p[5] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) p[6] = (base >> 16) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) p[7] = (base >> 24) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) p[8] = len & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) p[9] = (len >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) p[10] = (len >> 16) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) p[11] = (len >> 24) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) pnp_dbg(&dev->dev, " encode fixed_mem32 %#lx-%#lx\n", base,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) base + len - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) static void pnpbios_encode_irq(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) unsigned long map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) if (pnp_resource_enabled(res))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) map = 1 << res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) map = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) p[1] = map & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) p[2] = (map >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) pnp_dbg(&dev->dev, " encode irq mask %#lx\n", map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) static void pnpbios_encode_dma(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) unsigned long map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) if (pnp_resource_enabled(res))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) map = 1 << res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) map = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) p[1] = map & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) pnp_dbg(&dev->dev, " encode dma mask %#lx\n", map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) static void pnpbios_encode_port(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) unsigned long base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) unsigned long len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) if (pnp_resource_enabled(res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) base = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) len = resource_size(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) base = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) p[2] = base & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) p[3] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) p[4] = base & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) p[5] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) p[7] = len & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) pnp_dbg(&dev->dev, " encode io %#lx-%#lx\n", base, base + len - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) static void pnpbios_encode_fixed_port(struct pnp_dev *dev, unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) struct resource *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) unsigned long base = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) unsigned long len = resource_size(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) if (pnp_resource_enabled(res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) base = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) len = resource_size(res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) base = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) p[1] = base & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) p[2] = (base >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) p[3] = len & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) pnp_dbg(&dev->dev, " encode fixed_io %#lx-%#lx\n", base,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) base + len - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) static unsigned char *pnpbios_encode_allocated_resource_data(struct pnp_dev
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) unsigned char *p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) unsigned char *end)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) unsigned int len, tag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) int port = 0, irq = 0, dma = 0, mem = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) while ((char *)p < (char *)end) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) /* determine the type of tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) if (p[0] & LARGE_TAG) { /* large tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) len = (p[2] << 8) | p[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) tag = p[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) } else { /* small tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) len = p[0] & 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) tag = ((p[0] >> 3) & 0x0f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) switch (tag) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) case LARGE_TAG_MEM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) if (len != 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) pnpbios_encode_mem(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) pnp_get_resource(dev, IORESOURCE_MEM, mem));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) mem++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) case LARGE_TAG_MEM32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) if (len != 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) pnpbios_encode_mem32(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) pnp_get_resource(dev, IORESOURCE_MEM, mem));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) mem++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) case LARGE_TAG_FIXEDMEM32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) if (len != 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) pnpbios_encode_fixed_mem32(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) pnp_get_resource(dev, IORESOURCE_MEM, mem));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) mem++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) case SMALL_TAG_IRQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) if (len < 2 || len > 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) pnpbios_encode_irq(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) pnp_get_resource(dev, IORESOURCE_IRQ, irq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) irq++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) case SMALL_TAG_DMA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) if (len != 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) pnpbios_encode_dma(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) pnp_get_resource(dev, IORESOURCE_DMA, dma));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) dma++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) case SMALL_TAG_PORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) if (len != 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) pnpbios_encode_port(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) pnp_get_resource(dev, IORESOURCE_IO, port));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) port++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) case SMALL_TAG_VENDOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) /* do nothing */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) case SMALL_TAG_FIXEDPORT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) if (len != 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) goto len_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) pnpbios_encode_fixed_port(dev, p,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) pnp_get_resource(dev, IORESOURCE_IO, port));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) port++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) case SMALL_TAG_END:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) p = p + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) return (unsigned char *)p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) default: /* an unknown tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) len_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) dev_err(&dev->dev, "unknown tag %#x length %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) tag, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) /* continue to the next tag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) if (p[0] & LARGE_TAG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) p += len + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) p += len + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) dev_err(&dev->dev, "no end tag in resource structure\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) * Core Parsing Functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) int __init pnpbios_parse_data_stream(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) struct pnp_bios_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) unsigned char *p = (char *)node->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) unsigned char *end = (char *)(node->data + node->size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) p = pnpbios_parse_allocated_resource_data(dev, p, end);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) p = pnpbios_parse_resource_option_data(p, end, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) p = pnpbios_parse_compatible_ids(p, end, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) int pnpbios_read_resources_from_node(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) struct pnp_bios_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) unsigned char *p = (char *)node->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) unsigned char *end = (char *)(node->data + node->size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) p = pnpbios_parse_allocated_resource_data(dev, p, end);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) int pnpbios_write_resources_to_node(struct pnp_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) struct pnp_bios_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) unsigned char *p = (char *)node->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) unsigned char *end = (char *)(node->data + node->size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) p = pnpbios_encode_allocated_resource_data(dev, p, end);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags