Linux-2.6.12-rc2

[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / char / rio / rioboot.c

/*
** -----------------------------------------------------------------------------
**
**  Perle Specialix driver for Linux
**  Ported from existing RIO Driver for SCO sources.
 *
 *  (C) 1990 - 2000 Specialix International Ltd., Byfleet, Surrey, 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
 *      (at your option) 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.
**
**      Module          : rioboot.c
**      SID             : 1.3
**      Last Modified   : 11/6/98 10:33:36
**      Retrieved       : 11/6/98 10:33:48
**
**  ident @(#)rioboot.c 1.3
**
** -----------------------------------------------------------------------------
*/

#ifdef SCCS_LABELS
static char *_rioboot_c_sccs_ = "@(#)rioboot.c  1.3";
#endif

#include <linux/module.h>
#include <linux/slab.h>
#include <linux/errno.h>
#include <linux/interrupt.h>
#include <asm/io.h>
#include <asm/system.h>
#include <asm/string.h>
#include <asm/semaphore.h>


#include <linux/termios.h>
#include <linux/serial.h>

#include <linux/generic_serial.h>



#include "linux_compat.h"
#include "rio_linux.h"
#include "typdef.h"
#include "pkt.h"
#include "daemon.h"
#include "rio.h"
#include "riospace.h"
#include "top.h"
#include "cmdpkt.h"
#include "map.h"
#include "riotypes.h"
#include "rup.h"
#include "port.h"
#include "riodrvr.h"
#include "rioinfo.h"
#include "func.h"
#include "errors.h"
#include "pci.h"

#include "parmmap.h"
#include "unixrup.h"
#include "board.h"
#include "host.h"
#include "error.h"
#include "phb.h"
#include "link.h"
#include "cmdblk.h"
#include "route.h"

static int RIOBootComplete( struct rio_info *p, struct Host *HostP, uint Rup, struct PktCmd *PktCmdP );

static uchar
RIOAtVec2Ctrl[] =
{
        /* 0 */  INTERRUPT_DISABLE,
        /* 1 */  INTERRUPT_DISABLE,
        /* 2 */  INTERRUPT_DISABLE,
        /* 3 */  INTERRUPT_DISABLE,
        /* 4 */  INTERRUPT_DISABLE,
        /* 5 */  INTERRUPT_DISABLE,
        /* 6 */  INTERRUPT_DISABLE,
        /* 7 */  INTERRUPT_DISABLE,
        /* 8 */  INTERRUPT_DISABLE,
        /* 9 */  IRQ_9|INTERRUPT_ENABLE,
        /* 10 */ INTERRUPT_DISABLE,
        /* 11 */ IRQ_11|INTERRUPT_ENABLE,
        /* 12 */ IRQ_12|INTERRUPT_ENABLE,
        /* 13 */ INTERRUPT_DISABLE,
        /* 14 */ INTERRUPT_DISABLE,
        /* 15 */ IRQ_15|INTERRUPT_ENABLE
};

/*
** Load in the RTA boot code.
*/
int
RIOBootCodeRTA(p, rbp)
struct rio_info *       p;
struct DownLoad *       rbp; 
{
        int offset;

        func_enter ();

        /* Linux doesn't allow you to disable interrupts during a
           "copyin". (Crash when a pagefault occurs). */
        /* disable(oldspl); */
        
        rio_dprintk (RIO_DEBUG_BOOT, "Data at user address 0x%x\n",(int)rbp->DataP);

        /*
        ** Check that we have set asside enough memory for this
        */
        if ( rbp->Count > SIXTY_FOUR_K ) {
                rio_dprintk (RIO_DEBUG_BOOT, "RTA Boot Code Too Large!\n");
                p->RIOError.Error = HOST_FILE_TOO_LARGE;
                /* restore(oldspl); */
                func_exit ();
                return -ENOMEM;
        }

        if ( p->RIOBooting ) {
                rio_dprintk (RIO_DEBUG_BOOT, "RTA Boot Code : BUSY BUSY BUSY!\n");
                p->RIOError.Error = BOOT_IN_PROGRESS;
                /* restore(oldspl); */
                func_exit ();
                return -EBUSY;
        }

        /*
        ** The data we load in must end on a (RTA_BOOT_DATA_SIZE) byte boundary,
        ** so calculate how far we have to move the data up the buffer
        ** to achieve this.
        */
        offset = (RTA_BOOT_DATA_SIZE - (rbp->Count % RTA_BOOT_DATA_SIZE)) % 
                                                        RTA_BOOT_DATA_SIZE;

        /*
        ** Be clean, and clear the 'unused' portion of the boot buffer,
        ** because it will (eventually) be part of the Rta run time environment
        ** and so should be zeroed.
        */
        bzero( (caddr_t)p->RIOBootPackets, offset );

        /*
        ** Copy the data from user space.
        */

        if ( copyin((int)rbp->DataP,((caddr_t)(p->RIOBootPackets))+offset,
                                rbp->Count) ==COPYFAIL ) {
                rio_dprintk (RIO_DEBUG_BOOT, "Bad data copy from user space\n");
                p->RIOError.Error = COPYIN_FAILED;
                /* restore(oldspl); */
                func_exit ();
                return -EFAULT;
        }

        /*
        ** Make sure that our copy of the size includes that offset we discussed
        ** earlier.
        */
        p->RIONumBootPkts = (rbp->Count+offset)/RTA_BOOT_DATA_SIZE;
        p->RIOBootCount   = rbp->Count;

        /* restore(oldspl); */
        func_exit();
        return 0;
}

void rio_start_card_running (struct Host * HostP)
{
        func_enter ();

        switch ( HostP->Type ) {
        case RIO_AT:
                rio_dprintk (RIO_DEBUG_BOOT, "Start ISA card running\n");
                WBYTE(HostP->Control, 
                      BOOT_FROM_RAM | EXTERNAL_BUS_ON
                      | HostP->Mode
                      | RIOAtVec2Ctrl[HostP->Ivec & 0xF] );
                break;
                
#ifdef FUTURE_RELEASE
        case RIO_MCA:
                                /*
                                ** MCA handles IRQ vectors differently, so we don't write 
                                ** them to this register.
                                */
                rio_dprintk (RIO_DEBUG_BOOT, "Start MCA card running\n");
                WBYTE(HostP->Control, McaTpBootFromRam | McaTpBusEnable | HostP->Mode);
                break;

        case RIO_EISA:
                                /*
                                ** EISA is totally different and expects OUTBZs to turn it on.
                                */
                rio_dprintk (RIO_DEBUG_BOOT, "Start EISA card running\n");
                OUTBZ( HostP->Slot, EISA_CONTROL_PORT, HostP->Mode | RIOEisaVec2Ctrl[HostP->Ivec] | EISA_TP_RUN | EISA_TP_BUS_ENABLE | EISA_TP_BOOT_FROM_RAM );
                break;
#endif

        case RIO_PCI:
                                /*
                                ** PCI is much the same as MCA. Everything is once again memory
                                ** mapped, so we are writing to memory registers instead of io
                                ** ports.
                                */
                rio_dprintk (RIO_DEBUG_BOOT, "Start PCI card running\n");
                WBYTE(HostP->Control, PCITpBootFromRam | PCITpBusEnable | HostP->Mode);
                break;
        default:
                rio_dprintk (RIO_DEBUG_BOOT, "Unknown host type %d\n", HostP->Type);
                break;
        }
/* 
        printk (KERN_INFO "Done with starting the card\n");
        func_exit ();
*/
        return;
}

/*
** Load in the host boot code - load it directly onto all halted hosts
** of the correct type.
**
** Put your rubber pants on before messing with this code - even the magic
** numbers have trouble understanding what they are doing here.
*/
int
RIOBootCodeHOST(p, rbp)
struct rio_info *       p;
register struct DownLoad *rbp;
{
        register struct Host *HostP;
        register caddr_t Cad;
        register PARM_MAP *ParmMapP;
        register int RupN;
        int PortN;
        uint host;
        caddr_t StartP;
        BYTE *DestP;
        int wait_count;
        ushort OldParmMap;
        ushort offset;  /* It is very important that this is a ushort */
        /* uint byte; */
        caddr_t DownCode = NULL;
        unsigned long flags;

        HostP = NULL; /* Assure the compiler we've initialized it */
        for ( host=0; host<p->RIONumHosts; host++ ) {
                rio_dprintk (RIO_DEBUG_BOOT, "Attempt to boot host %d\n",host);
                HostP = &p->RIOHosts[host];
                
                rio_dprintk (RIO_DEBUG_BOOT,  "Host Type = 0x%x, Mode = 0x%x, IVec = 0x%x\n",
                    HostP->Type, HostP->Mode, HostP->Ivec);


                if ( (HostP->Flags & RUN_STATE) != RC_WAITING ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "%s %d already running\n","Host",host);
                        continue;
                }

                /*
                ** Grab a 32 bit pointer to the card.
                */
                Cad = HostP->Caddr;

                /*
                ** We are going to (try) and load in rbp->Count bytes.
                ** The last byte will reside at p->RIOConf.HostLoadBase-1;
                ** Therefore, we need to start copying at address
                ** (caddr+p->RIOConf.HostLoadBase-rbp->Count)
                */
                StartP = (caddr_t)&Cad[p->RIOConf.HostLoadBase-rbp->Count];

                rio_dprintk (RIO_DEBUG_BOOT, "kernel virtual address for host is 0x%x\n", (int)Cad );
                rio_dprintk (RIO_DEBUG_BOOT, "kernel virtual address for download is 0x%x\n", (int)StartP);
                rio_dprintk (RIO_DEBUG_BOOT, "host loadbase is 0x%x\n",p->RIOConf.HostLoadBase);
                rio_dprintk (RIO_DEBUG_BOOT, "size of download is 0x%x\n", rbp->Count);

                if ( p->RIOConf.HostLoadBase < rbp->Count ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "Bin too large\n");
                        p->RIOError.Error = HOST_FILE_TOO_LARGE;
                        func_exit ();
                        return -EFBIG;
                }
                /*
                ** Ensure that the host really is stopped.
                ** Disable it's external bus & twang its reset line.
                */
                RIOHostReset( HostP->Type, (struct DpRam *)HostP->CardP, HostP->Slot );

                /*
                ** Copy the data directly from user space to the SRAM.
                ** This ain't going to be none too clever if the download
                ** code is bigger than this segment.
                */
                rio_dprintk (RIO_DEBUG_BOOT, "Copy in code\n");

                /*
                ** PCI hostcard can't cope with 32 bit accesses and so need to copy 
                ** data to a local buffer, and then dripfeed the card.
                */
                if ( HostP->Type == RIO_PCI ) {
                  /* int offset; */

                        DownCode = sysbrk(rbp->Count);
                        if ( !DownCode ) {
                                rio_dprintk (RIO_DEBUG_BOOT, "No system memory available\n");
                                p->RIOError.Error = NOT_ENOUGH_CORE_FOR_PCI_COPY;
                                func_exit ();
                                return -ENOMEM;
                        }
                        bzero(DownCode, rbp->Count);

                        if ( copyin((int)rbp->DataP,DownCode,rbp->Count)==COPYFAIL ) {
                                rio_dprintk (RIO_DEBUG_BOOT, "Bad copyin of host data\n");
                                sysfree( DownCode, rbp->Count );
                                p->RIOError.Error = COPYIN_FAILED;
                                func_exit ();
                                return -EFAULT;
                        }

                        HostP->Copy( DownCode, StartP, rbp->Count );

                        sysfree( DownCode, rbp->Count );
                }
                else if ( copyin((int)rbp->DataP,StartP,rbp->Count)==COPYFAIL ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "Bad copyin of host data\n");
                        p->RIOError.Error = COPYIN_FAILED;
                        func_exit ();
                        return -EFAULT;
                }

                rio_dprintk (RIO_DEBUG_BOOT, "Copy completed\n");

                /*
                **                      S T O P !
                **
                ** Upto this point the code has been fairly rational, and possibly
                ** even straight forward. What follows is a pile of crud that will
                ** magically turn into six bytes of transputer assembler. Normally
                ** you would expect an array or something, but, being me, I have
                ** chosen [been told] to use a technique whereby the startup code
                ** will be correct if we change the loadbase for the code. Which
                ** brings us onto another issue - the loadbase is the *end* of the
                ** code, not the start.
                **
                ** If I were you I wouldn't start from here.
                */

                /*
                ** We now need to insert a short boot section into
                ** the memory at the end of Sram2. This is normally (de)composed
                ** of the last eight bytes of the download code. The
                ** download has been assembled/compiled to expect to be
                ** loaded from 0x7FFF downwards. We have loaded it
                ** at some other address. The startup code goes into the small
                ** ram window at Sram2, in the last 8 bytes, which are really
                ** at addresses 0x7FF8-0x7FFF.
                **
                ** If the loadbase is, say, 0x7C00, then we need to branch to
                ** address 0x7BFE to run the host.bin startup code. We assemble
                ** this jump manually.
                **
                ** The two byte sequence 60 08 is loaded into memory at address
                ** 0x7FFE,F. This is a local branch to location 0x7FF8 (60 is nfix 0,
                ** which adds '0' to the .O register, complements .O, and then shifts
                ** it left by 4 bit positions, 08 is a jump .O+8 instruction. This will
                ** add 8 to .O (which was 0xFFF0), and will branch RELATIVE to the new
                ** location. Now, the branch starts from the value of .PC (or .IP or
                ** whatever the bloody register is called on this chip), and the .PC
                ** will be pointing to the location AFTER the branch, in this case
                ** .PC == 0x8000, so the branch will be to 0x8000+0xFFF8 = 0x7FF8.
                **
                ** A long branch is coded at 0x7FF8. This consists of loading a four
                ** byte offset into .O using nfix (as above) and pfix operators. The
                ** pfix operates in exactly the same way as the nfix operator, but
                ** without the complement operation. The offset, of course, must be
                ** relative to the address of the byte AFTER the branch instruction,
                ** which will be (urm) 0x7FFC, so, our final destination of the branch
                ** (loadbase-2), has to be reached from here. Imagine that the loadbase
                ** is 0x7C00 (which it is), then we will need to branch to 0x7BFE (which
                ** is the first byte of the initial two byte short local branch of the
                ** download code).
                **
                ** To code a jump from 0x7FFC (which is where the branch will start
                ** from) to 0x7BFE, we will need to branch 0xFC02 bytes (0x7FFC+0xFC02)=
                ** 0x7BFE.
                ** This will be coded as four bytes:
                ** 60 2C 20 02
                ** being nfix .O+0
                **         pfix .O+C
                **         pfix .O+0
                **         jump .O+2
                **
                ** The nfix operator is used, so that the startup code will be
                ** compatible with the whole Tp family. (lies, damn lies, it'll never
                ** work in a month of Sundays).
                **
                ** The nfix nyble is the 1s complement of the nyble value you
                ** want to load - in this case we wanted 'F' so we nfix loaded '0'.
                */


                /*
                ** Dest points to the top 8 bytes of Sram2. The Tp jumps
                ** to 0x7FFE at reset time, and starts executing. This is
                ** a short branch to 0x7FF8, where a long branch is coded.
                */

                DestP = (BYTE *)&Cad[0x7FF8];   /* <<<---- READ THE ABOVE COMMENTS */

#define NFIX(N) (0x60 | (N))    /* .O  = (~(.O + N))<<4 */
#define PFIX(N) (0x20 | (N))    /* .O  =   (.O + N)<<4  */
#define JUMP(N) (0x00 | (N))    /* .PC =   .PC + .O      */

                /*
                ** 0x7FFC is the address of the location following the last byte of
                ** the four byte jump instruction.
                ** READ THE ABOVE COMMENTS
                **
                ** offset is (TO-FROM) % MEMSIZE, but with compound buggering about.
                ** Memsize is 64K for this range of Tp, so offset is a short (unsigned,
                ** cos I don't understand 2's complement).
                */
                offset = (p->RIOConf.HostLoadBase-2)-0x7FFC;
                WBYTE( DestP[0] , NFIX(((ushort)(~offset) >> (ushort)12) & 0xF) );
                WBYTE( DestP[1] , PFIX(( offset >> 8) & 0xF) );
                WBYTE( DestP[2] , PFIX(( offset >> 4) & 0xF) );
                WBYTE( DestP[3] , JUMP( offset & 0xF) );

                WBYTE( DestP[6] , NFIX(0) );
                WBYTE( DestP[7] , JUMP(8) );

                rio_dprintk (RIO_DEBUG_BOOT, "host loadbase is 0x%x\n",p->RIOConf.HostLoadBase);
                rio_dprintk (RIO_DEBUG_BOOT, "startup offset is 0x%x\n",offset);

                /*
                ** Flag what is going on
                */
                HostP->Flags &= ~RUN_STATE;
                HostP->Flags |= RC_STARTUP;

                /*
                ** Grab a copy of the current ParmMap pointer, so we
                ** can tell when it has changed.
                */
                OldParmMap = RWORD(HostP->__ParmMapR);

                rio_dprintk (RIO_DEBUG_BOOT, "Original parmmap is 0x%x\n",OldParmMap);

                /*
                ** And start it running (I hope).
                ** As there is nothing dodgy or obscure about the
                ** above code, this is guaranteed to work every time.
                */
                rio_dprintk (RIO_DEBUG_BOOT,  "Host Type = 0x%x, Mode = 0x%x, IVec = 0x%x\n",
                    HostP->Type, HostP->Mode, HostP->Ivec);

                rio_start_card_running(HostP);

                rio_dprintk (RIO_DEBUG_BOOT, "Set control port\n");

                /*
                ** Now, wait for upto five seconds for the Tp to setup the parmmap
                ** pointer:
                */
                for ( wait_count=0; (wait_count<p->RIOConf.StartupTime)&&
                        (RWORD(HostP->__ParmMapR)==OldParmMap); wait_count++ ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "Checkout %d, 0x%x\n",wait_count,RWORD(HostP->__ParmMapR));
                        delay(HostP, HUNDRED_MS);

                }

                /*
                ** If the parmmap pointer is unchanged, then the host code
                ** has crashed & burned in a really spectacular way
                */
                if ( RWORD(HostP->__ParmMapR) == OldParmMap ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "parmmap 0x%x\n", RWORD(HostP->__ParmMapR));
                        rio_dprintk (RIO_DEBUG_BOOT, "RIO Mesg Run Fail\n");

#define HOST_DISABLE \
                HostP->Flags &= ~RUN_STATE; \
                HostP->Flags |= RC_STUFFED; \
                RIOHostReset( HostP->Type, (struct DpRam *)HostP->CardP, HostP->Slot );\
                continue

                        HOST_DISABLE;
                }

                rio_dprintk (RIO_DEBUG_BOOT, "Running 0x%x\n", RWORD(HostP->__ParmMapR));

                /*
                ** Well, the board thought it was OK, and setup its parmmap
                ** pointer. For the time being, we will pretend that this
                ** board is running, and check out what the error flag says.
                */

                /*
                ** Grab a 32 bit pointer to the parmmap structure
                */
                ParmMapP = (PARM_MAP *)RIO_PTR(Cad,RWORD(HostP->__ParmMapR));
                rio_dprintk (RIO_DEBUG_BOOT, "ParmMapP : %x\n", (int)ParmMapP);
                ParmMapP = (PARM_MAP *)((unsigned long)Cad + 
                                                (unsigned long)((RWORD((HostP->__ParmMapR))) & 0xFFFF)); 
                rio_dprintk (RIO_DEBUG_BOOT, "ParmMapP : %x\n", (int)ParmMapP);

                /*
                ** The links entry should be 0xFFFF; we set it up
                ** with a mask to say how many PHBs to use, and 
                ** which links to use.
                */
                if ( (RWORD(ParmMapP->links) & 0xFFFF) != 0xFFFF ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "RIO Mesg Run Fail %s\n", HostP->Name);
                        rio_dprintk (RIO_DEBUG_BOOT, "Links = 0x%x\n",RWORD(ParmMapP->links));
                        HOST_DISABLE;
                }

                WWORD(ParmMapP->links , RIO_LINK_ENABLE);

                /*
                ** now wait for the card to set all the parmmap->XXX stuff
                ** this is a wait of upto two seconds....
                */
                rio_dprintk (RIO_DEBUG_BOOT, "Looking for init_done - %d ticks\n",p->RIOConf.StartupTime);
                HostP->timeout_id = 0;
                for ( wait_count=0; (wait_count<p->RIOConf.StartupTime) && 
                                                !RWORD(ParmMapP->init_done); wait_count++ ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "Waiting for init_done\n");
                        delay(HostP, HUNDRED_MS);
                }
                rio_dprintk (RIO_DEBUG_BOOT, "OK! init_done!\n");

                if (RWORD(ParmMapP->error) != E_NO_ERROR || 
                                                        !RWORD(ParmMapP->init_done) ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "RIO Mesg Run Fail %s\n", HostP->Name);
                        rio_dprintk (RIO_DEBUG_BOOT, "Timedout waiting for init_done\n");
                        HOST_DISABLE;
                }

                rio_dprintk (RIO_DEBUG_BOOT, "Got init_done\n");

                /*
                ** It runs! It runs!
                */
                rio_dprintk (RIO_DEBUG_BOOT, "Host ID %x Running\n",HostP->UniqueNum);

                /*
                ** set the time period between interrupts.
                */
                WWORD(ParmMapP->timer, (short)p->RIOConf.Timer );

                /*
                ** Translate all the 16 bit pointers in the __ParmMapR into
                ** 32 bit pointers for the driver.
                */
                HostP->ParmMapP  =      ParmMapP;
                HostP->PhbP              =      (PHB*)RIO_PTR(Cad,RWORD(ParmMapP->phb_ptr));
                HostP->RupP              =      (RUP*)RIO_PTR(Cad,RWORD(ParmMapP->rups));
                HostP->PhbNumP    = (ushort*)RIO_PTR(Cad,RWORD(ParmMapP->phb_num_ptr));
                HostP->LinkStrP  =      (LPB*)RIO_PTR(Cad,RWORD(ParmMapP->link_str_ptr));

                /*
                ** point the UnixRups at the real Rups
                */
                for ( RupN = 0; RupN<MAX_RUP; RupN++ ) {
                        HostP->UnixRups[RupN].RupP              = &HostP->RupP[RupN];
                        HostP->UnixRups[RupN].Id                  = RupN+1;
                        HostP->UnixRups[RupN].BaseSysPort = NO_PORT;
                        spin_lock_init(&HostP->UnixRups[RupN].RupLock);
                }

                for ( RupN = 0; RupN<LINKS_PER_UNIT; RupN++ ) {
                        HostP->UnixRups[RupN+MAX_RUP].RupP      = &HostP->LinkStrP[RupN].rup;
                        HostP->UnixRups[RupN+MAX_RUP].Id  = 0;
                        HostP->UnixRups[RupN+MAX_RUP].BaseSysPort = NO_PORT;
                        spin_lock_init(&HostP->UnixRups[RupN+MAX_RUP].RupLock);
                }

                /*
                ** point the PortP->Phbs at the real Phbs
                */
                for ( PortN=p->RIOFirstPortsMapped; 
                                PortN<p->RIOLastPortsMapped+PORTS_PER_RTA; PortN++ ) {
                        if ( p->RIOPortp[PortN]->HostP == HostP ) {
                                struct Port *PortP = p->RIOPortp[PortN];
                                struct PHB *PhbP;
                                /* int oldspl; */

                                if ( !PortP->Mapped )
                                        continue;

                                PhbP = &HostP->PhbP[PortP->HostPort];
                                rio_spin_lock_irqsave(&PortP->portSem, flags);

                                PortP->PhbP = PhbP;

                                PortP->TxAdd    = (WORD *)RIO_PTR(Cad,RWORD(PhbP->tx_add));
                                PortP->TxStart  = (WORD *)RIO_PTR(Cad,RWORD(PhbP->tx_start));
                                PortP->TxEnd    = (WORD *)RIO_PTR(Cad,RWORD(PhbP->tx_end));
                                PortP->RxRemove = (WORD *)RIO_PTR(Cad,RWORD(PhbP->rx_remove));
                                PortP->RxStart  = (WORD *)RIO_PTR(Cad,RWORD(PhbP->rx_start));
                                PortP->RxEnd    = (WORD *)RIO_PTR(Cad,RWORD(PhbP->rx_end));

                                rio_spin_unlock_irqrestore(&PortP->portSem, flags);
                                /*
                                ** point the UnixRup at the base SysPort
                                */
                                if ( !(PortN % PORTS_PER_RTA) )
                                        HostP->UnixRups[PortP->RupNum].BaseSysPort = PortN;
                        }
                }

                rio_dprintk (RIO_DEBUG_BOOT, "Set the card running... \n");
                /*
                ** last thing - show the world that everything is in place
                */
                HostP->Flags &= ~RUN_STATE;
                HostP->Flags |= RC_RUNNING;
        }
        /*
        ** MPX always uses a poller. This is actually patched into the system
        ** configuration and called directly from each clock tick.
        **
        */
        p->RIOPolling = 1;

        p->RIOSystemUp++;
        
        rio_dprintk (RIO_DEBUG_BOOT, "Done everything %x\n", HostP->Ivec);
        func_exit ();
        return 0;
}



/*
** Boot an RTA. If we have successfully processed this boot, then
** return 1. If we havent, then return 0.
*/
int
RIOBootRup( p, Rup, HostP, PacketP)
struct rio_info *       p;
uint Rup;
struct Host *HostP;
struct PKT *PacketP; 
{
        struct PktCmd *PktCmdP = (struct PktCmd *)PacketP->data;
        struct PktCmd_M *PktReplyP;
        struct CmdBlk *CmdBlkP;
        uint sequence;

#ifdef CHECK
        CheckHost(Host);
        CheckRup(Rup);
        CheckHostP(HostP);
        CheckPacketP(PacketP);
#endif

        /*
        ** If we haven't been told what to boot, we can't boot it.
        */
        if ( p->RIONumBootPkts == 0 ) {
                rio_dprintk (RIO_DEBUG_BOOT, "No RTA code to download yet\n");
                return 0;
        }

        /* rio_dprint(RIO_DEBUG_BOOT, NULL,DBG_BOOT,"Incoming command packet\n"); */
        /* ShowPacket( DBG_BOOT, PacketP ); */

        /*
        ** Special case of boot completed - if we get one of these then we
        ** don't need a command block. For all other cases we do, so handle
        ** this first and then get a command block, then handle every other
        ** case, relinquishing the command block if disaster strikes!
        */
        if ( (RBYTE(PacketP->len) & PKT_CMD_BIT) && 
                        (RBYTE(PktCmdP->Command)==BOOT_COMPLETED) )
                return RIOBootComplete(p, HostP, Rup, PktCmdP );

        /*
        ** try to unhook a command block from the command free list.
        */
        if ( !(CmdBlkP = RIOGetCmdBlk()) ) {
                rio_dprintk (RIO_DEBUG_BOOT, "No command blocks to boot RTA! come back later.\n");
                return 0;
        }

        /*
        ** Fill in the default info on the command block
        */
        CmdBlkP->Packet.dest_unit = Rup < (ushort)MAX_RUP ? Rup : 0;
        CmdBlkP->Packet.dest_port = BOOT_RUP;
        CmdBlkP->Packet.src_unit  = 0;
        CmdBlkP->Packet.src_port  = BOOT_RUP;

        CmdBlkP->PreFuncP = CmdBlkP->PostFuncP = NULL;
        PktReplyP = (struct PktCmd_M *)CmdBlkP->Packet.data;

        /*
        ** process COMMANDS on the boot rup!
        */
        if ( RBYTE(PacketP->len) & PKT_CMD_BIT ) {
                /*
                ** We only expect one type of command - a BOOT_REQUEST!
                */
                if ( RBYTE(PktCmdP->Command) != BOOT_REQUEST ) {
                        rio_dprintk (RIO_DEBUG_BOOT, "Unexpected command %d on BOOT RUP %d of host %d\n", 
                                                PktCmdP->Command,Rup,HostP-p->RIOHosts);
                        ShowPacket( DBG_BOOT, PacketP );
                        RIOFreeCmdBlk( CmdBlkP );
                        return 1;
                }

                /*
                ** Build a Boot Sequence command block
                **
                ** 02.03.1999 ARG - ESIL 0820 fix
                ** We no longer need to use "Boot Mode", we'll always allow
                ** boot requests - the boot will not complete if the device
                ** appears in the bindings table.
                ** So, this conditional is not required ...
                **
                if (p->RIOBootMode == RC_BOOT_NONE)
                        **
                        ** If the system is in slave mode, and a boot request is
                        ** received, set command to BOOT_ABORT so that the boot
                        ** will not complete.
                        **
                        PktReplyP->Command                       = BOOT_ABORT;
                else
                **
                ** We'll just (always) set the command field in packet reply
                ** to allow an attempted boot sequence :
                */
                PktReplyP->Command = BOOT_SEQUENCE;

                PktReplyP->BootSequence.NumPackets = p->RIONumBootPkts;
                PktReplyP->BootSequence.LoadBase   = p->RIOConf.RtaLoadBase;
                PktReplyP->BootSequence.CodeSize   = p->RIOBootCount;

                CmdBlkP->Packet.len                             = BOOT_SEQUENCE_LEN | PKT_CMD_BIT;

                bcopy("BOOT",(void *)&CmdBlkP->Packet.data[BOOT_SEQUENCE_LEN],4);

                rio_dprintk (RIO_DEBUG_BOOT, "Boot RTA on Host %d Rup %d - %d (0x%x) packets to 0x%x\n",
                        HostP-p->RIOHosts, Rup, p->RIONumBootPkts, p->RIONumBootPkts, 
                                                                p->RIOConf.RtaLoadBase);

                /*
                ** If this host is in slave mode, send the RTA an invalid boot
                ** sequence command block to force it to kill the boot. We wait
                ** for half a second before sending this packet to prevent the RTA
                ** attempting to boot too often. The master host should then grab
                ** the RTA and make it its own.
                */
                p->RIOBooting++;
                RIOQueueCmdBlk( HostP, Rup, CmdBlkP );
                return 1;
        }

        /*
        ** It is a request for boot data.
        */
        sequence = RWORD(PktCmdP->Sequence);

        rio_dprintk (RIO_DEBUG_BOOT, "Boot block %d on Host %d Rup%d\n",sequence,HostP-p->RIOHosts,Rup);

        if ( sequence >= p->RIONumBootPkts ) {
                rio_dprintk (RIO_DEBUG_BOOT, "Got a request for packet %d, max is %d\n", sequence, 
                                        p->RIONumBootPkts);
                ShowPacket( DBG_BOOT, PacketP );
        }

        PktReplyP->Sequence = sequence;

        bcopy( p->RIOBootPackets[ p->RIONumBootPkts - sequence - 1 ], 
                                PktReplyP->BootData, RTA_BOOT_DATA_SIZE );

        CmdBlkP->Packet.len = PKT_MAX_DATA_LEN;
        ShowPacket( DBG_BOOT, &CmdBlkP->Packet );
        RIOQueueCmdBlk( HostP, Rup, CmdBlkP );
        return 1;
}

/*
** This function is called when an RTA been booted.
** If booted by a host, HostP->HostUniqueNum is the booting host.
** If booted by an RTA, HostP->Mapping[Rup].RtaUniqueNum is the booting RTA.
** RtaUniq is the booted RTA.
*/
static int RIOBootComplete( struct rio_info *p, struct Host *HostP, uint Rup, struct PktCmd *PktCmdP )
{
        struct Map      *MapP = NULL;
        struct Map      *MapP2 = NULL;
        int     Flag;
        int     found;
        int     host, rta;
        int     EmptySlot = -1;
        int     entry, entry2;
        char    *MyType, *MyName;
        uint    MyLink;
        ushort  RtaType;
        uint    RtaUniq = (RBYTE(PktCmdP->UniqNum[0])) +
                          (RBYTE(PktCmdP->UniqNum[1]) << 8) +
                          (RBYTE(PktCmdP->UniqNum[2]) << 16) +
                          (RBYTE(PktCmdP->UniqNum[3]) << 24);

        /* Was RIOBooting-- . That's bad. If an RTA sends two of them, the
           driver will never think that the RTA has booted... -- REW */
        p->RIOBooting = 0;

        rio_dprintk (RIO_DEBUG_BOOT, "RTA Boot completed - BootInProgress now %d\n", p->RIOBooting);

        /*
        ** Determine type of unit (16/8 port RTA).
        */
        RtaType = GetUnitType(RtaUniq);
        if ( Rup >= (ushort)MAX_RUP ) {
            rio_dprintk (RIO_DEBUG_BOOT, "RIO: Host %s has booted an RTA(%d) on link %c\n",
             HostP->Name, 8 * RtaType, RBYTE(PktCmdP->LinkNum)+'A');
        } else {
            rio_dprintk (RIO_DEBUG_BOOT, "RIO: RTA %s has booted an RTA(%d) on link %c\n",
             HostP->Mapping[Rup].Name, 8 * RtaType,
             RBYTE(PktCmdP->LinkNum)+'A');
        }

        rio_dprintk (RIO_DEBUG_BOOT, "UniqNum is 0x%x\n",RtaUniq);

        if ( ( RtaUniq == 0x00000000 ) || ( RtaUniq == 0xffffffff ) )
        {
            rio_dprintk (RIO_DEBUG_BOOT, "Illegal RTA Uniq Number\n");
            return TRUE;
        }

        /*
        ** If this RTA has just booted an RTA which doesn't belong to this
        ** system, or the system is in slave mode, do not attempt to create
        ** a new table entry for it.
        */
        if (!RIOBootOk(p, HostP, RtaUniq))
        {
            MyLink = RBYTE(PktCmdP->LinkNum);
            if (Rup < (ushort) MAX_RUP)
            {
                /*
                ** RtaUniq was clone booted (by this RTA). Instruct this RTA
                ** to hold off further attempts to boot on this link for 30
                ** seconds.
                */
                if (RIOSuspendBootRta(HostP, HostP->Mapping[Rup].ID, MyLink))
                {
                    rio_dprintk (RIO_DEBUG_BOOT, "RTA failed to suspend booting on link %c\n",
                     'A' + MyLink);
                }
            }
            else
            {
                /*
                ** RtaUniq was booted by this host. Set the booting link
                ** to hold off for 30 seconds to give another unit a
                ** chance to boot it.
                */
                WWORD(HostP->LinkStrP[MyLink].WaitNoBoot, 30);
            }
            rio_dprintk (RIO_DEBUG_BOOT, "RTA %x not owned - suspend booting down link %c on unit %x\n",
              RtaUniq, 'A' + MyLink, HostP->Mapping[Rup].RtaUniqueNum);
            return TRUE;
        }

        /*
        ** Check for a SLOT_IN_USE entry for this RTA attached to the
        ** current host card in the driver table.
        **
        ** If it exists, make a note that we have booted it. Other parts of
        ** the driver are interested in this information at a later date,
        ** in particular when the booting RTA asks for an ID for this unit,
        ** we must have set the BOOTED flag, and the NEWBOOT flag is used
        ** to force an open on any ports that where previously open on this
        ** unit.
        */
        for ( entry=0; entry<MAX_RUP; entry++ )
        {
            uint sysport;

            if ((HostP->Mapping[entry].Flags & SLOT_IN_USE) && 
               (HostP->Mapping[entry].RtaUniqueNum==RtaUniq))
            {
                HostP->Mapping[entry].Flags |= RTA_BOOTED|RTA_NEWBOOT;
#if NEED_TO_FIX
                RIO_SV_BROADCAST(HostP->svFlags[entry]);
#endif
                if ( (sysport=HostP->Mapping[entry].SysPort) != NO_PORT )
                {
                   if ( sysport < p->RIOFirstPortsBooted )
                        p->RIOFirstPortsBooted = sysport;
                   if ( sysport > p->RIOLastPortsBooted )
                        p->RIOLastPortsBooted = sysport;
                   /*
                   ** For a 16 port RTA, check the second bank of 8 ports
                   */
                   if (RtaType == TYPE_RTA16)
                   {
                        entry2 = HostP->Mapping[entry].ID2 - 1;
                        HostP->Mapping[entry2].Flags |= RTA_BOOTED|RTA_NEWBOOT;
#if NEED_TO_FIX
                        RIO_SV_BROADCAST(HostP->svFlags[entry2]);
#endif
                        sysport = HostP->Mapping[entry2].SysPort;
                        if ( sysport < p->RIOFirstPortsBooted )
                            p->RIOFirstPortsBooted = sysport;
                        if ( sysport > p->RIOLastPortsBooted )
                            p->RIOLastPortsBooted = sysport;
                   }
                }
                if (RtaType == TYPE_RTA16) {
                   rio_dprintk (RIO_DEBUG_BOOT, "RTA will be given IDs %d+%d\n",
                    entry+1, entry2+1);
                } else {
                   rio_dprintk (RIO_DEBUG_BOOT, "RTA will be given ID %d\n",entry+1);
                }
                return TRUE;
            }
        }

        rio_dprintk (RIO_DEBUG_BOOT, "RTA not configured for this host\n");

        if ( Rup >= (ushort)MAX_RUP )
        {
            /*
            ** It was a host that did the booting
            */
            MyType = "Host";
            MyName = HostP->Name;
        }
        else
        {
            /*
            ** It was an RTA that did the booting
            */
            MyType = "RTA";
            MyName = HostP->Mapping[Rup].Name;
        }
#ifdef CHECK
        CheckString(MyType);
        CheckString(MyName);
#endif

        MyLink = RBYTE(PktCmdP->LinkNum);

        /*
        ** There is no SLOT_IN_USE entry for this RTA attached to the current
        ** host card in the driver table.
        **
        ** Check for a SLOT_TENTATIVE entry for this RTA attached to the
        ** current host card in the driver table.
        **
        ** If we find one, then we re-use that slot.
        */
        for ( entry=0; entry<MAX_RUP; entry++ )
        {
            if ( (HostP->Mapping[entry].Flags & SLOT_TENTATIVE) &&
                 (HostP->Mapping[entry].RtaUniqueNum == RtaUniq) )
            {
                if (RtaType == TYPE_RTA16)
                {
                    entry2 = HostP->Mapping[entry].ID2 - 1;
                    if ( (HostP->Mapping[entry2].Flags & SLOT_TENTATIVE) &&
                         (HostP->Mapping[entry2].RtaUniqueNum == RtaUniq) )
                        rio_dprintk (RIO_DEBUG_BOOT, "Found previous tentative slots (%d+%d)\n",
                         entry, entry2);
                    else
                        continue;
                }
                else
                        rio_dprintk (RIO_DEBUG_BOOT, "Found previous tentative slot (%d)\n",entry);
                if (! p->RIONoMessage)
                    cprintf("RTA connected to %s '%s' (%c) not configured.\n",MyType,MyName,MyLink+'A');
                return TRUE;
            }
        }

        /*
        ** There is no SLOT_IN_USE or SLOT_TENTATIVE entry for this RTA
        ** attached to the current host card in the driver table.
        **
        ** Check if there is a SLOT_IN_USE or SLOT_TENTATIVE entry on another
        ** host for this RTA in the driver table.
        **
        ** For a SLOT_IN_USE entry on another host, we need to delete the RTA
        ** entry from the other host and add it to this host (using some of
        ** the functions from table.c which do this).
        ** For a SLOT_TENTATIVE entry on another host, we must cope with the
        ** following scenario:
        **
        ** + Plug 8 port RTA into host A. (This creates SLOT_TENTATIVE entry
        **   in table)
        ** + Unplug RTA and plug into host B. (We now have 2 SLOT_TENTATIVE
        **   entries)
        ** + Configure RTA on host B. (This slot now becomes SLOT_IN_USE)
        ** + Unplug RTA and plug back into host A.
        ** + Configure RTA on host A. We now have the same RTA configured
        **   with different ports on two different hosts.
        */
        rio_dprintk (RIO_DEBUG_BOOT, "Have we seen RTA %x before?\n", RtaUniq );
        found = 0;
        Flag = 0; /* Convince the compiler this variable is initialized */
        for ( host = 0; !found && (host < p->RIONumHosts); host++ )
        {
            for ( rta=0; rta<MAX_RUP; rta++ )
            {
                if ((p->RIOHosts[host].Mapping[rta].Flags &
                 (SLOT_IN_USE | SLOT_TENTATIVE)) &&
                 (p->RIOHosts[host].Mapping[rta].RtaUniqueNum==RtaUniq))
                {
                    Flag = p->RIOHosts[host].Mapping[rta].Flags;
                    MapP = &p->RIOHosts[host].Mapping[rta];
                    if (RtaType == TYPE_RTA16)
                    {
                        MapP2 = &p->RIOHosts[host].Mapping[MapP->ID2 - 1];
                        rio_dprintk (RIO_DEBUG_BOOT, "This RTA is units %d+%d from host %s\n",
                         rta+1, MapP->ID2, p->RIOHosts[host].Name);
                    }
                    else
                        rio_dprintk (RIO_DEBUG_BOOT, "This RTA is unit %d from host %s\n",
                         rta+1, p->RIOHosts[host].Name);
                    found = 1;
                    break;
                }
            }
        }

        /*
        ** There is no SLOT_IN_USE or SLOT_TENTATIVE entry for this RTA
        ** attached to the current host card in the driver table.
        **
        ** If we have not found a SLOT_IN_USE or SLOT_TENTATIVE entry on
        ** another host for this RTA in the driver table...
        **
        ** Check for a SLOT_IN_USE entry for this RTA in the config table.
        */
        if ( !MapP )
        {
            rio_dprintk (RIO_DEBUG_BOOT, "Look for RTA %x in RIOSavedTable\n",RtaUniq);
            for ( rta=0; rta < TOTAL_MAP_ENTRIES; rta++ )
            {
                rio_dprintk (RIO_DEBUG_BOOT, "Check table entry %d (%x)",
                      rta,
                      p->RIOSavedTable[rta].RtaUniqueNum);

                if ( (p->RIOSavedTable[rta].Flags & SLOT_IN_USE) &&
                 (p->RIOSavedTable[rta].RtaUniqueNum == RtaUniq) )
                {
                    MapP = &p->RIOSavedTable[rta];
                    Flag = p->RIOSavedTable[rta].Flags;
                    if (RtaType == TYPE_RTA16)
                    {
                        for (entry2 = rta + 1; entry2 < TOTAL_MAP_ENTRIES;
                         entry2++)
                        {
                            if (p->RIOSavedTable[entry2].RtaUniqueNum == RtaUniq)
                                break;
                        }
                        MapP2 = &p->RIOSavedTable[entry2];
                        rio_dprintk (RIO_DEBUG_BOOT, "This RTA is from table entries %d+%d\n",
                              rta, entry2);
                    }
                    else
                        rio_dprintk (RIO_DEBUG_BOOT, "This RTA is from table entry %d\n", rta);
                    break;
                }
            }
        }

        /*
        ** There is no SLOT_IN_USE or SLOT_TENTATIVE entry for this RTA
        ** attached to the current host card in the driver table.
        **
        ** We may have found a SLOT_IN_USE entry on another host for this
        ** RTA in the config table, or a SLOT_IN_USE or SLOT_TENTATIVE entry
        ** on another host for this RTA in the driver table.
        **
        ** Check the driver table for room to fit this newly discovered RTA.
        ** RIOFindFreeID() first looks for free slots and if it does not
        ** find any free slots it will then attempt to oust any
        ** tentative entry in the table.
        */
        EmptySlot = 1;
        if (RtaType == TYPE_RTA16)
        {
            if (RIOFindFreeID(p, HostP, &entry, &entry2) == 0)
            {
                RIODefaultName(p, HostP, entry);
                FillSlot(entry, entry2, RtaUniq, HostP);
                EmptySlot = 0;
            }
        }
        else
        {
            if (RIOFindFreeID(p, HostP, &entry, NULL) == 0)
            {
                RIODefaultName(p, HostP, entry);
                FillSlot(entry, 0, RtaUniq, HostP);
                EmptySlot = 0;
            }
        }

        /*
        ** There is no SLOT_IN_USE or SLOT_TENTATIVE entry for this RTA
        ** attached to the current host card in the driver table.
        **
        ** If we found a SLOT_IN_USE entry on another host for this
        ** RTA in the config or driver table, and there are enough free
        ** slots in the driver table, then we need to move it over and
        ** delete it from the other host.
        ** If we found a SLOT_TENTATIVE entry on another host for this
        ** RTA in the driver table, just delete the other host entry.
        */
        if (EmptySlot == 0)
        {
            if ( MapP )
            {
                if (Flag & SLOT_IN_USE)
                {
                    rio_dprintk (RIO_DEBUG_BOOT, 
    "This RTA configured on another host - move entry to current host (1)\n");
                    HostP->Mapping[entry].SysPort = MapP->SysPort;
                    CCOPY( MapP->Name, HostP->Mapping[entry].Name, MAX_NAME_LEN );
                    HostP->Mapping[entry].Flags =
                     SLOT_IN_USE | RTA_BOOTED | RTA_NEWBOOT;
#if NEED_TO_FIX
                    RIO_SV_BROADCAST(HostP->svFlags[entry]);
#endif
                    RIOReMapPorts( p, HostP, &HostP->Mapping[entry] );
                    if ( HostP->Mapping[entry].SysPort < p->RIOFirstPortsBooted )
                        p->RIOFirstPortsBooted = HostP->Mapping[entry].SysPort;
                    if ( HostP->Mapping[entry].SysPort > p->RIOLastPortsBooted )
                        p->RIOLastPortsBooted = HostP->Mapping[entry].SysPort;
                    rio_dprintk (RIO_DEBUG_BOOT, "SysPort %d, Name %s\n",(int)MapP->SysPort,MapP->Name);
                }
                else
                {
                    rio_dprintk (RIO_DEBUG_BOOT, 
   "This RTA has a tentative entry on another host - delete that entry (1)\n");
                    HostP->Mapping[entry].Flags =
                     SLOT_TENTATIVE | RTA_BOOTED | RTA_NEWBOOT;
#if NEED_TO_FIX
                    RIO_SV_BROADCAST(HostP->svFlags[entry]);
#endif
                }
                if (RtaType == TYPE_RTA16)
                {
                    if (Flag & SLOT_IN_USE)
                    {
                        HostP->Mapping[entry2].Flags = SLOT_IN_USE |
                         RTA_BOOTED | RTA_NEWBOOT | RTA16_SECOND_SLOT;
#if NEED_TO_FIX
                        RIO_SV_BROADCAST(HostP->svFlags[entry2]);
#endif
                        HostP->Mapping[entry2].SysPort = MapP2->SysPort;
                        /*
                        ** Map second block of ttys for 16 port RTA
                        */
                        RIOReMapPorts( p, HostP, &HostP->Mapping[entry2] );
                       if (HostP->Mapping[entry2].SysPort < p->RIOFirstPortsBooted)
                         p->RIOFirstPortsBooted = HostP->Mapping[entry2].SysPort;
                       if (HostP->Mapping[entry2].SysPort > p->RIOLastPortsBooted)
                         p->RIOLastPortsBooted = HostP->Mapping[entry2].SysPort;
                        rio_dprintk (RIO_DEBUG_BOOT, "SysPort %d, Name %s\n",
                               (int)HostP->Mapping[entry2].SysPort,
                               HostP->Mapping[entry].Name);
                    }
                    else
                        HostP->Mapping[entry2].Flags = SLOT_TENTATIVE |
                         RTA_BOOTED | RTA_NEWBOOT | RTA16_SECOND_SLOT;
#if NEED_TO_FIX
                        RIO_SV_BROADCAST(HostP->svFlags[entry2]);
#endif
                    bzero( (caddr_t)MapP2, sizeof(struct Map) );
                }
                bzero( (caddr_t)MapP, sizeof(struct Map) );
                if (! p->RIONoMessage)
                    cprintf("An orphaned RTA has been adopted by %s '%s' (%c).\n",MyType,MyName,MyLink+'A');
            }
            else if (! p->RIONoMessage)
                cprintf("RTA connected to %s '%s' (%c) not configured.\n",MyType,MyName,MyLink+'A');
            RIOSetChange(p);
            return TRUE;
        }

        /*
        ** There is no room in the driver table to make an entry for the
        ** booted RTA. Keep a note of its Uniq Num in the overflow table,
        ** so we can ignore it's ID requests.
        */
        if (! p->RIONoMessage)
            cprintf("The RTA connected to %s '%s' (%c) cannot be configured.  You cannot configure more than 128 ports to one host card.\n",MyType,MyName,MyLink+'A');
        for ( entry=0; entry<HostP->NumExtraBooted; entry++ )
        {
            if ( HostP->ExtraUnits[entry] == RtaUniq )
            {
                /*
                ** already got it!
                */
                return TRUE;
            }
        }
        /*
        ** If there is room, add the unit to the list of extras
        */
        if ( HostP->NumExtraBooted < MAX_EXTRA_UNITS )
            HostP->ExtraUnits[HostP->NumExtraBooted++] = RtaUniq;
        return TRUE;
}


/*
** If the RTA or its host appears in the RIOBindTab[] structure then
** we mustn't boot the RTA and should return FALSE.
** This operation is slightly different from the other drivers for RIO
** in that this is designed to work with the new utilities
** not config.rio and is FAR SIMPLER.
** We no longer support the RIOBootMode variable. It is all done from the
** "boot/noboot" field in the rio.cf file.
*/
int
RIOBootOk(p, HostP, RtaUniq)
struct rio_info *       p;
struct Host *           HostP;
ulong RtaUniq;
{
    int         Entry;
    uint HostUniq = HostP->UniqueNum;

        /*
        ** Search bindings table for RTA or its parent.
        ** If it exists, return 0, else 1.
        */
        for (Entry = 0;
            ( Entry < MAX_RTA_BINDINGS ) && ( p->RIOBindTab[Entry] != 0 );
            Entry++)
        {
                if ( (p->RIOBindTab[Entry] == HostUniq) ||
                     (p->RIOBindTab[Entry] == RtaUniq) )
                        return 0;
        }
        return 1;
}

/*
** Make an empty slot tentative. If this is a 16 port RTA, make both
** slots tentative, and the second one RTA_SECOND_SLOT as well.
*/

void
FillSlot(entry, entry2, RtaUniq, HostP)
int entry;
int entry2;
uint RtaUniq;
struct Host *HostP;
{
        int             link;

        rio_dprintk (RIO_DEBUG_BOOT, "FillSlot(%d, %d, 0x%x...)\n", entry, entry2, RtaUniq);

        HostP->Mapping[entry].Flags = (RTA_BOOTED | RTA_NEWBOOT | SLOT_TENTATIVE);
        HostP->Mapping[entry].SysPort = NO_PORT;
        HostP->Mapping[entry].RtaUniqueNum = RtaUniq;
        HostP->Mapping[entry].HostUniqueNum = HostP->UniqueNum;
        HostP->Mapping[entry].ID = entry + 1;
        HostP->Mapping[entry].ID2 = 0;
        if (entry2) {
                HostP->Mapping[entry2].Flags = (RTA_BOOTED | RTA_NEWBOOT | 
                                                                SLOT_TENTATIVE | RTA16_SECOND_SLOT);
                HostP->Mapping[entry2].SysPort = NO_PORT;
                HostP->Mapping[entry2].RtaUniqueNum = RtaUniq;
                HostP->Mapping[entry2].HostUniqueNum = HostP->UniqueNum;
                HostP->Mapping[entry2].Name[0] = '\0';
                HostP->Mapping[entry2].ID = entry2 + 1;
                HostP->Mapping[entry2].ID2 = entry + 1;
                HostP->Mapping[entry].ID2 = entry2 + 1;
        }
        /*
        ** Must set these up, so that utilities show
        ** topology of 16 port RTAs correctly
        */
        for ( link=0; link<LINKS_PER_UNIT; link++ ) {
                HostP->Mapping[entry].Topology[link].Unit = ROUTE_DISCONNECT;
                HostP->Mapping[entry].Topology[link].Link = NO_LINK;
                if (entry2) {
                        HostP->Mapping[entry2].Topology[link].Unit = ROUTE_DISCONNECT;
                        HostP->Mapping[entry2].Topology[link].Link = NO_LINK;
                }
        }
}

#if 0
/*
        Function:       This function is to disable the disk interrupt 
    Returns :   Nothing
*/
void
disable_interrupt(vector)
int     vector;
{
        int     ps;
        int     val;

        disable(ps);
        if (vector > 40)  {
                val = 1 << (vector - 40);
                __outb(S8259+1, __inb(S8259+1) | val);
        }
        else {
                val = 1 << (vector - 32);
                __outb(M8259+1, __inb(M8259+1) | val);
        }
        restore(ps);
}

/*
        Function:       This function is to enable the disk interrupt 
    Returns :   Nothing
*/
void
enable_interrupt(vector)
int     vector;
{
        int     ps;
        int     val;

        disable(ps);
        if (vector > 40)  {
                val = 1 << (vector - 40);
                val = ~val;
                __outb(S8259+1, __inb(S8259+1) & val);
        }
        else {
                val = 1 << (vector - 32);
                val = ~val;
                __outb(M8259+1, __inb(M8259+1) & val);
        }
        restore(ps);
}
#endif