workbench/devs/networks/intelpro100/powerpci.c

   1 /*
   2
   3 Copyright (C) 2004,2005 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* intelpro100.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* intelpro100.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 */
 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    }
 122
 123    if(!success)
 124    {
 125       FreePowerPCICard(context, base);
 126       context = NULL;
 127    }
 128
 129    return context;
 130 }
 131
 132
 133
 134 /****i* intelpro100.device/FreePowerPCICard ********************************
 135 *
 136 *   NAME
 137 *       FreePowerPCICard -- Release a card.
 138 *
 139 *   SYNOPSIS
 140 *       FreePowerPCICard(context)
 141 *
 142 *       VOID FreePowerPCICard(struct BusContext *);
 143 *
 144 ****************************************************************************
 145 *
 146 */
 147
 148 VOID FreePowerPCICard(struct BusContext *context, struct DevBase *base)
 149 {
 150    if(context != NULL)
 151    {
 152       FreeMem(context, sizeof(struct BusContext));
 153    }
 154
 155    return;
 156 }
 157
 158
 159
 160 /****i* intelpro100.device/AddPowerPCIIntServer ****************************
 161 *
 162 *   NAME
 163 *       AddPowerPCIIntServer
 164 *
 165 *   SYNOPSIS
 166 *       context = AddPowerPCIIntServer(index)
 167 *
 168 *       struct BusContext *AddPowerPCIIntServer(ULONG);
 169 *
 170 ****************************************************************************
 171 *
 172 */
 173
 174 BOOL AddPowerPCIIntServer(APTR card, struct Interrupt *interrupt,
 175    struct DevBase *base)
 176 {
 177    return pci_add_irq((ULONG)card, interrupt);
 178 }
 179
 180
 181
 182 /****i* intelpro100.device/RemPowerPCIIntServer ****************************
 183 *
 184 *   NAME
 185 *       RemPowerPCIIntServer
 186 *
 187 *   SYNOPSIS
 188 *       RemPowerPCIIntServer()
 189 *
 190 *       VOID RemPowerPCIIntServer(ULONG);
 191 *
 192 ****************************************************************************
 193 *
 194 */
 195
 196 VOID RemPowerPCIIntServer(APTR card, struct Interrupt *interrupt,
 197    struct DevBase *base)
 198 {
 199    pci_rem_irq((ULONG)card, interrupt);
 200
 201    return;
 202 }
 203
 204
 205