132 lines
3.8 KiB
C
132 lines
3.8 KiB
C
/*
|
|
* Copyright (C) 1994-2003 The XFree86 Project, Inc. All Rights Reserved.
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person
|
|
* obtaining a copy of this software and associated documentation
|
|
* files (the "Software"), to deal in the Software without
|
|
* restriction, including without limitation the rights to use, copy,
|
|
* modify, merge, publish, distribute, sublicense, and/or sell copies
|
|
* of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be
|
|
* included in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE XFREE86 PROJECT BE LIABLE
|
|
* FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF
|
|
* CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
|
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
|
*
|
|
* Except as contained in this notice, the name of the XFree86 Project
|
|
* shall not be used in advertising or otherwise to promote the sale,
|
|
* use or other dealings in this Software without prior written
|
|
* authorization from the XFree86 Project.
|
|
*/
|
|
|
|
#ifdef HAVE_XORG_CONFIG_H
|
|
#include <xorg-config.h>
|
|
#endif
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/mman.h>
|
|
#include <sys/ioctl.h>
|
|
#include <fcntl.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <dev/pci/pciio.h>
|
|
|
|
#include "xf86.h"
|
|
#include "xf86Priv.h"
|
|
#include "xf86OSpriv.h"
|
|
|
|
#include "Pci.h"
|
|
|
|
static CARD32 netbsdPciConfRead(PCITAG, int);
|
|
static void netbsdPciConfWrite(PCITAG, int, CARD32);
|
|
static void netbsdPciSetBits(PCITAG, int, CARD32, CARD32);
|
|
|
|
static int devpci = -1;
|
|
|
|
static pciBusFuncs_t netbsdFuncs0 = {
|
|
/* pciReadLong */ netbsdPciConfRead,
|
|
/* pciWriteLong */ netbsdPciConfWrite,
|
|
/* pciSetBitsLong */ netbsdPciSetBits,
|
|
/* pciAddrHostToBus */ pciAddrNOOP,
|
|
/* pciAddrBusToHost */ pciAddrNOOP
|
|
};
|
|
|
|
static pciBusInfo_t netbsdPci0 = {
|
|
/* configMech */ PCI_CFG_MECH_OTHER,
|
|
/* numDevices */ 32,
|
|
/* secondary */ FALSE,
|
|
/* primary_bus */ 0,
|
|
/* funcs */ &netbsdFuncs0,
|
|
/* pciBusPriv */ NULL,
|
|
/* bridge */ NULL
|
|
};
|
|
|
|
void
|
|
netbsdPciInit()
|
|
{
|
|
struct pciio_businfo pci_businfo;
|
|
|
|
devpci = open("/dev/pci0", O_RDWR);
|
|
if (devpci == -1)
|
|
FatalError("netbsdPciInit: can't open /dev/pci0\n");
|
|
|
|
pciNumBuses = 1;
|
|
pciBusInfo[0] = &netbsdPci0;
|
|
pciFindFirstFP = pciGenFindFirst;
|
|
pciFindNextFP = pciGenFindNext;
|
|
/* use businfo to get the number of devs */
|
|
if (ioctl(devpci, PCI_IOC_BUSINFO, &pci_businfo) != 0)
|
|
FatalError("netbsdPciInit: not a PCI bus device");
|
|
netbsdPci0.numDevices = pci_businfo.maxdevs;
|
|
}
|
|
|
|
static CARD32
|
|
netbsdPciConfRead(PCITAG tag, int reg)
|
|
{
|
|
struct pciio_bdf_cfgreg bdfr;
|
|
|
|
bdfr.bus = PCI_BUS_FROM_TAG(tag);
|
|
bdfr.device = PCI_DEV_FROM_TAG(tag);
|
|
bdfr.function = PCI_FUNC_FROM_TAG(tag);
|
|
bdfr.cfgreg.reg = reg;
|
|
|
|
if (ioctl(devpci, PCI_IOC_BDF_CFGREAD, &bdfr) == -1)
|
|
FatalError("netbsdPciConfRead: failed on %d/%d/%d\n",
|
|
bdfr.bus, bdfr.device, bdfr.function);
|
|
|
|
return (bdfr.cfgreg.val);
|
|
}
|
|
|
|
static void
|
|
netbsdPciConfWrite(PCITAG tag, int reg, CARD32 val)
|
|
{
|
|
struct pciio_bdf_cfgreg bdfr;
|
|
|
|
bdfr.bus = PCI_BUS_FROM_TAG(tag);
|
|
bdfr.device = PCI_DEV_FROM_TAG(tag);
|
|
bdfr.function = PCI_FUNC_FROM_TAG(tag);
|
|
bdfr.cfgreg.reg = reg;
|
|
bdfr.cfgreg.val = val;
|
|
|
|
if (ioctl(devpci, PCI_IOC_BDF_CFGWRITE, &bdfr) == -1)
|
|
FatalError("netbsdPciConfWrite: failed on %d/%d/%d\n",
|
|
bdfr.bus, bdfr.device, bdfr.function);
|
|
}
|
|
|
|
static void
|
|
netbsdPciSetBits(PCITAG tag, int reg, CARD32 mask, CARD32 bits)
|
|
{
|
|
CARD32 val;
|
|
|
|
val = netbsdPciConfRead(tag, reg);
|
|
val = (val & ~mask) | (bits & mask);
|
|
netbsdPciConfWrite(tag, reg, val);
|
|
}
|