cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

shadowpci.c (3205B)

      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};