sys/ia64/pci/pci_cfgreg.c

   1 /*-
   2  * Copyright (c) 2010 Marcel Moolenaar
   3  * Copyright (c) 2001 Doug Rabson
   4  * All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  16  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  18  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  21  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  25  * SUCH DAMAGE.
  26  *
  27  * $FreeBSD$
  28  */
  29
  30 #include <sys/param.h>
  31 #include <machine/pci_cfgreg.h>
  32 #include <machine/sal.h>
  33
  34 static u_long
  35 pci_sal_address(int dom, int bus, int slot, int func, int reg)
  36 {
  37         u_long addr;
  38
  39         addr = ~0ul;
  40         if (dom >= 0 && dom <= 255 && bus >= 0 && bus <= 255 &&
  41             slot >= 0 && slot <= 31 && func >= 0 && func <= 7 &&
  42             reg >= 0 && reg <= 255) {
  43                 addr = ((u_long)dom << 24) | ((u_long)bus << 16) |
  44                     ((u_long)slot << 11) | ((u_long)func << 8) | (u_long)reg;
  45         }
  46         return (addr);
  47 }
  48
  49 static int
  50 pci_valid_access(int reg, int len)
  51 {
  52         int ok;
  53
  54         ok = ((len == 1 || len == 2 || len == 4) && (reg & (len - 1)) == 0)
  55             ? 1 : 0;
  56         return (ok);
  57 }
  58
  59 int
  60 pci_cfgregopen(void)
  61 {
  62         return (1);
  63 }
  64
  65 uint32_t
  66 pci_cfgregread(int bus, int slot, int func, int reg, int len)
  67 {
  68         struct ia64_sal_result res;
  69         u_long addr;
  70
  71         addr = pci_sal_address(0, bus, slot, func, reg);
  72         if (addr == ~0ul)
  73                 return (~0);
  74
  75         if (!pci_valid_access(reg, len))
  76                 return (~0);
  77
  78         res = ia64_sal_entry(SAL_PCI_CONFIG_READ, addr, len, 0, 0, 0, 0, 0);
  79         if (res.sal_status < 0)
  80                 return (~0);
  81
  82         return (res.sal_result[0]);
  83 }
  84
  85 void
  86 pci_cfgregwrite(int bus, int slot, int func, int reg, uint32_t data, int len)
  87 {
  88         struct ia64_sal_result res;
  89         u_long addr;
  90
  91         addr = pci_sal_address(0, bus, slot, func, reg);
  92         if (addr == ~0ul)
  93                 return;
  94
  95         if (!pci_valid_access(reg, len))
  96                 return;
  97
  98         res = ia64_sal_entry(SAL_PCI_CONFIG_WRITE, addr, len, data, 0, 0, 0, 0);
  99 }