summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/i386/shared/pci/pcibios.c
diff options
context:
space:
mode:
Diffstat (limited to 'c/src/lib/libbsp/i386/shared/pci/pcibios.c')
-rw-r--r--c/src/lib/libbsp/i386/shared/pci/pcibios.c499
1 files changed, 499 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/i386/shared/pci/pcibios.c b/c/src/lib/libbsp/i386/shared/pci/pcibios.c
new file mode 100644
index 0000000000..483e5df2a9
--- /dev/null
+++ b/c/src/lib/libbsp/i386/shared/pci/pcibios.c
@@ -0,0 +1,499 @@
+/*
+ * This software is Copyright (C) 1998 by T.sqware - all rights limited
+ * It is provided in to the public domain "as is", can be freely modified
+ * as far as this copyight notice is kept unchanged, but does not imply
+ * an endorsement by T.sqware of the product in which it is included.
+ *
+ * $Id$
+ */
+
+#include <rtems.h>
+#include <bsp.h>
+#include <assert.h>
+#include <pcibios.h>
+
+/*
+ * This is simpliest possible PCI BIOS, it assumes that addressing
+ * is flat and that stack is big enough
+ */
+
+
+static int pcibInitialized = 0;
+static unsigned int pcibEntry;
+
+/*
+ * Array to pass data between c and asm parts, at the time of
+ * writing I am not yet that familiar with extended asm feature
+ * of gcc. This code is not on performance path, so we can care
+ * relatively little about performance here
+ */
+static volatile unsigned int pcibExchg[5];
+
+static int pcib_convert_err(int err);
+
+/*
+ * Detects presense of PCI BIOS, returns
+ * error code
+ */
+int
+pcib_init(void)
+{
+ unsigned char *ucp;
+ unsigned char sum;
+ int i;
+
+ pcibInitialized = 0;
+
+ /* First, we have to look for BIOS-32 */
+ for(ucp=(unsigned char *)0xE0000; ucp < (unsigned char *)0xFFFFF; ucp+=0x10)
+ {
+ if(memcmp(ucp, "_32_", 4) != 0)
+ {
+ continue;
+ }
+
+ /* Got signature, check length */
+ if(*(ucp + 9) != 1)
+ {
+ continue;
+ }
+
+ /* Verify checksum */
+ sum = 0;
+ for(i=0; i<16; i++)
+ {
+ sum += *(ucp+i);
+ }
+
+ if(sum == 0)
+ {
+ /* found */
+ break;
+ }
+ }
+
+ if(ucp >= (unsigned char *)0xFFFFF)
+ {
+ /* BIOS-32 not found */
+ assert(0);
+ return PCIB_ERR_NOTPRESENT;
+ }
+
+ /* BIOS-32 found, let us find PCI BIOS */
+ ucp += 4;
+
+ pcibExchg[0] = *(unsigned int *)ucp;
+
+ asm (" pusha"); /* Push all registers */
+ asm (" movl pcibExchg, %edi"); /* Move entry point to esi */
+ asm (" movl $0x49435024, %eax"); /* Move signature to eax */
+ asm (" xorl %ebx, %ebx"); /* Zero ebx */
+ asm (" pushl %cs");
+ asm (" call *%edi"); /* Call entry */
+ asm (" movl %eax, pcibExchg");
+ asm (" movl %ebx, pcibExchg+4");
+ asm (" movl %ecx, pcibExchg+8");
+ asm (" movl %edx, pcibExchg+12");
+ asm (" popa");
+
+ if((pcibExchg[0] & 0xff) != 0)
+ {
+ /* Not found */
+ assert(0);
+ return PCIB_ERR_NOTPRESENT;
+ }
+
+ /* Found PCI entry point */
+ pcibEntry = pcibExchg[1] + pcibExchg[3];
+
+ /* Let us check whether PCI bios is present */
+ pcibExchg[0] = pcibEntry;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %edi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x01, %al");
+ asm (" pushl %cs");
+ asm(" call *%edi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ebx, pcibExchg+4");
+ asm(" movl %ecx, pcibExchg+8");
+ asm(" movl %edx, pcibExchg+12");
+ asm(" popa");
+
+ if((pcibExchg[0] & 0xff00) != 0)
+ {
+ /* Not found */
+ assert(0);
+ return PCIB_ERR_NOTPRESENT;
+ }
+
+ if(pcibExchg[3] != 0x20494350)
+ {
+ /* Signature does not match */
+ assert(0);
+ return PCIB_ERR_NOTPRESENT;
+ }
+
+ /* Success */
+
+ pcibInitialized = 1;
+ return PCIB_ERR_SUCCESS;
+}
+
+/*
+ * Find specified device and return its signature: combination
+ * of bus number, device number and function number
+ */
+int
+pcib_find_by_devid(int vendorId, int devId, int idx, int *sig)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = vendorId;
+ pcibExchg[2] = devId;
+ pcibExchg[3] = idx;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %edi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x02, %al");
+ asm(" movl pcibExchg+4, %edx");
+ asm(" movl pcibExchg+8, %ecx");
+ asm(" movl pcibExchg+12, %esi");
+ asm(" pushl %cs");
+ asm(" call *%edi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ebx, pcibExchg+4");
+ asm(" popa");
+
+ *sig = pcibExchg[1] & 0xffff;
+
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+}
+
+/*
+ * Find specified class code return device signature: combination
+ * of bus number, device number and function number
+ */
+int
+pcib_find_by_class(int classCode, int idx, int *sig)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = classCode;
+ pcibExchg[2] = idx;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %edi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x03, %al");
+ asm(" movl pcibExchg+4, %ecx");
+ asm(" movl pcibExchg+8, %esi");
+ asm(" pushl %cs");
+ asm(" call *%edi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ebx, pcibExchg+4");
+ asm(" popa");
+
+ if((pcibExchg[0] & 0xff00) != 0)
+ {
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+ }
+
+ *sig = pcibExchg[1] & 0xffff;
+
+ return PCIB_ERR_SUCCESS;
+}
+
+
+
+/*
+ * Generate Special Cycle
+ */
+int
+pcib_special_cycle(int busNo, int data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = busNo << 8;
+ pcibExchg[2] = data;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %edi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x06, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edx");
+ asm(" pushl %cs");
+ asm(" call *%edi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ebx, pcibExchg+4");
+ asm(" popa");
+
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+}
+
+
+/*
+ * Read byte from config space
+ */
+int
+pcib_conf_read8(int sig, int off, unsigned char *data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = sig;
+ pcibExchg[2] = off;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %esi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x08, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edi");
+ asm(" pushl %cs");
+ asm(" call *%esi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ecx, pcibExchg+4");
+ asm(" popa");
+
+ if((pcibExchg[0] & 0xff00) != 0)
+ {
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+ }
+
+ *data = (unsigned char)pcibExchg[1] & 0xff;
+
+ return PCIB_ERR_SUCCESS;
+}
+
+
+/*
+ * Read word from config space
+ */
+int
+pcib_conf_read16(int sig, int off, unsigned short *data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = sig;
+ pcibExchg[2] = off;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %esi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x09, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edi");
+ asm(" pushl %cs");
+ asm(" call *%esi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ecx, pcibExchg+4");
+ asm(" popa");
+
+ if((pcibExchg[0] & 0xff00) != 0)
+ {
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+ }
+
+ *data = (unsigned short)pcibExchg[1] & 0xffff;
+
+ return PCIB_ERR_SUCCESS;
+}
+
+
+/*
+ * Read dword from config space
+ */
+int
+pcib_conf_read32(int sig, int off, unsigned int *data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = sig;
+ pcibExchg[2] = off;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %esi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x0a, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edi");
+ asm(" pushl %cs");
+ asm(" call *%esi");
+ asm(" movl %eax, pcibExchg");
+ asm(" movl %ecx, pcibExchg+4");
+ asm(" popa");
+
+ if((pcibExchg[0] & 0xff00) != 0)
+ {
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+ }
+
+ *data = (unsigned int)pcibExchg[1];
+
+ return PCIB_ERR_SUCCESS;
+}
+
+
+/*
+ * Write byte into config space
+ */
+int
+pcib_conf_write8(int sig, int off, unsigned int data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = sig;
+ pcibExchg[2] = off;
+ pcibExchg[3] = data & 0xff;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %esi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x0b, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edi");
+ asm(" movl pcibExchg+12, %ecx");
+ asm(" pushl %cs");
+ asm(" call *%esi");
+ asm(" movl %eax, pcibExchg");
+ asm(" popa");
+
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+}
+
+/*
+ * Write word into config space
+ */
+int
+pcib_conf_write16(int sig, int off, unsigned int data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = sig;
+ pcibExchg[2] = off;
+ pcibExchg[3] = data & 0xffff;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %esi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x0c, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edi");
+ asm(" movl pcibExchg+12, %ecx");
+ asm(" pushl %cs");
+ asm(" call *%esi");
+ asm(" movl %eax, pcibExchg");
+ asm(" popa");
+
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+}
+
+
+
+/*
+ * Write dword into config space
+ */
+int
+pcib_conf_write32(int sig, int off, unsigned int data)
+{
+ if(!pcibInitialized)
+ {
+ assert(0);
+ return PCIB_ERR_UNINITIALIZED;
+ }
+
+ pcibExchg[0] = pcibEntry;
+ pcibExchg[1] = sig;
+ pcibExchg[2] = off;
+ pcibExchg[3] = data;
+
+ asm(" pusha");
+ asm(" movl pcibExchg, %esi");
+ asm(" movb $0xb1, %ah");
+ asm(" movb $0x0d, %al");
+ asm(" movl pcibExchg+4, %ebx");
+ asm(" movl pcibExchg+8, %edi");
+ asm(" movl pcibExchg+12, %ecx");
+ asm(" pushl %cs");
+ asm(" call *%esi");
+ asm(" movl %eax, pcibExchg");
+ asm(" popa");
+
+ return pcib_convert_err((pcibExchg[0] >> 8) & 0xff);
+}
+
+
+static int
+pcib_convert_err(int err)
+{
+ switch(err & 0xff)
+ {
+ case 0:
+ return PCIB_ERR_SUCCESS;
+ case 0x81:
+ return PCIB_ERR_NOFUNC;
+ case 0x83:
+ return PCIB_ERR_BADVENDOR;
+ case 0x86:
+ return PCIB_ERR_DEVNOTFOUND;
+ case 0x87:
+ return PCIB_ERR_BADREG;
+ default:
+ assert(0);
+ break;
+ }
+ return PCIB_ERR_NOFUNC;
+}
+
+
+
+
+
+
+
+
+
+
generated by cgit v1.2.3 (git 2.25.1) at 2024-05-07 00:19:22 +0000