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 struct priv { 26 struct pci_dev *pdev; 27 void __iomem *rom; 28 size_t size; 29 }; 30 31 static u32 32 pcirom_read(void *data, u32 offset, u32 length, struct nvkm_bios *bios) 33 { 34 struct priv *priv = data; 35 if (offset + length <= priv->size) { 36 memcpy_fromio(bios->data + offset, priv->rom + offset, length); 37 return length; 38 } 39 return 0; 40 } 41 42 static void 43 pcirom_fini(void *data) 44 { 45 struct priv *priv = data; 46 pci_unmap_rom(priv->pdev, priv->rom); 47 pci_disable_rom(priv->pdev); 48 kfree(priv); 49 } 50 51 static void * 52 pcirom_init(struct nvkm_bios *bios, const char *name) 53 { 54 struct pci_dev *pdev = bios->subdev.device->pdev; 55 struct priv *priv = NULL; 56 int ret; 57 58 if (!(ret = pci_enable_rom(pdev))) { 59 if (ret = -ENOMEM, 60 (priv = kmalloc(sizeof(*priv), GFP_KERNEL))) { 61 if (ret = -EFAULT, 62 (priv->rom = pci_map_rom(pdev, &priv->size))) { 63 priv->pdev = pdev; 64 return priv; 65 } 66 kfree(priv); 67 } 68 pci_disable_rom(pdev); 69 } 70 71 return ERR_PTR(ret); 72 } 73 74 const struct nvbios_source 75 nvbios_pcirom = { 76 .name = "PCIROM", 77 .init = pcirom_init, 78 .fini = pcirom_fini, 79 .read = pcirom_read, 80 .rw = true, 81 }; 82 83 static void * 84 platform_init(struct nvkm_bios *bios, const char *name) 85 { 86 struct pci_dev *pdev = bios->subdev.device->pdev; 87 struct priv *priv; 88 int ret = -ENOMEM; 89 90 if ((priv = kmalloc(sizeof(*priv), GFP_KERNEL))) { 91 if (ret = -ENODEV, 92 (priv->rom = pci_platform_rom(pdev, &priv->size))) 93 return priv; 94 kfree(priv); 95 } 96 97 return ERR_PTR(ret); 98 } 99 100 const struct nvbios_source 101 nvbios_platform = { 102 .name = "PLATFORM", 103 .init = platform_init, 104 .fini = (void(*)(void *))kfree, 105 .read = pcirom_read, 106 .rw = true, 107 }; 108