1/*
  2 *  ops-vr41xx.c, PCI configuration routines for the PCIU of NEC VR4100 series.
  3 *
  4 *  Copyright (C) 2001-2003 MontaVista Software Inc.
  5 *    Author: Yoichi Yuasa <source@mvista.com>
  6 *  Copyright (C) 2004-2005  Yoichi Yuasa <yuasa@linux-mips.org>
  7 *
  8 *  This program is free software; you can redistribute it and/or modify
  9 *  it under the terms of the GNU General Public License as published by
 10 *  the Free Software Foundation; either version 2 of the License, or
 11 *  (at your option) any later version.
 12 *
 13 *  This program is distributed in the hope that it will be useful,
 14 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 *  GNU General Public License for more details.
 17 *
 18 *  You should have received a copy of the GNU General Public License
 19 *  along with this program; if not, write to the Free Software
 20 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 21 */
 22/*
 23 * Changes:
 24 *  MontaVista Software Inc. <source@mvista.com>
 25 *  - New creation, NEC VR4122 and VR4131 are supported.
 26 */
 27#include <linux/pci.h>
 28#include <linux/types.h>
 29
 30#include <asm/io.h>
 31
 32#define PCICONFDREG	(void __iomem *)KSEG1ADDR(0x0f000c14)
 33#define PCICONFAREG	(void __iomem *)KSEG1ADDR(0x0f000c18)
 34
 35static inline int set_pci_configuration_address(unsigned char number,
 36                                                unsigned int devfn, int where)
 37{
 38	if (number == 0) {
 39		/*
 40		 * Type 0 configuration
 41		 */
 42		if (PCI_SLOT(devfn) < 11 || where > 0xff)
 43			return -EINVAL;
 44
 45		writel((1U << PCI_SLOT(devfn)) | (PCI_FUNC(devfn) << 8) |
 46		       (where & 0xfc), PCICONFAREG);
 47	} else {
 48		/*
 49		 * Type 1 configuration
 50		 */
 51		if (where > 0xff)
 52			return -EINVAL;
 53
 54		writel(((uint32_t)number << 16) | ((devfn & 0xff) << 8) |
 55		       (where & 0xfc) | 1U, PCICONFAREG);
 56	}
 57
 58	return 0;
 59}
 60
 61static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
 62                           int size, uint32_t *val)
 63{
 64	uint32_t data;
 65
 66	*val = 0xffffffffU;
 67	if (set_pci_configuration_address(bus->number, devfn, where) < 0)
 68		return PCIBIOS_DEVICE_NOT_FOUND;
 69
 70	data = readl(PCICONFDREG);
 71
 72	switch (size) {
 73	case 1:
 74		*val = (data >> ((where & 3) << 3)) & 0xffU;
 75		break;
 76	case 2:
 77		*val = (data >> ((where & 2) << 3)) & 0xffffU;
 78		break;
 79	case 4:
 80		*val = data;
 81		break;
 82	default:
 83		return PCIBIOS_FUNC_NOT_SUPPORTED;
 84	}
 85
 86	return PCIBIOS_SUCCESSFUL;
 87}
 88
 89static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
 90                            int size, uint32_t val)
 91{
 92	uint32_t data;
 93	int shift;
 94
 95	if (set_pci_configuration_address(bus->number, devfn, where) < 0)
 96		return PCIBIOS_DEVICE_NOT_FOUND;
 97
 98	data = readl(PCICONFDREG);
 99
100	switch (size) {
101	case 1:
102		shift = (where & 3) << 3;
103		data &= ~(0xffU << shift);
104		data |= ((val & 0xffU) << shift);
105		break;
106	case 2:
107		shift = (where & 2) << 3;
108		data &= ~(0xffffU << shift);
109		data |= ((val & 0xffffU) << shift);
110		break;
111	case 4:
112		data = val;
113		break;
114	default:
115		return PCIBIOS_FUNC_NOT_SUPPORTED;
116	}
117
118	writel(data, PCICONFDREG);
119
120	return PCIBIOS_SUCCESSFUL;
121}
122
123struct pci_ops vr41xx_pci_ops = {
124	.read	= pci_config_read,
125	.write	= pci_config_write,
126};