shadowpci.c

  1/*
  2 * Copyright 2012 Red Hat Inc.
  3 *
  4 * Permission is hereby granted, free of charge, to any person obtaining a
  5 * copy of this software and associated documentation files (the "Software"),
  6 * to deal in the Software without restriction, including without limitation
  7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8 * and/or sell copies of the Software, and to permit persons to whom the
  9 * Software is furnished to do so, subject to the following conditions:
 10 *
 11 * The above copyright notice and this permission notice shall be included in
 12 * all copies or substantial portions of the Software.
 13 *
 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 20 * OTHER DEALINGS IN THE SOFTWARE.
 21 *
 22 */
 23#include "priv.h"
 24
 25#include <core/pci.h>
 26
 27struct priv {
 28	struct pci_dev *pdev;
 29	void __iomem *rom;
 30	size_t size;
 31};
 32
 33static u32
 34pcirom_read(void *data, u32 offset, u32 length, struct nvkm_bios *bios)
 35{
 36	struct priv *priv = data;
 37	if (offset + length <= priv->size) {
 38		memcpy_fromio(bios->data + offset, priv->rom + offset, length);
 39		return length;
 40	}
 41	return 0;
 42}
 43
 44static void
 45pcirom_fini(void *data)
 46{
 47	struct priv *priv = data;
 48	pci_unmap_rom(priv->pdev, priv->rom);
 49	pci_disable_rom(priv->pdev);
 50	kfree(priv);
 51}
 52
 53static void *
 54pcirom_init(struct nvkm_bios *bios, const char *name)
 55{
 56	struct nvkm_device *device = bios->subdev.device;
 57	struct priv *priv = NULL;
 58	struct pci_dev *pdev;
 59	int ret;
 60
 61	if (device->func->pci)
 62		pdev = device->func->pci(device)->pdev;
 63	else
 64		return ERR_PTR(-ENODEV);
 65
 66	if (!(ret = pci_enable_rom(pdev))) {
 67		if (ret = -ENOMEM,
 68		    (priv = kmalloc(sizeof(*priv), GFP_KERNEL))) {
 69			if (ret = -EFAULT,
 70			    (priv->rom = pci_map_rom(pdev, &priv->size))) {
 71				priv->pdev = pdev;
 72				return priv;
 73			}
 74			kfree(priv);
 75		}
 76		pci_disable_rom(pdev);
 77	}
 78
 79	return ERR_PTR(ret);
 80}
 81
 82const struct nvbios_source
 83nvbios_pcirom = {
 84	.name = "PCIROM",
 85	.init = pcirom_init,
 86	.fini = pcirom_fini,
 87	.read = pcirom_read,
 88	.rw = true,
 89};
 90
 91static void *
 92platform_init(struct nvkm_bios *bios, const char *name)
 93{
 94	struct nvkm_device *device = bios->subdev.device;
 95	struct pci_dev *pdev;
 96	struct priv *priv;
 97	int ret = -ENOMEM;
 98
 99	if (device->func->pci)
100		pdev = device->func->pci(device)->pdev;
101	else
102		return ERR_PTR(-ENODEV);
103
104	if (!pdev->rom || pdev->romlen == 0)
105		return ERR_PTR(-ENODEV);
106
107	if ((priv = kmalloc(sizeof(*priv), GFP_KERNEL))) {
108		priv->size = pdev->romlen;
109		if (ret = -ENODEV,
110		    (priv->rom = ioremap(pdev->rom, pdev->romlen)))
111			return priv;
112		kfree(priv);
113	}
114
115	return ERR_PTR(ret);
116}
117
118static void
119platform_fini(void *data)
120{
121	struct priv *priv = data;
122
123	iounmap(priv->rom);
124	kfree(priv);
125}
126
127const struct nvbios_source
128nvbios_platform = {
129	.name = "PLATFORM",
130	.init = platform_init,
131	.fini = platform_fini,
132	.read = pcirom_read,
133	.rw = true,
134};