liliana/r-link-uboot
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
r-link-uboot/board/MAI/bios_emulator/scitech/src/v86bios/int.c
wdenk 8bde7f776c * Code cleanup: 
- remove trailing white space, trailing empty lines, C++ comments, etc.
  - split cmd_boot.c (separate cmd_bdinfo.c and cmd_load.c)

* Patches by Kenneth Johansson, 25 Jun 2003:
  - major rework of command structure
    (work done mostly by Michal Cendrowski and Joakim Kristiansen)
2003-06-27 21:31:46 +00:00

239 lines
8.0 KiB
C
Raw Blame History

/*
* Copyright 1999 Egbert Eich
*
* Permission to use, copy, modify, distribute, and sell this software and its
* documentation for any purpose is hereby granted without fee, provided that
* the above copyright notice appear in all copies and that both that
* copyright notice and this permission notice appear in supporting
* documentation, and that the name of the authors not be used in
* advertising or publicity pertaining to distribution of the software without
* specific, written prior permission. The authors makes no representations
* about the suitability of this software for any purpose. It is provided
* "as is" without express or implied warranty.
*
* THE AUTHORS DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
* INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
* EVENT SHALL THE AUTHORS BE LIABLE FOR ANY SPECIAL, INDIRECT OR
* CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
* DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
* PERFORMANCE OF THIS SOFTWARE.
*/
#include "debug.h"
#if defined(__alpha__) || defined (__ia64__)
#include <sys/io.h>
#endif
#include "v86bios.h"
#include "AsmMacros.h"
#include "pci.h"
static int int1A_handler(struct regs86 *regs);
static int int42_handler(int num, struct regs86 *regs);
int
int_handler(int num, struct regs86 *regs)
{
switch (num) {
case 0x10:
case 0x42:
return (int42_handler(num,regs));
case 0x1A:
return (int1A_handler(regs));
default:
return 0;
}
return 0;
}
static int
int42_handler(int num,struct regs86 *regs)
{
unsigned char c;
CARD32 val;
i_printf("int 0x%x: ax:0x%lx bx:0x%lx cx:0x%lx dx:0x%lx\n",num,
regs->eax,regs->ebx, regs->ecx, regs->edx);
/*
* video bios has modified these -
* leave it to the video bios to do this
*/
val = getIntVect(num);
if (val != 0xF000F065)
return 0;
if ((regs->ebx & 0xff) == 0x32) {
switch (regs->eax & 0xFFFF) {
case 0x1200:
i_printf("enabling video\n");
c = inb(0x3cc);
c |= 0x02;
outb(0x3c2,c);
return 1;
case 0x1201:
i_printf("disabling video\n");
c = inb(0x3cc);
c &= ~0x02;
outb(0x3c2,c);
return 1;
default:
}
}
if (num == 0x42)
return 1;
else
return 0;
}
#define SUCCESSFUL 0x00
#define DEVICE_NOT_FOUND 0x86
#define BAD_REGISTER_NUMBER 0x87
static int
int1A_handler(struct regs86 *regs)
{
CARD32 Slot;
PciStructPtr pPci;
if (! CurrentPci) return 0; /* oops */
i_printf("int 0x1a: ax=0x%lx bx=0x%lx cx=0x%lx dx=0x%lx di=0x%lx"
" si=0x%lx\n", regs->eax,regs->ebx,regs->ecx,regs->edx,
regs->edi,regs->esi);
switch (regs->eax & 0xFFFF) {
case 0xb101:
regs->eax &= 0xFF00; /* no config space/special cycle support */
regs->edx = 0x20494350; /* " ICP" */
regs->ebx = 0x0210; /* Version 2.10 */
regs->ecx &= 0xFF00;
regs->ecx |= (pciMaxBus & 0xFF); /* Max bus number in system */
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
i_printf("ax=0x%lx dx=0x%lx bx=0x%lx cx=0x%lx flags=0x%lx\n",
regs->eax,regs->edx,regs->ebx,regs->ecx,regs->eflags);
return 1;
case 0xb102:
if (((regs->edx & 0xFFFF) == CurrentPci->VendorID) &&
((regs->ecx & 0xFFFF) == CurrentPci->DeviceID) &&
(regs->esi == 0)) {
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
regs->ebx = pciSlotBX(CurrentPci);
}
else if (Config.ShowAllDev &&
(pPci = findPciDevice(regs->edx,regs->ecx,regs->esi)) != NULL) {
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
regs->ebx = pciSlotBX(pPci);
} else {
regs->eax = (regs->eax & 0x00FF) | (DEVICE_NOT_FOUND << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx bx=0x%lx flags=0x%lx\n",
regs->eax,regs->ebx,regs->eflags);
return 1;
case 0xb103:
if (((regs->ecx & 0xFF) == CurrentPci->Interface) &&
(((regs->ecx & 0xFF00) >> 8) == CurrentPci->SubClass) &&
(((regs->ecx & 0xFFFF0000) >> 16) == CurrentPci->BaseClass) &&
((regs->esi & 0xff) == 0)) {
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->ebx = pciSlotBX(CurrentPci);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
}
else if (Config.ShowAllDev
&& (pPci = findPciClass(regs->ecx & 0xFF, (regs->ecx & 0xff00) >> 8,
(regs->ecx & 0xffff0000) >> 16, regs->esi)) != NULL) {
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->ebx = pciSlotBX(pPci);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (DEVICE_NOT_FOUND << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx flags=0x%lx\n",regs->eax,regs->eflags);
return 1;
case 0xb108:
i_printf("Slot=0x%x\n",CurrentPci->Slot.l);
if ((Slot = findPci(regs->ebx))) {
regs->ecx &= 0xFFFFFF00;
regs->ecx |= PciRead8(regs->edi,Slot);
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (BAD_REGISTER_NUMBER << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx cx=0x%lx flags=0x%lx\n",
regs->eax,regs->ecx,regs->eflags);
return 1;
case 0xb109:
i_printf("Slot=0x%x\n",CurrentPci->Slot.l);
if ((Slot = findPci(regs->ebx))) {
regs->ecx &= 0xFFFF0000;
regs->ecx |= PciRead16(regs->edi,Slot);
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (BAD_REGISTER_NUMBER << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx cx=0x%lx flags=0x%lx\n",
regs->eax,regs->ecx,regs->eflags);
return 1;
case 0xb10a:
i_printf("Slot=0x%x\n",CurrentPci->Slot.l);
if ((Slot = findPci(regs->ebx))) {
regs->ecx &= 0;
regs->ecx |= PciRead32(regs->edi,Slot);
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (BAD_REGISTER_NUMBER << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx cx=0x%lx flags=0x%lx\n",
regs->eax,regs->ecx,regs->eflags);
return 1;
case 0xb10b:
i_printf("Slot=0x%x\n",CurrentPci->Slot.l);
if ((Slot = findPci(regs->ebx))) {
PciWrite8(regs->edi,(CARD8)regs->ecx,Slot);
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (BAD_REGISTER_NUMBER << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx flags=0x%lx\n", regs->eax,regs->eflags);
return 1;
case 0xb10c:
i_printf("Slot=0x%x\n",CurrentPci->Slot.l);
if ((Slot = findPci(regs->ebx))) {
PciWrite16(regs->edi,(CARD16)regs->ecx,Slot);
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (BAD_REGISTER_NUMBER << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx flags=0x%lx\n", regs->eax,regs->eflags);
return 1;
case 0xb10d:
i_printf("Slot=0x%x\n",CurrentPci->Slot.l);
if ((Slot = findPci(regs->ebx))) {
PciWrite32(regs->edi,(CARD32)regs->ecx,Slot);
regs->eax = (regs->eax & 0x00FF) | (SUCCESSFUL << 8);
regs->eflags &= ~((unsigned long)0x01); /* clear carry flag */
} else {
regs->eax = (regs->eax & 0x00FF) | (BAD_REGISTER_NUMBER << 8);
regs->eflags |= ((unsigned long)0x01); /* set carry flag */
}
i_printf("ax=0x%lx flags=0x%lx\n", regs->eax,regs->eflags);
return 1;
default:
return 0;
}
}
Reference in New Issue View Git Blame Copy Permalink