]>
Commit | Line | Data |
---|---|---|
83fd885b | 1 | /* |
61829219 | 2 | * The PCI Library -- Direct Configuration access via SylixOS Ports |
83fd885b | 3 | * |
61829219 | 4 | * Copyright (c) 2018 YuJian.Gong <gongyujian@acoinfo.com> |
83fd885b | 5 | * |
61829219 MM |
6 | * Can be freely distributed and used under the terms of the GNU GPL v2+. |
7 | * | |
8 | * SPDX-License-Identifier: GPL-2.0-or-later | |
83fd885b MM |
9 | */ |
10 | ||
11 | #define _GNU_SOURCE | |
12 | #define __SYLIXOS_KERNEL | |
13 | #define __SYLIXOS_PCI_DRV | |
14 | #include <SylixOS.h> | |
15 | #include <stdlib.h> | |
16 | #include <string.h> | |
17 | ||
18 | #include "internal.h" | |
19 | ||
83fd885b MM |
20 | static void |
21 | sylixos_scan(struct pci_access *a) | |
22 | { | |
83fd885b | 23 | u8 busmap[256]; |
6c201b8f | 24 | int bus; |
83fd885b MM |
25 | |
26 | memset(busmap, 0, sizeof(busmap)); | |
27 | ||
6c201b8f MM |
28 | for (bus = 0; bus < PCI_MAX_BUS; bus++) |
29 | if (!busmap[bus]) | |
8d750a8d | 30 | pci_generic_scan_bus(a, busmap, 0, bus); |
83fd885b MM |
31 | } |
32 | ||
33 | static void | |
34 | sylixos_config(struct pci_access *a) | |
35 | { | |
36 | pci_define_param(a, "sylixos.path", PCI_PATH_SYLIXOS_DEVICE, "Path to the SylixOS PCI device"); | |
37 | } | |
38 | ||
39 | static int | |
40 | sylixos_detect(struct pci_access *a) | |
41 | { | |
42 | char *name = pci_get_param(a, "sylixos.path"); | |
43 | ||
44 | if (access(name, R_OK)) | |
45 | { | |
46 | a->warning("Cannot open %s", name); | |
47 | return 0; | |
48 | } | |
49 | ||
50 | a->debug("...using %s", name); | |
83fd885b MM |
51 | return 1; |
52 | } | |
53 | ||
54 | static void | |
6c201b8f | 55 | sylixos_init(struct pci_access *a UNUSED) |
83fd885b | 56 | { |
83fd885b MM |
57 | } |
58 | ||
59 | static void | |
6c201b8f | 60 | sylixos_cleanup(struct pci_access *a UNUSED) |
83fd885b | 61 | { |
83fd885b MM |
62 | } |
63 | ||
64 | static int | |
65 | sylixos_read(struct pci_dev *d, int pos, byte *buf, int len) | |
66 | { | |
67 | int ret = -1; | |
68 | u8 data_byte = -1; | |
69 | u16 data_word = -1; | |
70 | u32 data_dword = -1; | |
71 | ||
72 | if (!(len == 1 || len == 2 || len == 4)) | |
278efb21 | 73 | return pci_generic_block_read(d, pos, buf, len); |
83fd885b MM |
74 | |
75 | if (pos >= 256) | |
278efb21 | 76 | return 0; |
83fd885b MM |
77 | |
78 | switch (len) | |
79 | { | |
80 | case 1: | |
81 | ret = pciConfigInByte(d->bus, d->dev, d->func, pos, &data_byte); | |
82 | if (ret != ERROR_NONE) | |
278efb21 | 83 | return 0; |
83fd885b MM |
84 | buf[0] = (u8)data_byte; |
85 | break; | |
86 | ||
87 | case 2: | |
88 | ret = pciConfigInWord(d->bus, d->dev, d->func, pos, &data_word); | |
89 | if (ret != ERROR_NONE) | |
278efb21 | 90 | return 0; |
83fd885b MM |
91 | ((u16 *) buf)[0] = cpu_to_le16(data_word); |
92 | break; | |
93 | ||
94 | case 4: | |
95 | ret = pciConfigInDword(d->bus, d->dev, d->func, pos, &data_dword); | |
96 | if (ret != ERROR_NONE) | |
278efb21 | 97 | return 0; |
83fd885b MM |
98 | ((u32 *) buf)[0] = cpu_to_le32(data_dword); |
99 | break; | |
100 | } | |
101 | ||
102 | return 1; | |
103 | } | |
104 | ||
105 | static int | |
106 | sylixos_write(struct pci_dev *d, int pos, byte *buf, int len) | |
107 | { | |
108 | int ret = PX_ERROR; | |
109 | u8 data_byte; | |
110 | u16 data_word; | |
111 | u32 data_dword; | |
112 | ||
113 | if (!(len == 1 || len == 2 || len == 4)) | |
278efb21 | 114 | return pci_generic_block_write(d, pos, buf, len); |
83fd885b MM |
115 | |
116 | if (pos >= 256) | |
278efb21 | 117 | return 0; |
83fd885b MM |
118 | |
119 | switch (len) | |
120 | { | |
121 | case 1: | |
122 | data_byte = buf[0]; | |
123 | ret = pciConfigOutByte(d->bus, d->dev, d->func, pos, data_byte); | |
124 | if (ret != ERROR_NONE) | |
278efb21 | 125 | return 0; |
83fd885b MM |
126 | break; |
127 | ||
128 | case 2: | |
129 | data_word = le16_to_cpu(((u16 *) buf)[0]); | |
130 | ret = pciConfigOutWord(d->bus, d->dev, d->func, pos, data_word); | |
131 | if (ret != ERROR_NONE) | |
278efb21 | 132 | return 0; |
83fd885b MM |
133 | break; |
134 | ||
135 | case 4: | |
136 | data_dword = le32_to_cpu(((u32 *) buf)[0]); | |
137 | ret = pciConfigOutDword(d->bus, d->dev, d->func, pos, data_dword); | |
138 | if (ret != ERROR_NONE) | |
278efb21 | 139 | return 0; |
83fd885b MM |
140 | break; |
141 | } | |
142 | ||
143 | return 1; | |
144 | } | |
145 | ||
146 | struct pci_methods pm_sylixos_device = { | |
1660c737 MM |
147 | .name = "sylixos-device", |
148 | .help = "SylixOS /proc/pci device", | |
149 | .config = sylixos_config, | |
150 | .detect = sylixos_detect, | |
151 | .init = sylixos_init, | |
152 | .cleanup = sylixos_cleanup, | |
153 | .scan = sylixos_scan, | |
154 | .fill_info = pci_generic_fill_info, | |
155 | .read = sylixos_read, | |
156 | .write = sylixos_write, | |
83fd885b | 157 | }; |