workbench/devs/networks/etherlink3/powerpci.c

   1 /*
   2
   3 Copyright (C) 2004-2011 Neil Cafferkey
   4
   5 This program is free software; you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation; either version 2 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful, but
  11 WITHOUT ANY WARRANTY; without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13 General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program; if not, write to the Free Software
  17 Foundation, Inc., 59 Temple Place - Suite 330, Boston,
  18 MA 02111-1307, USA.
  19
  20 */
  21
  22
  23 #include <exec/types.h>
  24 #include <pci/powerpci_pci.h>
  25
  26 #include <proto/exec.h>
  27 #include <proto/powerpci.h>
  28
  29 #include "device.h"
  30 #include "pci.h"
  31
  32 #include "pci_protos.h"
  33 #include "powerpci_protos.h"
  34
  35
  36 /****i* etherlink3.device/GetPowerPCICount *********************************
  37 *
  38 *   NAME
  39 *       GetPowerPCICount
  40 *
  41 *   SYNOPSIS
  42 *       count = GetPowerPCICount()
  43 *
  44 *       ULONG GetPowerPCICount();
  45 *
  46 ****************************************************************************
  47 *
  48 */
  49
  50 ULONG GetPowerPCICount(struct DevBase *base)
  51 {
  52    ULONG count = 0;
  53    ULONG card = 0;
  54    UWORD vendor_id, product_id;
  55
  56    while((card = pci_find_device(0xffff, 0xffff, card)) != NULL)
  57    {
  58       product_id = pci_read_conf_word(card, PCI_DEVICE_ID);
  59       vendor_id = pci_read_conf_word(card, PCI_VENDOR_ID);
  60       if(IsCardCompatible(vendor_id, product_id, base))
  61          count++;
  62    }
  63
  64    return count;
  65 }
  66
  67
  68
  69 /****i* etherlink3.device/AllocPowerPCICard ********************************
  70 *
  71 *   NAME
  72 *       AllocPowerPCICard -- Take control of a card.
  73 *
  74 *   SYNOPSIS
  75 *       context = AllocPowerPCICard(index)
  76 *
  77 *       struct BusContext *AllocPowerPCICard(ULONG);
  78 *
  79 ****************************************************************************
  80 *
  81 */
  82
  83 struct BusContext *AllocPowerPCICard(ULONG index, struct DevBase *base)
  84 {
  85    BOOL success = TRUE;
  86    struct BusContext *context;
  87    ULONG card = 0;
  88    UWORD i = 0, vendor_id, product_id;
  89
  90    /* Find a compatible card */
  91
  92    context = AllocMem(sizeof(struct BusContext), MEMF_PUBLIC | MEMF_CLEAR);
  93    if(context == NULL)
  94       success = FALSE;
  95
  96    if(success)
  97    {
  98       while(i <= index)
  99       {
 100          card = pci_find_device(0xffff, 0xffff, card);
 101          product_id = pci_read_conf_word(card, PCI_DEVICE_ID);
 102          vendor_id = pci_read_conf_word(card, PCI_VENDOR_ID);
 103          if(IsCardCompatible(vendor_id, product_id, base))
 104             i++;
 105       }
 106
 107       context->card = (APTR)card;
 108       if(card == NULL)
 109          success = FALSE;
 110    }
 111
 112    /* Get base address and generation */
 113
 114    if(success)
 115    {
 116       context->io_base = (UPINT)pci_get_base_start(card, BAR_NO);
 117       if(context->io_base == NULL)
 118          success = FALSE;
 119       if((context->io_base & 0xffff0000) == 0xee0000)
 120          context->io_base += 0x10000;
 121       context->generation = GetGeneration(product_id, base);
 122    }
 123
 124    if(!success)
 125    {
 126       FreePowerPCICard(context, base);
 127       context = NULL;
 128    }
 129
 130    return context;
 131 }
 132
 133
 134
 135 /****i* etherlink3.device/FreePowerPCICard *********************************
 136 *
 137 *   NAME
 138 *       FreePowerPCICard -- Release a card.
 139 *
 140 *   SYNOPSIS
 141 *       FreePowerPCICard(context)
 142 *
 143 *       VOID FreePowerPCICard(struct BusContext *);
 144 *
 145 ****************************************************************************
 146 *
 147 */
 148
 149 VOID FreePowerPCICard(struct BusContext *context, struct DevBase *base)
 150 {
 151    if(context != NULL)
 152    {
 153       FreeMem(context, sizeof(struct BusContext));
 154    }
 155
 156    return;
 157 }
 158
 159
 160
 161 /****i* etherlink3.device/AddPowerPCIIntServer *****************************
 162 *
 163 *   NAME
 164 *       AddPowerPCIIntServer
 165 *
 166 *   SYNOPSIS
 167 *       success = AddPowerPCIIntServer(card, interrupt)
 168 *
 169 *       BOOL AddPowerPCIIntServer(APTR, struct Interrupt *);
 170 *
 171 ****************************************************************************
 172 *
 173 */
 174
 175 BOOL AddPowerPCIIntServer(APTR card, struct Interrupt *interrupt,
 176    struct DevBase *base)
 177 {
 178    return pci_add_irq((ULONG)card, interrupt);
 179 }
 180
 181
 182
 183 /****i* etherlink3.device/RemPowerPCIIntServer *****************************
 184 *
 185 *   NAME
 186 *       RemPowerPCIIntServer
 187 *
 188 *   SYNOPSIS
 189 *       RemPowerPCIIntServer(card, interrupt)
 190 *
 191 *       VOID RemPowerPCIIntServer(APTR, struct Interrupt *);
 192 *
 193 ****************************************************************************
 194 *
 195 */
 196
 197 VOID RemPowerPCIIntServer(APTR card, struct Interrupt *interrupt,
 198    struct DevBase *base)
 199 {
 200    pci_rem_irq((ULONG)card, interrupt);
 201
 202    return;
 203 }
 204
 205
 206