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
pcirom_read(void * data,u32 offset,u32 length,struct nvkm_bios * bios)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
pcirom_fini(void * data)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 *
pcirom_init(struct nvkm_bios * bios,const char * name)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 *
platform_init(struct nvkm_bios * bios,const char * name)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 (!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
118 static void
platform_fini(void * data)119 platform_fini(void *data)
120 {
121 struct priv *priv = data;
122
123 iounmap(priv->rom);
124 kfree(priv);
125 }
126
127 const struct nvbios_source
128 nvbios_platform = {
129 .name = "PLATFORM",
130 .init = platform_init,
131 .fini = platform_fini,
132 .read = pcirom_read,
133 .rw = true,
134 };
135