arch/m68k-amiga/card/card_init.c

   1 /*
   2     Copyright © 1995-2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc:
   6     Lang: English
   7 */
   8
   9 #include <aros/debug.h>
  10 #include <exec/types.h>
  11 #include <exec/interrupts.h>
  12 #include <hardware/intbits.h>
  13 #include <proto/exec.h>
  14 #include <aros/symbolsets.h>
  15 #include "card_intern.h"
  16
  17 AROS_INTP(card_level2);
  18 AROS_INTP(card_level6);
  19
  20 void CardTask(struct Task *parent, struct CardResource *CardResource);
  21
  22 static BOOL addpcmciaram(struct CardResource *CardResource, struct CardHandle *ch, struct DeviceTData *dtd)
  23 {
  24     ULONG size = dtd->dtd_DTsize;
  25     APTR addr =(APTR)GAYLE_RAM;
  26
  27     if (size < 262144)
  28         return FALSE;
  29     if (size > GAYLE_RAMSIZE)
  30         size = GAYLE_RAMSIZE;
  31     size -= 512;
  32     addr += 512;
  33     AddMemList(size, MEMF_FAST | MEMF_PUBLIC, -5, addr, CardResource->crb_LibNode.lib_Node.ln_Name);
  34     return TRUE;
  35 }
  36
  37 static BOOL checkcard(struct CardResource *CardResource)
  38 {
  39     struct CardHandle *ch;
  40     BOOL sysram = FALSE;
  41
  42     ch = AllocVec(sizeof(struct CardHandle), MEMF_CLEAR);
  43     if (ch) {
  44         ch->cah_CardFlags = CARDF_IFAVAILABLE;
  45         if (!OwnCard(ch)) {
  46             struct Resident *res;
  47             struct DeviceTData dtd;
  48             UBYTE device[6];
  49
  50             BeginCardAccess(ch);
  51
  52             if (!CopyTuple(ch, NULL, 0, 0)) { /* debug log all tuples, check if tuple chain is valid */
  53                 CARDDEBUG(bug("Invalid tuple chain detected\n"));
  54             } else {
  55                 res = IfAmigaXIP(ch);
  56                 if (res) {
  57                     CARDDEBUG(bug("CISTPL_AMIGAXIP found\n"));
  58                 } else if (CopyTuple(ch, device, CISTPL_DEVICE, sizeof(device) - 2)) {
  59                     if (DeviceTuple(device, &dtd)) {
  60                         if (dtd.dtd_DTtype == DTYPE_SRAM || dtd.dtd_DTtype == DTYPE_DRAM) {
  61                             CARDDEBUG(bug("Type %d RAM card found, size %d bytes, speed %d\n", dtd.dtd_DTtype, dtd.dtd_DTsize, dtd.dtd_DTspeed));
  62                             if (!CopyTuple(ch, device, CISTPL_FORMAT, 0) && !CopyTuple(ch, device, CISTPL_GEOMETRY, 0) && dtd.dtd_DTspeed <= 250) {
  63                                 if (addpcmciaram(CardResource, ch, &dtd)) {
  64                                     CardAccessSpeed(ch, dtd.dtd_DTspeed);
  65                                     CARDDEBUG(bug("Mapped as System RAM.\n"));
  66                                     sysram = TRUE;
  67                                 }
  68                             } else {
  69                                 CARDDEBUG(bug("Not usable as System RAM.\n"));
  70                             }
  71                         }
  72                     }
  73                 }
  74             }
  75
  76             EndCardAccess(ch);
  77
  78             ReleaseCard(ch, CARDF_REMOVEHANDLE);
  79         }
  80         FreeVec(ch);
  81     }
  82     return sysram;
  83 }
  84
  85 static int Cardres_Init(struct CardResource *CardResource)
  86 {
  87     UBYTE gayle;
  88     struct Interrupt *intr;
  89     volatile struct GayleIO *gio = (struct GayleIO*)GAYLE_BASE;
  90
  91     Disable();
  92     gayle = ReadGayle();
  93     Enable();
  94
  95     /* No Gayle = No PCMCIA slot */
  96     if (!gayle)
  97         return FALSE;
  98
  99     /* Address space conflict? */
 100     if (TypeOfMem((UBYTE*)GAYLE_RAM + 0x1000) != 0)
 101         return FALSE;
 102
 103     NEWLIST(&CardResource->handles);
 104
 105     CARDDEBUG(bug("PCMCIA slot enabled\n"));
 106
 107     pcmcia_reset(CardResource);
 108     pcmcia_enable();
 109
 110     CardResource->removed = TRUE;
 111     if (gio->status & GAYLE_CS_CCDET) {
 112         /* Card inserted */
 113         CARDDEBUG(bug("Inserted PCMCIA card detected\n"));
 114         pcmcia_cardreset(CardResource);
 115         CardResource->removed = FALSE;
 116         if (checkcard(CardResource)) {
 117             CardResource->resetberr = GAYLE_IRQ_RESET;
 118             pcmcia_clear_requests(CardResource);
 119             /* Installed as Fast RAM. Do not initialize resource */
 120             return 0;
 121         }
 122     }
 123
 124     CardResource->task = NewCreateTask(
 125         TASKTAG_PC, CardTask,
 126         TASKTAG_NAME, CardResource->crb_LibNode.lib_Node.ln_Name,
 127         TASKTAG_PRI, 15,
 128         TASKTAG_ARG1, FindTask(0),
 129         TASKTAG_ARG2, CardResource,
 130         TAG_DONE);
 131     if (!CardResource->task)
 132         return FALSE;
 133     Wait(SIGBREAKF_CTRL_F);
 134
 135     Disable();
 136
 137     intr = &CardResource->level2;
 138     intr->is_Node.ln_Pri = 127;
 139     intr->is_Node.ln_Type = NT_INTERRUPT;
 140     intr->is_Node.ln_Name = CardResource->crb_LibNode.lib_Node.ln_Name;
 141     intr->is_Code = (APTR)card_level2;
 142     intr->is_Data = CardResource;
 143     AddIntServer(INTB_PORTS, intr);
 144
 145     intr = &CardResource->level6;
 146     intr->is_Node.ln_Pri = -127;
 147     intr->is_Node.ln_Type = NT_INTERRUPT;
 148     intr->is_Node.ln_Name = CardResource->crb_LibNode.lib_Node.ln_Name;
 149     intr->is_Code = (APTR)card_level6;
 150     intr->is_Data = CardResource;
 151     AddIntServer(INTB_EXTER, intr);
 152
 153     pcmcia_clear_requests(CardResource);
 154     pcmcia_enable_interrupts();
 155
 156     Enable();
 157
 158     return TRUE;
 159 }
 160
 161 ADD2INITLIB(Cardres_Init, 0)