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/device.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 pci_dev *pdev = nv_device(bios)->pdev; 57 struct priv *priv = NULL; 58 int ret; 59 60 if (!(ret = pci_enable_rom(pdev))) { 61 if (ret = -ENOMEM, 62 (priv = kmalloc(sizeof(*priv), GFP_KERNEL))) { 63 if (ret = -EFAULT, 64 (priv->rom = pci_map_rom(pdev, &priv->size))) { 65 priv->pdev = pdev; 66 return priv; 67 } 68 kfree(priv); 69 } 70 pci_disable_rom(pdev); 71 } 72 73 return ERR_PTR(ret); 74 } 75 76 const struct nvbios_source 77 nvbios_pcirom = { 78 .name = "PCIROM", 79 .init = pcirom_init, 80 .fini = pcirom_fini, 81 .read = pcirom_read, 82 .rw = true, 83 }; 84 85 static void * 86 platform_init(struct nvkm_bios *bios, const char *name) 87 { 88 struct pci_dev *pdev = nv_device(bios)->pdev; 89 struct priv *priv; 90 int ret = -ENOMEM; 91 92 if ((priv = kmalloc(sizeof(*priv), GFP_KERNEL))) { 93 if (ret = -ENODEV, 94 (priv->rom = pci_platform_rom(pdev, &priv->size))) 95 return priv; 96 kfree(priv); 97 } 98 99 return ERR_PTR(ret); 100 } 101 102 const struct nvbios_source 103 nvbios_platform = { 104 .name = "PLATFORM", 105 .init = platform_init, 106 .fini = (void(*)(void *))kfree, 107 .read = pcirom_read, 108 .rw = true, 109 }; 110