workbench/devs/AHI/Drivers/SB128/driver-init.c

   1 /*
   2
   3 The contents of this file are subject to the AROS Public License Version 1.1 (the "License"); you may not use this file except in compliance with the License. You may obtain a copy of the License at
   4 http://www.aros.org/license.html
   5
   6 Software distributed under the License is distributed on an "AS IS" basis, WITHOUT WARRANTY OF
   7 ANY KIND, either express or implied. See the License for the specific language governing rights and
   8 limitations under the License.
   9
  10 The Original Code is (C) Copyright 2004-2011 Ross Vumbaca.
  11
  12 The Initial Developer of the Original Code is Ross Vumbaca.
  13
  14 All Rights Reserved.
  15
  16 */
  17
  18 #include <config.h>
  19
  20 #include <exec/memory.h>
  21
  22 #undef __USE_INLINE__
  23 #include <proto/expansion.h>
  24
  25 #include <proto/exec.h>
  26 #include <proto/dos.h>
  27
  28 #include <devices/timer.h>
  29
  30 #include "library_card.h"
  31 #include "version.h"
  32 #include "misc.h"
  33 #include "regs.h"
  34 #include "DriverData.h"
  35
  36
  37 struct Library*    SysBase;
  38 struct Library*    DOSBase;
  39 struct DriverBase* AHIsubBase;
  40
  41 struct Library*             ExpansionBase = NULL;
  42 struct ExpansionIFace*      IExpansion = NULL;
  43 struct UtilityIFace*        IUtility = NULL;
  44 struct AHIsubIFace*         IAHIsub = NULL;
  45 struct MMUIFace*            IMMU = NULL;
  46 struct PCIIFace*            IPCI = NULL;
  47
  48 #define CARD_STRING "SB128"
  49
  50
  51 /******************************************************************************
  52 ** Custom driver init *********************************************************
  53 ******************************************************************************/
  54
  55 BOOL
  56 DriverInit( struct DriverBase* ahisubbase )
  57 {
  58   struct CardBase* CardBase = (struct CardBase*) ahisubbase;
  59   struct PCIDevice   *dev;
  60   int                 card_no;
  61
  62   UWORD cards[] =
  63   {
  64     0x1274, 0x5000,
  65     0x1274, 0x1371,
  66     0x1274, 0x5880,
  67     0x1102, 0x8938,
  68     PCI_ANY_ID, PCI_ANY_ID
  69   };
  70
  71   CardBase->cards_found = 0;
  72   CardBase->driverdatas = 0;
  73   AHIsubBase = ahisubbase;
  74
  75   DOSBase  = IExec->OpenLibrary( DOSNAME, 37 );
  76
  77   if( DOSBase == NULL )
  78   {
  79     Req( "Unable to open 'dos.library' version 37.\n" );
  80     return FALSE;
  81   }
  82
  83   if ((IDOS = (struct DOSIFace *) IExec->GetInterface((struct Library *) DOSBase, "main", 1, NULL)) == NULL)
  84   {
  85        Req("Couldn't open IDOS interface!\n");
  86        return FALSE;
  87   }
  88
  89   ExpansionBase = IExec->OpenLibrary( "expansion.library", 50 );
  90   if( ExpansionBase == NULL )
  91   {
  92     Req( "Unable to open 'expansion.library' version 50.\n" );
  93     return FALSE;
  94   }
  95   if ((IExpansion = (struct ExpansionIFace *) IExec->GetInterface((struct Library *) ExpansionBase, "main", 1, NULL)) == NULL)
  96   {
  97        Req("Couldn't open IExpansion interface!\n");
  98        return FALSE;
  99   }
 100
 101   if ((IPCI = (struct PCIIFace *) IExec->GetInterface((struct Library *) ExpansionBase, "pci", 1, NULL)) == NULL)
 102   {
 103        Req("Couldn't open IPCI interface!\n");
 104        return FALSE;
 105   }
 106
 107   if ((IAHIsub = (struct AHIsubIFace *) IExec->GetInterface((struct Library *) AHIsubBase, "main", 1, NULL)) == NULL)
 108   {
 109        Req("Couldn't open IAHIsub interface!\n");
 110        return FALSE;
 111   }
 112
 113   if ((IUtility = (struct UtilityIFace *) IExec->GetInterface((struct Library *) UtilityBase, "main", 1, NULL)) == NULL)
 114   {
 115        Req("Couldn't open IUtility interface!\n");
 116        return FALSE;
 117   }
 118
 119   if ((IMMU = (struct MMUIFace *) IExec->GetInterface((struct Library *) SysBase, "mmu", 1, NULL)) == NULL)
 120   {
 121        Req("Couldn't open IMMU interface!\n");
 122        return FALSE;
 123   }
 124
 125   /* Timer Device */
 126
 127 /*  replymp = (struct MsgPort *) IExec->CreatePort(NULL, 0);
 128   if (!replymp)
 129   {
 130     IExec->DebugPrintF("SB128: Couldn't create ReplyPort!\n");
 131     return FALSE;
 132   }*/
 133
 134   /*TimerIO = (struct timerequest *)IExec->CreateIORequest(replymp, sizeof(struct timerequest));
 135
 136   if (TimerIO == NULL)
 137   {
 138     IExec->DebugPrintF("Out of memory.\n");
 139     return FALSE;
 140   }
 141
 142   if (IExec->OpenDevice("timer.device", UNIT_MICROHZ, (struct IORequest *)TimerIO, 0) != 0)
 143   {
 144     IExec->DebugPrintF("Unable to open 'timer.device'.\n");
 145     return FALSE;
 146   }
 147   else
 148     TimerBase = (struct Device *)TimerIO->tr_node.io_Device;*/
 149
 150   IExec->InitSemaphore( &CardBase->semaphore );
 151
 152
 153   /*** Count cards ***********************************************************/
 154
 155   dev = NULL;
 156
 157   if ( (dev = IPCI->FindDeviceTags( FDT_CandidateList, cards,
 158                                   TAG_DONE ) ) != NULL )
 159   {
 160     ++CardBase->cards_found;
 161     IExec->DebugPrintF("%s found! :-)\n", CARD_STRING);
 162   }
 163
 164   /* Fail if no hardware is present (prevents the audio modes from being added to
 165      the database if the driver cannot be used). */
 166
 167   if( CardBase->cards_found == 0 )
 168   {
 169     IExec->DebugPrintF("No %s found! :-(\n", CARD_STRING);
 170     Req( "No card present.\n" );
 171     return FALSE;
 172   }
 173
 174   /*** CAMD ******************************************************************/
 175 #if 0
 176   IExec->InitSemaphore( &CardBase->camd.Semaphore );
 177   CardBase->camd.Semaphore.ss_Link.ln_Pri  = 0;
 178
 179   CardBase->camd.Semaphore.ss_Link.ln_Name = Card_CAMD_SEMAPHORE;
 180   IExec->AddSemaphore( &CardBase->camd.Semaphore );
 181
 182   CardBase->camd.Cards    = CardBase->cards_found;
 183   CardBase->camd.Version  = VERSION;
 184   CardBase->camd.Revision = REVISION;
 185
 186
 187   CardBase->camd.OpenPortFunc.h_Entry    = OpenCAMDPort;
 188   CardBase->camd.OpenPortFunc.h_SubEntry = NULL;
 189   CardBase->camd.OpenPortFunc.h_Data     = NULL;
 190
 191   CardBase->camd.ClosePortFunc.h_Entry    = (HOOKFUNC) CloseCAMDPort;
 192   CardBase->camd.ClosePortFunc.h_SubEntry = NULL;
 193   CardBase->camd.ClosePortFunc.h_Data     = NULL;
 194
 195   CardBase->camd.ActivateXmitFunc.h_Entry    = (HOOKFUNC) ActivateCAMDXmit;
 196   CardBase->camd.ActivateXmitFunc.h_SubEntry = NULL;
 197   CardBase->camd.ActivateXmitFunc.h_Data     = NULL;
 198 #endif
 199
 200
 201   /*** Allocate and init all cards *******************************************/
 202
 203   CardBase->driverdatas = IExec->AllocVec( sizeof( *CardBase->driverdatas ) *
 204                                        CardBase->cards_found,
 205                                        MEMF_PUBLIC );
 206
 207   if( CardBase->driverdatas == NULL )
 208   {
 209     Req( "Out of memory." );
 210     return FALSE;
 211   }
 212
 213   card_no = 0;
 214
 215   if( ( dev = IPCI->FindDeviceTags( FDT_CandidateList, cards,
 216                                   TAG_DONE ) ) != NULL )
 217   {
 218     CardBase->driverdatas[ card_no ] = AllocDriverData( dev, AHIsubBase );
 219     ++card_no;
 220   }
 221
 222   return TRUE;
 223 }
 224
 225
 226 /******************************************************************************
 227 ** Custom driver clean-up *****************************************************
 228 ******************************************************************************/
 229
 230 VOID
 231 DriverCleanup( struct DriverBase* AHIsubBase )
 232 {
 233   struct CardBase* CardBase = (struct CardBase*) AHIsubBase;
 234   int i;
 235 #if 0
 236   if( CardBase->camd.Semaphore.ss_Link.ln_Name != NULL )
 237   {
 238     IExec->ObtainSemaphore( &CardBase->camd.Semaphore );
 239     IExec->RemSemaphore( &CardBase->camd.Semaphore );
 240     IExec->ReleaseSemaphore( &CardBase->camd.Semaphore );
 241   }
 242 #endif
 243
 244   for( i = 0; i < CardBase->cards_found; ++i )
 245   {
 246     if (CardBase->driverdatas)
 247     {
 248       CardBase->driverdatas[ i ]->pci_dev->OutLong(CardBase->driverdatas[ i ]->iobase + SB128_SCON, 0);
 249       FreeDriverData( CardBase->driverdatas[ i ], AHIsubBase );
 250     }
 251   }
 252
 253   if (CardBase->driverdatas)
 254     IExec->FreeVec( CardBase->driverdatas );
 255
 256   /*if (TimerIO)
 257   {
 258     IExec->CloseDevice((struct IORequest *)TimerIO);
 259     IExec->DeleteIORequest((struct IORequest *)TimerIO);
 260   }*/
 261
 262   /*if (replymp)
 263     IExec->DeletePort(replymp);*/
 264
 265   if (IMMU)
 266     IExec->DropInterface( (struct Interface *) IMMU);
 267
 268   if (IUtility)
 269     IExec->DropInterface( (struct Interface *) IUtility);
 270
 271   if (IExpansion)
 272     IExec->DropInterface( (struct Interface *) IExpansion);
 273
 274   if (IPCI)
 275     IExec->DropInterface( (struct Interface *) IPCI);
 276
 277   if (IAHIsub)
 278     IExec->DropInterface( (struct Interface *) IAHIsub);
 279
 280   if (IDOS)
 281     IExec->DropInterface( (struct Interface *) IDOS);
 282
 283   if (ExpansionBase)
 284     IExec->CloseLibrary( (struct Library*) ExpansionBase );
 285
 286   if (UtilityBase)
 287     IExec->CloseLibrary( (struct Library*) UtilityBase );
 288
 289   if (DOSBase)
 290     IExec->CloseLibrary( (struct Library*) DOSBase );
 291 }