]>
Commit | Line | Data |
---|---|---|
90d08965 JW |
1 | #include <sys/types.h> |
2 | #include <sys/stat.h> | |
3 | #include <fcntl.h> | |
4 | #include <stdio.h> | |
5 | #include <inttypes.h> | |
6 | ||
81148fa1 | 7 | #include "../include/pci.h" |
7e16b8e6 | 8 | |
90d08965 JW |
9 | static int _open(int bus, int slot, int fn) |
10 | { | |
11 | char fname[512]; | |
12 | ||
13 | sprintf(fname, "/proc/bus/pci/%02x/%02x.%01x", bus, slot, fn); | |
14 | return open(fname, O_RDWR); | |
15 | } | |
16 | ||
17 | void pci_write32(int bus, int slot, int fn, int addr, uint32_t data) | |
18 | { | |
19 | int fd; | |
20 | ||
21 | fd = _open(bus, slot, fn); | |
22 | if (fd < 0) | |
23 | return; | |
24 | lseek(fd, addr, SEEK_SET); | |
25 | write(fd, &data, 4); | |
26 | close(fd); | |
27 | } | |
28 | ||
29 | void pci_write16(int bus, int slot, int fn, int addr, uint16_t data) | |
30 | { | |
31 | int fd; | |
32 | ||
33 | fd = _open(bus, slot, fn); | |
34 | if (fd < 0) | |
35 | return; | |
36 | lseek(fd, addr, SEEK_SET); | |
37 | write(fd, &data, 2); | |
38 | close(fd); | |
39 | } | |
40 | ||
41 | void pci_write8(int bus, int slot, int fn, int addr, uint8_t data) | |
42 | { | |
43 | int fd; | |
44 | ||
45 | fd = _open(bus, slot, fn); | |
46 | if (fd < 0) | |
47 | return; | |
48 | lseek(fd, addr, SEEK_SET); | |
49 | write(fd, &data, 1); | |
50 | close(fd); | |
51 | } | |
52 | ||
53 | uint32_t pci_read32(int bus, int slot, int fn, int addr) | |
54 | { | |
55 | int fd; | |
56 | uint32_t data; | |
57 | ||
58 | fd = _open(bus, slot, fn); | |
59 | if (fd < 0) | |
60 | return; | |
61 | lseek(fd, addr, SEEK_SET); | |
62 | read(fd, &data, 4); | |
63 | close(fd); | |
64 | ||
65 | return data; | |
66 | } | |
67 | ||
68 | uint16_t pci_read16(int bus, int slot, int fn, int addr) | |
69 | { | |
70 | int fd; | |
71 | uint16_t data; | |
72 | ||
73 | fd = _open(bus, slot, fn); | |
74 | if (fd < 0) | |
75 | { | |
76 | perror("open"); | |
77 | return; | |
78 | } | |
79 | lseek(fd, addr, SEEK_SET); | |
80 | read(fd, &data, 2); | |
81 | close(fd); | |
82 | ||
83 | return data; | |
84 | } | |
85 | ||
86 | ||
87 | uint8_t pci_read8(int bus, int slot, int fn, int addr) | |
88 | { | |
89 | int fd; | |
90 | uint8_t data; | |
91 | ||
92 | fd = _open(bus, slot, fn); | |
93 | if (fd < 0) | |
94 | { | |
95 | perror("open"); | |
96 | return; | |
97 | } | |
98 | lseek(fd, addr, SEEK_SET); | |
99 | read(fd, &data, 1); | |
100 | close(fd); | |
101 | ||
102 | return data; | |
103 | } |