Annotation of qemu/roms/seabios/src/pcibios.c, revision 1.1.1.3

1.1       root        1: // PCI BIOS (int 1a/b1) calls
                      2: //
                      3: // Copyright (C) 2008  Kevin O'Connor <[email protected]>
                      4: // Copyright (C) 2002  MandrakeSoft S.A.
                      5: //
                      6: // This file may be distributed under the terms of the GNU LGPLv3 license.
                      7: 
                      8: #include "types.h" // u32
                      9: #include "util.h" // handle_1ab1
                     10: #include "pci.h" // pci_config_readl
                     11: #include "bregs.h" // struct bregs
                     12: #include "biosvar.h" // GET_EBDA
                     13: #include "pci_regs.h" // PCI_VENDOR_ID
                     14: 
1.1.1.2   root       15: // romlayout.S
1.1.1.3 ! root       16: extern void entry_bios32(void);
        !            17: extern void entry_pcibios32(void);
1.1.1.2   root       18: 
1.1       root       19: #define RET_FUNC_NOT_SUPPORTED 0x81
                     20: #define RET_BAD_VENDOR_ID      0x83
                     21: #define RET_DEVICE_NOT_FOUND   0x86
                     22: #define RET_BUFFER_TOO_SMALL   0x89
                     23: 
                     24: // installation check
                     25: static void
                     26: handle_1ab101(struct bregs *regs)
                     27: {
                     28:     regs->al = 0x01; // Flags - "Config Mechanism #1" supported.
                     29:     regs->bx = 0x0210; // PCI version 2.10
1.1.1.3 ! root       30:     regs->cl = GET_GLOBAL(MaxPCIBus);
1.1       root       31:     regs->edx = 0x20494350; // "PCI "
1.1.1.3 ! root       32:     regs->edi = (u32)entry_pcibios32 + BUILD_BIOS_ADDR;
1.1       root       33:     set_code_success(regs);
                     34: }
                     35: 
                     36: // find pci device
                     37: static void
                     38: handle_1ab102(struct bregs *regs)
                     39: {
                     40:     u32 id = (regs->cx << 16) | regs->dx;
                     41:     int count = regs->si;
1.1.1.3 ! root       42:     int bus = -1;
        !            43:     while (bus < GET_GLOBAL(MaxPCIBus)) {
        !            44:         bus++;
        !            45:         int bdf;
        !            46:         foreachbdf(bdf, bus) {
        !            47:             u32 v = pci_config_readl(bdf, PCI_VENDOR_ID);
        !            48:             if (v != id)
        !            49:                 continue;
        !            50:             if (count--)
        !            51:                 continue;
        !            52:             regs->bx = bdf;
        !            53:             set_code_success(regs);
        !            54:             return;
        !            55:         }
1.1       root       56:     }
                     57:     set_code_invalid(regs, RET_DEVICE_NOT_FOUND);
                     58: }
                     59: 
                     60: // find class code
                     61: static void
                     62: handle_1ab103(struct bregs *regs)
                     63: {
                     64:     int count = regs->si;
                     65:     u32 classprog = regs->ecx;
1.1.1.3 ! root       66:     int bus = -1;
        !            67:     while (bus < GET_GLOBAL(MaxPCIBus)) {
        !            68:         bus++;
        !            69:         int bdf;
        !            70:         foreachbdf(bdf, bus) {
        !            71:             u32 v = pci_config_readl(bdf, PCI_CLASS_REVISION);
        !            72:             if ((v>>8) != classprog)
        !            73:                 continue;
        !            74:             if (count--)
        !            75:                 continue;
        !            76:             regs->bx = bdf;
        !            77:             set_code_success(regs);
        !            78:             return;
        !            79:         }
1.1       root       80:     }
                     81:     set_code_invalid(regs, RET_DEVICE_NOT_FOUND);
                     82: }
                     83: 
                     84: // read configuration byte
                     85: static void
                     86: handle_1ab108(struct bregs *regs)
                     87: {
                     88:     regs->cl = pci_config_readb(regs->bx, regs->di);
                     89:     set_code_success(regs);
                     90: }
                     91: 
                     92: // read configuration word
                     93: static void
                     94: handle_1ab109(struct bregs *regs)
                     95: {
                     96:     regs->cx = pci_config_readw(regs->bx, regs->di);
                     97:     set_code_success(regs);
                     98: }
                     99: 
                    100: // read configuration dword
                    101: static void
                    102: handle_1ab10a(struct bregs *regs)
                    103: {
                    104:     regs->ecx = pci_config_readl(regs->bx, regs->di);
                    105:     set_code_success(regs);
                    106: }
                    107: 
                    108: // write configuration byte
                    109: static void
                    110: handle_1ab10b(struct bregs *regs)
                    111: {
                    112:     pci_config_writeb(regs->bx, regs->di, regs->cl);
                    113:     set_code_success(regs);
                    114: }
                    115: 
                    116: // write configuration word
                    117: static void
                    118: handle_1ab10c(struct bregs *regs)
                    119: {
                    120:     pci_config_writew(regs->bx, regs->di, regs->cx);
                    121:     set_code_success(regs);
                    122: }
                    123: 
                    124: // write configuration dword
                    125: static void
                    126: handle_1ab10d(struct bregs *regs)
                    127: {
                    128:     pci_config_writel(regs->bx, regs->di, regs->ecx);
                    129:     set_code_success(regs);
                    130: }
                    131: 
                    132: // get irq routing options
                    133: static void
                    134: handle_1ab10e(struct bregs *regs)
                    135: {
                    136:     struct pir_header *pirtable_g = (void*)(GET_GLOBAL(PirOffset) + 0);
                    137:     if (! pirtable_g) {
                    138:         set_code_invalid(regs, RET_FUNC_NOT_SUPPORTED);
                    139:         return;
                    140:     }
                    141: 
                    142:     struct param_s {
                    143:         u16 size;
                    144:         u16 buf_off;
                    145:         u16 buf_seg;
                    146:     } *param_far = (void*)(regs->di+0);
                    147: 
                    148:     // Validate and update size.
                    149:     u16 bufsize = GET_FARVAR(regs->es, param_far->size);
                    150:     u16 pirsize = GET_GLOBAL(pirtable_g->size) - sizeof(struct pir_header);
                    151:     SET_FARVAR(regs->es, param_far->size, pirsize);
                    152:     if (bufsize < pirsize) {
                    153:         set_code_invalid(regs, RET_BUFFER_TOO_SMALL);
                    154:         return;
                    155:     }
                    156: 
                    157:     // Get dest buffer.
                    158:     void *buf_far = (void*)(GET_FARVAR(regs->es, param_far->buf_off)+0);
                    159:     u16 buf_seg = GET_FARVAR(regs->es, param_far->buf_seg);
                    160: 
                    161:     // Memcpy pir table slots to dest buffer.
                    162:     memcpy_far(buf_seg, buf_far
1.1.1.2   root      163:                , get_global_seg()
                    164:                , (void*)(pirtable_g->slots) + get_global_offset()
1.1       root      165:                , pirsize);
                    166: 
                    167:     // XXX - bochs bios sets bx to (1 << 9) | (1 << 11)
                    168:     regs->bx = GET_GLOBAL(pirtable_g->exclusive_irqs);
                    169:     set_code_success(regs);
                    170: }
                    171: 
                    172: static void
                    173: handle_1ab1XX(struct bregs *regs)
                    174: {
                    175:     set_code_unimplemented(regs, RET_FUNC_NOT_SUPPORTED);
                    176: }
                    177: 
                    178: void
                    179: handle_1ab1(struct bregs *regs)
                    180: {
                    181:     //debug_stub(regs);
                    182: 
                    183:     if (! CONFIG_PCIBIOS) {
                    184:         set_invalid(regs);
                    185:         return;
                    186:     }
                    187: 
                    188:     switch (regs->al) {
                    189:     case 0x01: handle_1ab101(regs); break;
                    190:     case 0x02: handle_1ab102(regs); break;
                    191:     case 0x03: handle_1ab103(regs); break;
                    192:     case 0x08: handle_1ab108(regs); break;
                    193:     case 0x09: handle_1ab109(regs); break;
                    194:     case 0x0a: handle_1ab10a(regs); break;
                    195:     case 0x0b: handle_1ab10b(regs); break;
                    196:     case 0x0c: handle_1ab10c(regs); break;
                    197:     case 0x0d: handle_1ab10d(regs); break;
                    198:     case 0x0e: handle_1ab10e(regs); break;
                    199:     default:   handle_1ab1XX(regs); break;
                    200:     }
                    201: }
1.1.1.2   root      202: 
                    203: 
                    204: /****************************************************************
                    205:  * 32bit interface
                    206:  ****************************************************************/
                    207: 
                    208: // Entry point for 32bit pci bios functions.
                    209: void VISIBLE32SEG
                    210: handle_pcibios32(struct bregs *regs)
                    211: {
                    212:     debug_enter(regs, DEBUG_HDL_pcibios32);
                    213:     handle_1ab1(regs);
                    214: }
                    215: 
                    216: struct bios32_s {
                    217:     u32 signature;
                    218:     u32 entry;
                    219:     u8 version;
                    220:     u8 length;
                    221:     u8 checksum;
                    222:     u8 reserved[5];
                    223: } PACKED;
                    224: 
                    225: struct bios32_s BIOS32HEADER __aligned(16) VAR16EXPORT = {
                    226:     .signature = 0x5f32335f, // _32_
                    227:     .length = sizeof(BIOS32HEADER) / 16,
                    228: };
                    229: 
                    230: void
                    231: bios32_setup(void)
                    232: {
                    233:     dprintf(3, "init bios32\n");
                    234: 
1.1.1.3 ! root      235:     BIOS32HEADER.entry = (u32)entry_bios32;
1.1.1.2   root      236:     BIOS32HEADER.checksum -= checksum(&BIOS32HEADER, sizeof(BIOS32HEADER));
                    237: }

unix.superglobalmegacorp.com

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.