arch/m68k-amiga/expansion/configchain.c

   1 /*
   2     Copyright © 1995-2007, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc:
   6     Lang: english
   7 */
   8
   9 #define DEBUG 1
  10 #include <aros/debug.h>
  11
  12 #include <proto/expansion.h>
  13
  14 #include "expansion_intern.h"
  15
  16 #include <clib/expansion_protos.h>
  17 #include <proto/exec.h>
  18 #include <exec/resident.h>
  19
  20 AROS_UFP3(ULONG, MemoryTest,
  21     AROS_UFPA(APTR, startaddr, A0),
  22     AROS_UFPA(APTR, endaddr, A1),
  23     AROS_UFPA(ULONG, block, D0));
  24
  25 static ULONG autosize(struct ExpansionBase *ExpansionBase, struct ConfigDev *configDev)
  26 {
  27         UBYTE sizebits = configDev->cd_Rom.er_Flags & ERT_Z3_SSMASK;
  28         ULONG maxsize = configDev->cd_BoardSize;
  29         ULONG size = 0;
  30         UBYTE *addr = (UBYTE*)configDev->cd_BoardAddr;
  31
  32         D(bug("sizebits=%x\n", sizebits));
  33         if (sizebits >= 14) /* 14 and 15 = reserved */
  34                 return 0;
  35         if (sizebits >= 2 && sizebits <= 8)
  36                 return 0x00010000 << (sizebits - 2);
  37         if (sizebits >= 9)
  38                 return 0x00600000 + (0x200000 * (sizebits - 9));
  39         size = AROS_UFC3(ULONG, MemoryTest,
  40                 AROS_UFCA(APTR, addr, A0),
  41                 AROS_UFCA(APTR, addr + maxsize, A1),
  42                 AROS_UFCA(ULONG, 0x80000, D0));
  43         D(bug("addr=%lx size=%lx maxsize=%lx\n", addr, size, maxsize));
  44         return size;
  45 }
  46
  47 static void findmbram(struct ExpansionBase *ExpansionBase)
  48 {
  49         LONG ret;
  50         ULONG step, start, end;
  51
  52         if (!(SysBase->AttnFlags & AFF_68020))
  53                 return;
  54         if ((SysBase->AttnFlags & AFF_68020) && !(SysBase->AttnFlags & AFF_ADDR32))
  55                 return;
  56
  57         /* High MBRAM */
  58         step =  0x00100000;
  59         start = 0x08000000;
  60         end =   0x7f000000;
  61         ret = AROS_UFC3(LONG, MemoryTest,
  62                 AROS_UFCA(APTR, start, A0),
  63                 AROS_UFCA(APTR, end, A1),
  64                 AROS_UFCA(ULONG, step, D0));
  65         if (ret < 0)
  66                 return;
  67         if (ret > 0) {
  68                 AddMemList(ret, MEMF_KICK | MEMF_LOCAL | MEMF_FAST | MEMF_PUBLIC, 40, (APTR)start, "expansion.memory");
  69                 D(bug("MBRAM @%08x, size %08x\n", start, ret));
  70         }
  71
  72         /* Low MBRAM, reversed detection needed */
  73         step =  0x00100000;
  74         start = 0x08000000;
  75         end =   0x01000000;
  76         for (;;) {
  77                 ret = AROS_UFC3(LONG, MemoryTest,
  78                         AROS_UFCA(APTR, start - step, A0),
  79                         AROS_UFCA(APTR, start, A1),
  80                         AROS_UFCA(ULONG, step, D0));
  81                 if (ret <= 0)
  82                         break;
  83                 if (end >= start - step)
  84                         break;
  85                 start -= step;
  86         }
  87         if (start != 0x08000000) {
  88                 ULONG size = 0x08000000 - start;
  89                 AddMemList(size, MEMF_KICK | MEMF_LOCAL | MEMF_FAST | MEMF_PUBLIC, 30, (APTR)start, "expansion.memory");
  90                 D(bug("MBRAM @%08x, size %08x\n", start, size));
  91         }
  92 }
  93
  94 static void allocram(struct ExpansionBase *ExpansionBase)
  95 {
  96         struct Node *node;
  97
  98         findmbram(ExpansionBase);
  99         // we should merge address spaces, later..
 100         D(bug("adding ram boards\n"));
 101         ForeachNode(&ExpansionBase->BoardList, node) {
 102                 struct ConfigDev *configDev = (struct ConfigDev*)node;
 103                 if ((configDev->cd_Rom.er_Type & ERTF_MEMLIST) && !(configDev->cd_Flags & CDF_SHUTUP) && !(configDev->cd_Flags & CDF_PROCESSED)) {
 104                         ULONG attr = MEMF_PUBLIC | MEMF_FAST | MEMF_KICK;
 105                         ULONG size = configDev->cd_BoardSize;
 106                         APTR addr = configDev->cd_BoardAddr;
 107                         LONG pri = 20;
 108                         if (configDev->cd_BoardAddr <= (APTR)0x00FFFFFF) {
 109                                 attr |= MEMF_24BITDMA;
 110                                 pri = 0;
 111                         } else if ((configDev->cd_Rom.er_Flags & ERT_Z3_SSMASK) != 0) {
 112                                 size = autosize(ExpansionBase, configDev);
 113                         }
 114                         if (size && size <= configDev->cd_BoardSize) {
 115                                 D(bug("ram board at %08x, size %08x attr %08x\n", addr, size, attr));
 116                                 AddMemList(size, attr, pri, addr, "Fast Memory");
 117                         }
 118                         configDev->cd_Flags |= CDF_PROCESSED;
 119                 }
 120         }
 121         D(bug("ram boards done\n"));
 122 }
 123
 124
 125 AROS_LH1(void, ConfigChain,
 126         AROS_LHA(APTR, baseAddr, A0),
 127         struct ExpansionBase *, ExpansionBase, 11, Expansion)
 128 {
 129     AROS_LIBFUNC_INIT
 130
 131         struct ConfigDev *configDev = NULL;
 132
 133         /* Try to guess if we have Z3 based machine.
 134          * Not all Z3 boards appear in Z2 region.
 135          *
 136          * Ignores original baseAddr by design.
 137          */
 138         BOOL maybeZ3 = (SysBase->AttnFlags & AFF_ADDR32);
 139         D(bug("configchain\n"));
 140         for(;;) {
 141                 BOOL gotrom = FALSE;
 142                 if (!configDev)
 143                         configDev = AllocConfigDev();
 144                 if (!configDev)
 145                         break;
 146                 if (maybeZ3) {
 147                         baseAddr = (APTR)EZ3_EXPANSIONBASE;
 148                         gotrom = ReadExpansionRom(baseAddr, configDev);
 149                 }
 150                 if (!gotrom) {
 151                         baseAddr = (APTR)E_EXPANSIONBASE;
 152                         gotrom = ReadExpansionRom(baseAddr, configDev);
 153                 }
 154                 if (!gotrom) {
 155                         FreeConfigDev(configDev);
 156                         break;
 157                 }
 158                 if (ConfigBoard(baseAddr, configDev)) {
 159                         AddConfigDev(configDev);
 160                         configDev = NULL;
 161                 }
 162         }
 163         D(bug("configchain done\n"));
 164
 165         allocram(ExpansionBase);
 166
 167     AROS_LIBFUNC_EXIT
 168 } /* ConfigChain */