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 27 struct priv { 28 struct pci_dev *pdev; 29 void __iomem *rom; 30 size_t size; 31 }; 32 33 static u32 34 pcirom_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 44 static void 45 pcirom_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 53 static void * 54 pcirom_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 82 const struct nvbios_source 83 nvbios_pcirom = { 84 .name = "PCIROM", 85 .init = pcirom_init, 86 .fini = pcirom_fini, 87 .read = pcirom_read, 88 .rw = true, 89 }; 90 91 static void * 92 platform_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 ((priv = kmalloc(sizeof(*priv), GFP_KERNEL))) { 105 if (ret = -ENODEV, 106 (priv->rom = pci_platform_rom(pdev, &priv->size))) 107 return priv; 108 kfree(priv); 109 } 110 111 return ERR_PTR(ret); 112 } 113 114 const struct nvbios_source 115 nvbios_platform = { 116 .name = "PLATFORM", 117 .init = platform_init, 118 .fini = (void(*)(void *))kfree, 119 .read = pcirom_read, 120 .rw = true, 121 }; 122