pci_cfgreg.c revision 203106
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: head/sys/ia64/pci/pci_cfgreg.c 203106 2010-01-28 04:50:09Z marcel $ 28 */ 29 30#include <sys/param.h> 31#include <machine/pci_cfgreg.h> 32#include <machine/sal.h> 33 34static u_long 35pci_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 49static int 50pci_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 59int 60pci_cfgregopen(void) 61{ 62 return (1); 63} 64 65uint32_t 66pci_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 85void 86pci_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} 100