Now split out into undirom.c and undiload.c
authorMichael Brown <mcb30@etherboot.org>
Mon, 8 Jan 2007 03:35:51 +0000 (03:35 +0000)
committerMichael Brown <mcb30@etherboot.org>
Mon, 8 Jan 2007 03:35:51 +0000 (03:35 +0000)
src/arch/i386/drivers/bus/pxedrv.c [deleted file]

diff --git a/src/arch/i386/drivers/bus/pxedrv.c b/src/arch/i386/drivers/bus/pxedrv.c
deleted file mode 100644 (file)
index fb0dd79..0000000
+++ /dev/null
@@ -1,324 +0,0 @@
-/*
- * Copyright (C) 2007 Michael Brown <mbrown@fensystems.co.uk>.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of the
- * License, or any later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
- */
-
-#include <stdint.h>
-#include <stdlib.h>
-#include <string.h>
-#include <pxe.h>
-#include <realmode.h>
-#include <bios.h>
-#include <pnpbios.h>
-
-/** @file
- *
- * PXE drivers
- *
- */
-
-static LIST_HEAD ( pxe_drivers );
-
-/**
- * Parse PXE ROM ID structure
- *
- * @v pxedrv           PXE driver
- * @v pxeromid         Offset within ROM to PXE ROM ID structure
- * @ret rc             Return status code
- */
-static int pxedrv_parse_pxeromid ( struct pxe_driver *pxedrv,
-                                  unsigned int pxeromid ) {
-       struct undi_rom_id undi_rom_id;
-       unsigned int undiloader;
-
-       DBGC ( pxedrv, "PXEDRV %p has PXE ROM ID at %04x:%04x\n", pxedrv,
-              pxedrv->rom_segment, pxeromid );
-
-       /* Read PXE ROM ID structure and verify */
-       copy_from_real ( &undi_rom_id, pxedrv->rom_segment, pxeromid,
-                        sizeof ( undi_rom_id ) );
-       if ( undi_rom_id.Signature != UNDI_ROM_ID_SIGNATURE ) {
-               DBGC ( pxedrv, "PXEDRV %p has bad PXE ROM ID signature "
-                      "%08lx\n", pxedrv, undi_rom_id.Signature );
-               return -EINVAL;
-       }
-
-       /* Check for UNDI loader */
-       undiloader = undi_rom_id.UNDILoader;
-       if ( ! undiloader ) {
-               DBGC ( pxedrv, "PXEDRV %p has no UNDI loader\n", pxedrv );
-               return -EINVAL;
-       }
-
-       /* Fill in PXE driver loader fields */
-       pxedrv->loader_entry.segment = pxedrv->rom_segment;
-       pxedrv->loader_entry.offset = undiloader;
-       pxedrv->code_size = undi_rom_id.CodeSize;
-       pxedrv->data_size = undi_rom_id.DataSize;
-
-       DBGC ( pxedrv, "PXEDRV %p has UNDI loader at %04x:%04x "
-              "(code %04x data %04x)\n", pxedrv,
-              pxedrv->loader_entry.segment, pxedrv->loader_entry.offset,
-              pxedrv->code_size, pxedrv->data_size );
-       return 0;
-}
-
-/**
- * Parse PCI expansion header
- *
- * @v pxedrv           PXE driver
- * @v pcirheader       Offset within ROM to PCI expansion header
- */
-static int pxedrv_parse_pcirheader ( struct pxe_driver *pxedrv,
-                                    unsigned int pcirheader ) {
-       struct pcir_header pcir_header;
-
-       DBGC ( pxedrv, "PXEDRV %p has PCI expansion header at %04x:%04x\n",
-              pxedrv, pxedrv->rom_segment, pcirheader );
-
-       /* Read PCI expansion header and verify */
-       copy_from_real ( &pcir_header, pxedrv->rom_segment, pcirheader,
-                        sizeof ( pcir_header ) );
-       if ( pcir_header.signature != PCIR_SIGNATURE ) {
-               DBGC ( pxedrv, "PXEDRV %p has bad PCI expansion header "
-                      "signature %08lx\n", pxedrv, pcir_header.signature );
-               return -EINVAL;
-       }
-
-       /* Fill in PXE driver PCI device fields */
-       pxedrv->bus_type = PCI_NIC;
-       pxedrv->bus_id.pci.vendor_id = pcir_header.vendor_id;
-       pxedrv->bus_id.pci.device_id = pcir_header.device_id;
-
-       DBGC ( pxedrv, "PXEDRV %p is for PCI devices %04x:%04x\n", pxedrv,
-              pxedrv->bus_id.pci.vendor_id, pxedrv->bus_id.pci.device_id );
-       return 0;
-       
-}
-
-/**
- * Create PXE driver for expansion ROM
- *
- * @v rom_segment      ROM segment address
- * @ret rc             Return status code
- */
-static int pxedrv_probe_rom ( unsigned int rom_segment ) {
-       struct pxe_driver *pxedrv = NULL;
-       struct undi_rom rom;
-       size_t rom_len;
-       unsigned int pxeromid;
-       unsigned int pcirheader;
-       int rc;
-
-       /* Read expansion ROM header and verify */
-       copy_from_real ( &rom, rom_segment, 0, sizeof ( rom ) );
-       if ( rom.Signature != ROM_SIGNATURE ) {
-               rc = -EINVAL;
-               goto err;
-       }
-       rom_len = ( rom.ROMLength * 512 );
-
-       /* Allocate memory for PXE driver */
-       pxedrv = malloc ( sizeof ( *pxedrv ) );
-       if ( ! pxedrv ) {
-               DBG ( "Could not allocate PXE driver structure\n" );
-               rc = -ENOMEM;
-               goto err;
-       }
-       memset ( pxedrv, 0, sizeof ( *pxedrv ) );
-       DBGC ( pxedrv, "PXEDRV %p trying expansion ROM at %04x:0000 (%zdkB)\n",
-              pxedrv, rom_segment, ( rom_len / 1024 ) );
-       pxedrv->rom_segment = rom_segment;
-
-       /* Check for and parse PXE ROM ID */
-       pxeromid = rom.PXEROMID;
-       if ( ! pxeromid ) {
-               DBGC ( pxedrv, "PXEDRV %p has no PXE ROM ID\n", pxedrv );
-               rc = -EINVAL;
-               goto err;
-       }
-       if ( pxeromid > rom_len ) {
-               DBGC ( pxedrv, "PXEDRV %p PXE ROM ID outside ROM\n", pxedrv );
-               rc = -EINVAL;
-               goto err;
-       }
-       if ( ( rc = pxedrv_parse_pxeromid ( pxedrv, pxeromid ) ) != 0 )
-               goto err;
-
-       /* Parse PCIR header, if present */
-       pcirheader = rom.PCIRHeader;
-       if ( pcirheader )
-               pxedrv_parse_pcirheader ( pxedrv, pcirheader );
-
-       /* Add to PXE driver list and return */
-       DBGC ( pxedrv, "PXEDRV %p registered\n", pxedrv );
-       list_add ( &pxedrv->list, &pxe_drivers );
-       return 0;
-
- err:
-       free ( pxedrv );
-       return rc;
-}
-
-/**
- * Create PXE drivers for all possible expansion ROMs
- *
- * @ret 
- */
-static void pxedrv_probe_all_roms ( void ) {
-       static int probed = 0;
-       unsigned int rom_segment;
-
-       /* Perform probe only once */
-       if ( probed )
-               return;
-
-       DBG ( "Scanning for PXE expansion ROMs\n" );
-
-       /* Scan through expansion ROM region at 2kB intervals */
-       for ( rom_segment = 0xc000 ; rom_segment < 0x10000 ;
-             rom_segment += 0x80 ) {
-               pxedrv_probe_rom ( rom_segment );
-       }
-
-       probed = 1;
-}
-
-/**
- * Find PXE driver for PCI device
- *
- * @v vendor_id                PCI vendor ID
- * @v device_id                PCI device ID
- * @v rombase          ROM base address, or 0 for any
- * @ret pxedrv         PXE driver, or NULL
- */
-struct pxe_driver * pxedrv_find_pci_driver ( unsigned int vendor_id,
-                                            unsigned int device_id,
-                                            unsigned int rombase ) {
-       struct pxe_driver *pxedrv;
-
-       pxedrv_probe_all_roms();
-
-       list_for_each_entry ( pxedrv, &pxe_drivers, list ) {
-               if ( pxedrv->bus_type != PCI_NIC )
-                       continue;
-               if ( pxedrv->bus_id.pci.vendor_id != vendor_id )
-                       continue;
-               if ( pxedrv->bus_id.pci.device_id != device_id )
-                       continue;
-               if ( rombase && ( ( pxedrv->rom_segment << 4 ) != rombase ) )
-                       continue;
-               DBGC ( pxedrv, "PXEDRV %p matched PCI %04x:%04x (%08x)\n",
-                      pxedrv, vendor_id, device_id, rombase );
-               return pxedrv;
-       }
-
-       DBG ( "No PXE driver matched PCI %04x:%04x (%08x)\n",
-             vendor_id, device_id, rombase );
-       return NULL;
-}
-
-/** Parameter block for calling UNDI loader */
-static struct s_UNDI_LOADER __data16 ( undi_loader );
-#define undi_loader __use_data16 ( undi_loader )
-
-/** UNDI loader entry point */
-static SEGOFF16_t __data16 ( undi_loader_entry );
-#define undi_loader_entry __use_data16 ( undi_loader_entry )
-
-/**
- * Call UNDI loader to create a pixie
- *
- * @v pxedrv           PXE driver
- * @v pxe              PXE device to be created
- * @v pci_busdevfn     PCI bus:dev.fn (PCI devices only), or 0
- * @v isapnp_csn       ISAPnP Card Select Number, or -1U
- * @v isapnp_read_port ISAPnP read port, or -1U
- * @ret rc             Return status code
- */
-static int pxedrv_load ( struct pxe_driver *pxedrv, struct pxe_device *pxe,
-                        unsigned int pci_busdevfn, unsigned int isapnp_csn,
-                        unsigned int isapnp_read_port ) {
-       int pnpbios_offset;
-       uint16_t fbms;
-       unsigned int fbms_seg;
-       int discard;
-       uint16_t exit;
-       int rc;
-
-       /* Record device location information */
-       memset ( &undi_loader, 0, sizeof ( undi_loader ) );
-       undi_loader.AX = pci_busdevfn;
-       undi_loader.BX = isapnp_csn;
-       undi_loader.DX = isapnp_read_port;
-
-       /* Set up PnP BIOS pointer, if PnP BIOS present */
-       pnpbios_offset = find_pnp_bios();
-       if ( pnpbios_offset >= 0 ) {
-               undi_loader.ES = BIOS_SEG;
-               undi_loader.DI = pnpbios_offset;
-       }
-
-       /* Allocate base memory for PXE stack */
-       get_real ( fbms, BDA_SEG, BDA_FBMS );
-       fbms_seg = ( fbms << 6 );
-       fbms_seg -= ( ( pxedrv->data_size + 0x0f ) >> 4 );
-       undi_loader.UNDI_DS = fbms_seg;
-       fbms_seg -= ( ( pxedrv->code_size + 0x0f ) >> 4 );
-       undi_loader.UNDI_CS = fbms_seg;
-       DBGC ( pxedrv, "PXEDRV %p loading to CS %04x and DS %04x\n", pxedrv,
-              undi_loader.UNDI_CS, undi_loader.UNDI_DS );
-
-       /* Call loader */
-       undi_loader_entry = pxedrv->loader_entry;
-       __asm__ __volatile__ ( REAL_CODE ( "pushw %%ds\n\t"
-                                          "pushw %w0\n\t"
-                                          "lcall *%c3\n\t"
-                                          "addw $4, %%sp\n\t" )
-                              : "=a" ( exit ), "=r" ( discard )
-                              : "0" ( & __from_data16 ( undi_loader ) ),
-                                "p" ( & __from_data16 ( undi_loader_entry )));
-       if ( exit != PXENV_EXIT_SUCCESS ) {
-               rc = -undi_loader.Status;
-               if ( rc == 0 ) /* Paranoia */
-                       rc = -EIO;
-               DBGC ( pxedrv, "PXEDRV %p loader failed: %s\n", pxedrv,
-                      strerror ( rc ) );
-               return rc;
-       }
-
-       /* Update free base memory counter */
-       fbms = ( fbms_seg >> 6 );
-       put_real ( fbms, BDA_SEG, BDA_FBMS );
-
-       /* Record location of pixie in PXE device structure */
-       pxe->pxenv = undi_loader.PXENVptr;
-       pxe->ppxe = undi_loader.PXEptr;
-       return 0;
-}
-
-/**
- * Call UNDI loader to create a pixie
- *
- * @v pxedrv           PXE driver
- * @v pxe              PXE device to be created
- * @v pci_busdevfn     PCI bus:dev.fn
- * @ret rc             Return status code
- */
-int pxedrv_load_pci ( struct pxe_driver *pxedrv, struct pxe_device *pxe,
-                     unsigned int bus, unsigned int devfn ) {
-       return pxedrv_load ( pxedrv, pxe, ( ( bus << 8 ) | devfn ), -1U, -1U );
-}