1 /*
2 * Common Option ROM Functions for fw_cfg
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, see <http://www.gnu.org/licenses/>.
16 *
17 * Copyright (c) 2015-2019 Red Hat Inc.
18 * Authors:
19 * Marc Marí <marc.mari.barcelo@gmail.com>
20 * Richard W.M. Jones <rjones@redhat.com>
21 * Stefano Garzarella <sgarzare@redhat.com>
22 */
23
24 #ifndef OPTROM_FW_CFG_H
25 #define OPTROM_FW_CFG_H
26
27 #include "../../include/standard-headers/linux/qemu_fw_cfg.h"
28
29 #define BIOS_CFG_IOPORT_CFG 0x510
30 #define BIOS_CFG_IOPORT_DATA 0x511
31 #define BIOS_CFG_DMA_ADDR_HIGH 0x514
32 #define BIOS_CFG_DMA_ADDR_LOW 0x518
33
34 static __attribute__((unused))
bios_cfg_select(uint16_t key)35 void bios_cfg_select(uint16_t key)
36 {
37 outw(key, BIOS_CFG_IOPORT_CFG);
38 }
39
40 static __attribute__((unused))
bios_cfg_read_entry_io(void * buf,uint16_t entry,uint32_t len)41 void bios_cfg_read_entry_io(void *buf, uint16_t entry, uint32_t len)
42 {
43 bios_cfg_select(entry);
44 insb(BIOS_CFG_IOPORT_DATA, buf, len);
45 }
46
47 /*
48 * clang is happy to inline this function, and bloats the
49 * ROM.
50 */
51 static __attribute__((__noinline__)) __attribute__((unused))
bios_cfg_read_entry_dma(void * buf,uint16_t entry,uint32_t len)52 void bios_cfg_read_entry_dma(void *buf, uint16_t entry, uint32_t len)
53 {
54 struct fw_cfg_dma_access access;
55 uint32_t control = (entry << 16) | FW_CFG_DMA_CTL_SELECT
56 | FW_CFG_DMA_CTL_READ;
57
58 access.address = cpu_to_be64((uint64_t)(uint32_t)buf);
59 access.length = cpu_to_be32(len);
60 access.control = cpu_to_be32(control);
61
62 barrier();
63
64 outl(cpu_to_be32((uint32_t)&access), BIOS_CFG_DMA_ADDR_LOW);
65
66 while (be32_to_cpu(access.control) & ~FW_CFG_DMA_CTL_ERROR) {
67 barrier();
68 }
69 }
70
71 static __attribute__((unused))
bios_cfg_read_entry(void * buf,uint16_t entry,uint32_t len,uint32_t version)72 void bios_cfg_read_entry(void *buf, uint16_t entry, uint32_t len,
73 uint32_t version)
74 {
75 if (version & FW_CFG_VERSION_DMA) {
76 bios_cfg_read_entry_dma(buf, entry, len);
77 } else {
78 bios_cfg_read_entry_io(buf, entry, len);
79 }
80 }
81
82 static __attribute__((unused))
bios_cfg_version(void)83 uint32_t bios_cfg_version(void)
84 {
85 uint32_t version;
86
87 bios_cfg_read_entry_io(&version, FW_CFG_ID, sizeof(version));
88
89 return version;
90 }
91
92 #endif /* OPTROM_FW_CFG_H */
93