sysadmin/ipxe
1
0
Fork 0
mirror of https://github.com/ipxe/ipxe synced 2026-02-14 02:31:26 +03:00
Code Issues Packages Projects Releases Wiki Activity

We now correctly use logical devices.

Browse Source
This commit is contained in:
Michael Brown
2005-04-15 15:37:39 +00:00
parent 8e375c638d
commit e6e43a2f2f
2 changed files with 113 additions and 89 deletions
Download Patch File Download Diff File Expand all files Collapse all files

193
src/drivers/bus/isapnp.c
View File

@@ -190,14 +190,14 @@ static void isapnp_send_key ( void ) {
* Compute ISAPnP identifier checksum * Compute ISAPnP identifier checksum
* *
*/ */
static uint8_t isapnp_checksum ( union isapnp_identifier *identifier ) { static uint8_t isapnp_checksum ( struct isapnp_identifier *identifier ) {
int i, j; int i, j;
uint8_t lfsr; uint8_t lfsr;
uint8_t byte; uint8_t byte;
lfsr = ISAPNP_LFSR_SEED; lfsr = ISAPNP_LFSR_SEED;
for ( i = 0 ; i < 8 ; i++ ) { for ( i = 0 ; i < 8 ; i++ ) {
byte = identifier->bytes[i]; byte = ( (char *) identifier )[i];
for ( j = 0 ; j < 8 ; j++ ) { for ( j = 0 ; j < 8 ; j++ ) {
lfsr = isapnp_lfsr_next ( lfsr, byte ); lfsr = isapnp_lfsr_next ( lfsr, byte );
byte >>= 1; byte >>= 1;
@@ -242,6 +242,38 @@ static void isapnp_peek ( uint8_t *buf, size_t bytes ) {
} }
} }
/*
* Scan through the resource data until we find a particular tag, and
* read its contents into a buffer.
*
* It is the caller's responsibility to ensure that buf is large
* enough to contain a tag of the requested size.
*
*/
static int isapnp_find_tag ( uint8_t wanted_tag, uint8_t *buf ) {
uint8_t tag;
uint16_t len;
do {
tag = isapnp_peek_byte();
if ( ISAPNP_IS_SMALL_TAG ( tag ) ) {
len = ISAPNP_SMALL_TAG_LEN ( tag );
tag = ISAPNP_SMALL_TAG_NAME ( tag );
} else {
len = isapnp_peek_byte() + ( isapnp_peek_byte() << 8 );
tag = ISAPNP_LARGE_TAG_NAME ( tag );
}
DBG ( "ISAPnP read tag %hhx len %hhx\n", tag, len );
if ( tag == wanted_tag ) {
isapnp_peek ( buf, len );
return 1;
} else {
isapnp_peek ( NULL, len );
}
} while ( tag != ISAPNP_TAG_END );
return 0;
}
/* /*
* Try isolating ISAPnP cards at the current read port. Return the * Try isolating ISAPnP cards at the current read port. Return the
* number of ISAPnP cards found. * number of ISAPnP cards found.
@@ -251,7 +283,7 @@ static void isapnp_peek ( uint8_t *buf, size_t bytes ) {
* *
*/ */
static int isapnp_try_isolate ( void ) { static int isapnp_try_isolate ( void ) {
union isapnp_identifier identifier; struct isapnp_identifier identifier;
int i, j, seen55aa; int i, j, seen55aa;
uint16_t data; uint16_t data;
uint8_t byte; uint8_t byte;
@@ -306,7 +338,7 @@ static int isapnp_try_isolate ( void ) {
} }
byte <<= 1; byte <<= 1;
} }
identifier.bytes[i] = byte; ( (char *) &identifier )[i] = byte;
if ( byte ) { if ( byte ) {
seen55aa = 1; seen55aa = 1;
} }
@@ -319,7 +351,7 @@ static int isapnp_try_isolate ( void ) {
/* Give the device a CSN */ /* Give the device a CSN */
isapnp_max_csn++; isapnp_max_csn++;
DBG ( "ISAPnP isolation found device " DBG ( "ISAPnP isolation found card "
"%hhx:%hhx:%hhx:%hhx:%hhx:%hhx:%hhx:%hhx " "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx:%hhx:%hhx "
"(checksum %hhx), assigning CSN %hhx\n", "(checksum %hhx), assigning CSN %hhx\n",
identifier.bytes[0], identifier.bytes[1], identifier.bytes[0], identifier.bytes[1],
@@ -342,7 +374,7 @@ static int isapnp_try_isolate ( void ) {
isapnp_wait_for_key (); isapnp_wait_for_key ();
/* Return number of cards found */ /* Return number of cards found */
DBG ( "ISAPnP found %d devices at read port %hx\n", isapnp_read_port ); DBG ( "ISAPnP found %d cards at read port %hx\n", isapnp_read_port );
return isapnp_max_csn; return isapnp_max_csn;
} }
@@ -374,7 +406,8 @@ static void isapnp_isolate ( void ) {
* *
*/ */
static int fill_isapnp_device ( struct isapnp_device *isapnp ) { static int fill_isapnp_device ( struct isapnp_device *isapnp ) {
union isapnp_identifier identifier; unsigned int i;
struct isapnp_logdevid logdevid;
/* Ensure that all ISAPnP cards have CSNs allocated to them, /* Ensure that all ISAPnP cards have CSNs allocated to them,
* if we haven't already done so. * if we haven't already done so.
@@ -383,38 +416,42 @@ static int fill_isapnp_device ( struct isapnp_device *isapnp ) {
isapnp_isolate(); isapnp_isolate();
} }
/* Wake the specified CSN */ /* Wake the card */
isapnp_wait_for_key (); isapnp_wait_for_key ();
isapnp_send_key (); isapnp_send_key ();
isapnp_wake ( isapnp->csn ); isapnp_wake ( isapnp->csn );
/* Read the identifier. Do *not* verify the checksum, because /* Skip past the card identifier */
* the PnP ISA spec explicitly states in section 4.5 that the isapnp_peek ( NULL, sizeof ( struct isapnp_identifier ) );
* checksum is invalid except when read via the serial
* isolation protocol. (This is presumably to allow for lazy /* Find the Logical Device ID tag corresponding to this device */
* card designers who implement the checksum using the LFSR for ( i = 0 ; i <= isapnp->logdev ; i++ ) {
* only and can't be bothered to write the same value into the if ( ! isapnp_find_tag ( ISAPNP_TAG_LOGDEVID,
* EPROM). ( char * ) &logdevid ) ) {
*/ /* No tag for this device */
isapnp_peek ( identifier.bytes, sizeof ( identifier ) ); return 0;
}
}
/* Read information from identifier structure */ /* Read information from identifier structure */
isapnp->vendor_id = identifier.vendor_id; isapnp->vendor_id = logdevid.vendor_id;
isapnp->prod_id = identifier.prod_id; isapnp->prod_id = logdevid.prod_id;
/* I/O addresses and IRQs are associated with logical devices, /* Select the logical device */
* not with cards. They will be assigned when isapnp_logicaldevice ( isapnp->logdev );
* activate_isapnp_device() is called.
*/ /* Read the current ioaddr and irqno */
isapnp->ioaddr = 0; isapnp->ioaddr = isapnp_read_iobase ( 0 );
isapnp->irqno = 0; isapnp->irqno = isapnp_read_irqno ( 0 );
/* Return all cards to Wait for Key state */ /* Return all cards to Wait for Key state */
isapnp_wait_for_key (); isapnp_wait_for_key ();
DBG ( "ISAPnP found CSN %hhx ID %hx:%hx (\"%s\")\n", DBG ( "ISAPnP found device %hhx.%hhx ID %hx:%hx (\"%s\"), "
isapnp->csn, isapnp->vendor_id, isapnp->prod_id, "base %hx irq %d\n",
isa_id_string ( isapnp->vendor_id, isapnp->prod_id ) ); isapnp->csn, isapnp->logdev, isapnp->vendor_id, isapnp->prod_id,
isa_id_string ( isapnp->vendor_id, isapnp->prod_id ),
isapnp->ioaddr, isapnp->irqno );
return 1; return 1;
} }
@@ -438,31 +475,40 @@ int find_isapnp_device ( struct isapnp_device *isapnp,
* left off. * left off.
*/ */
for ( ; isapnp->csn <= isapnp_max_csn ; isapnp->csn++ ) { for ( ; isapnp->csn <= isapnp_max_csn ; isapnp->csn++ ) {
/* If we've already used this device, skip it */ for ( ; isapnp->logdev <= 0xff ; isapnp->logdev++ ) {
if ( isapnp->already_tried ) { /* If we've already used this device, skip it */
isapnp->already_tried = 0; if ( isapnp->already_tried ) {
continue; isapnp->already_tried = 0;
} continue;
}
/* Fill in device parameters */
if ( ! fill_isapnp_device ( isapnp ) ) {
continue;
}
/* Compare against driver's ID list */
for ( i = 0 ; i < driver->id_count ; i++ ) {
struct isapnp_id *id = &driver->ids[i];
if ( ( isapnp->vendor_id == id->vendor_id ) && /* Fill in device parameters */
( ISA_PROD_ID ( isapnp->prod_id ) == if ( ! fill_isapnp_device ( isapnp ) ) {
ISA_PROD_ID ( id->prod_id ) ) ) { /* If fill_isapnp_device fails, assume
DBG ( "Device %s (driver %s) matches ID %s\n", * that we've reached the last logical
id->name, driver->name, * device on this card, and proceed to
isa_id_string ( isapnp->vendor_id, * the next card.
isapnp->prod_id ) ); */
isapnp->name = id->name; isapnp->logdev = 0;
isapnp->already_tried = 1; break;
return 1; }
/* Compare against driver's ID list */
for ( i = 0 ; i < driver->id_count ; i++ ) {
struct isapnp_id *id = &driver->ids[i];
if ( ( isapnp->vendor_id == id->vendor_id ) &&
( ISA_PROD_ID ( isapnp->prod_id ) ==
ISA_PROD_ID ( id->prod_id ) ) ) {
DBG ( "Device %s (driver %s) "
"matches ID %s\n",
id->name, driver->name,
isa_id_string( isapnp->vendor_id,
isapnp->prod_id ) );
isapnp->name = id->name;
isapnp->already_tried = 1;
return 1;
}
} }
} }
} }
@@ -492,8 +538,7 @@ int find_isapnp_boot_device ( struct dev *dev, struct isapnp_driver *driver ) {
} }
/* /*
* Activate a logical function on an ISAPnP device, and fill in the * Activate or deactivate an ISAPnP device
* ioaddr and irqno fields in the isapnp struct.
* *
* This routine simply activates the device in its current * This routine simply activates the device in its current
* configuration. It does not attempt any kind of resource * configuration. It does not attempt any kind of resource
@@ -501,46 +546,20 @@ int find_isapnp_boot_device ( struct dev *dev, struct isapnp_driver *driver ) {
* *
*/ */
void activate_isapnp_device ( struct isapnp_device *isapnp, void activate_isapnp_device ( struct isapnp_device *isapnp,
uint8_t logdev ) { int activate ) {
/* Wake the device */ /* Wake the card and select the logical device */
isapnp_wait_for_key (); isapnp_wait_for_key ();
isapnp_send_key (); isapnp_send_key ();
isapnp_wake ( isapnp->csn ); isapnp_wake ( isapnp->csn );
isapnp_logicaldevice ( isapnp->logdev );
/* Select the specified logical device */ /* Activate/deactivate the logical device */
isapnp_activate ( logdev ); isapnp_activate ( activate );
isapnp_delay(); isapnp_delay();
/* Read the current ioaddr and irqno */
isapnp->ioaddr = isapnp_read_iobase ( 0 );
isapnp->irqno = isapnp_read_irqno ( 0 );
/* Return all cards to Wait for Key state */ /* Return all cards to Wait for Key state */
isapnp_wait_for_key (); isapnp_wait_for_key ();
DBG ( "ISAPnP activated logical device %hhx on CSN %hhx " DBG ( "ISAPnP activated device %hhx.%hhx\n",
"with ioaddr %hx and IRQ %d\n", isapnp->csn, isapnp->logdev );
logdev, isapnp->csn, isapnp->ioaddr, isapnp->irqno );
}
/*
* Deactivate a logical function on an ISAPnP device
*
*/
void deactivate_isapnp_device ( struct isapnp_device *isapnp,
uint8_t logdev ) {
/* Wake the device */
isapnp_wait_for_key ();
isapnp_send_key ();
isapnp_wake ( isapnp->csn );
/* Select the specified logical device */
isapnp_deactivate ( logdev );
isapnp_delay();
/* Return all cards to Wait for Key state */
isapnp_wait_for_key ();
DBG ( "ISAPnP deactivated logical device %hhx on CSN %hhx\n",
logdev, isapnp->csn );
} }

9
src/include/isapnp.h
View File

@@ -81,7 +81,10 @@
/* The LFSR used for the initiation key and for checksumming */ /* The LFSR used for the initiation key and for checksumming */
#define ISAPNP_LFSR_SEED 0x6a #define ISAPNP_LFSR_SEED 0x6a
/* Short Tags */ /* Small tags */
#define ISAPNP_IS_SMALL_TAG(tag) ( ! ( (tag) & 0x80 ) )
#define ISAPNP_SMALL_TAG_NAME(tag) ( ( (tag) >> 3 ) & 0xf )
#define ISAPNP_SMALL_TAG_LEN(tag) ( ( (tag) & 0x7 ) )
#define ISAPNP_TAG_PNPVERNO 0x01 #define ISAPNP_TAG_PNPVERNO 0x01
#define ISAPNP_TAG_LOGDEVID 0x02 #define ISAPNP_TAG_LOGDEVID 0x02
#define ISAPNP_TAG_COMPATDEVID 0x03 #define ISAPNP_TAG_COMPATDEVID 0x03
@@ -97,7 +100,9 @@
#define ISAPNP_TAG_RSVDSHORTD 0x0D #define ISAPNP_TAG_RSVDSHORTD 0x0D
#define ISAPNP_TAG_VENDORSHORT 0x0E #define ISAPNP_TAG_VENDORSHORT 0x0E
#define ISAPNP_TAG_END 0x0F #define ISAPNP_TAG_END 0x0F
/* Long Tags */ /* Large tags */
#define ISAPNP_IS_LARGE_TAG(tag) ( ( (tag) & 0x80 ) )
#define ISAPNP_LARGE_TAG_NAME(tag) ( (tag) & 0x7f )
#define ISAPNP_TAG_MEMRANGE 0x81 #define ISAPNP_TAG_MEMRANGE 0x81
#define ISAPNP_TAG_ANSISTR 0x82 #define ISAPNP_TAG_ANSISTR 0x82
#define ISAPNP_TAG_UNICODESTR 0x83 #define ISAPNP_TAG_UNICODESTR 0x83