3973
|
1 /*
|
|
2 libgha.c - Library for direct hardware access
|
|
3 Copyrights:
|
|
4 1996/10/27 - Robin Cutshaw (robin@xfree86.org)
|
|
5 XFree86 3.3.3 implementation
|
|
6 1999 - �yvind Aabling.
|
|
7 Modified for GATOS/win/gfxdump.
|
|
8
|
|
9 2002 - library implementation by Nick Kurshev
|
4474
|
10 - dhahelper and some changes by Alex Beregszaszi
|
3973
|
11
|
|
12 supported O/S's: SVR4, UnixWare, SCO, Solaris,
|
|
13 FreeBSD, NetBSD, 386BSD, BSDI BSD/386,
|
|
14 Linux, Mach/386, ISC
|
|
15 DOS (WATCOM 9.5 compiler), Win9x (with mapdev.vxd)
|
|
16 Licence: GPL
|
|
17 Original location: www.linuxvideo.org/gatos
|
|
18 */
|
|
19
|
4474
|
20 #include "config.h"
|
|
21
|
3973
|
22 #include "libdha.h"
|
|
23 #include "AsmMacros.h"
|
|
24 #include <stdio.h>
|
|
25 #include <stdlib.h>
|
|
26 #include <string.h>
|
|
27 #include <fcntl.h>
|
|
28 #include <sys/stat.h>
|
|
29 #include <sys/types.h>
|
5702
|
30 #ifdef ARCH_ALPHA
|
|
31 #include <sys/io.h>
|
|
32 #endif
|
3973
|
33 #include <unistd.h>
|
|
34
|
12069
|
35 #if defined(WIN32)
|
4164
|
36 #include "sysdep/libdha_win32.c"
|
|
37 #elif defined (__EMX__)
|
|
38 #include "sysdep/libdha_os2.c"
|
|
39 #else
|
3973
|
40
|
4164
|
41 #if defined(SVR4) || defined(SCO325)
|
|
42 # if !(defined(sun) && defined (i386) && defined (SVR4))
|
|
43 # define DEV_MEM "/dev/pmem"
|
|
44 # elif defined(PowerMAX_OS)
|
|
45 # define DEV_MEM "/dev/iomem"
|
|
46 # endif
|
|
47 # ifdef SCO325
|
|
48 # undef DEV_MEM
|
|
49 # define DEV_MEM "/dev/mem"
|
|
50 # endif
|
|
51 # endif /* SVR4 */
|
3973
|
52
|
14567
|
53 #if defined(__OpenBSD__)
|
|
54 #define DEV_APERTURE "/dev/xf86"
|
|
55 #endif
|
|
56
|
4164
|
57 /* Generic version */
|
|
58 #include <sys/mman.h>
|
3973
|
59
|
4164
|
60 #ifndef DEV_MEM
|
|
61 #define DEV_MEM "/dev/mem"
|
|
62 #endif
|
3973
|
63
|
4474
|
64 #ifdef CONFIG_DHAHELPER
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
65 #include "kernelhelper/dhahelper.h"
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
66 #endif
|
4938
|
67
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
68 #ifdef CONFIG_SVGAHELPER
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
69 #include <svgalib_helper.h>
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
70 #endif
|
4938
|
71
|
9025
|
72 static int mem_fd = -1;
|
|
73
|
5702
|
74 void *map_phys_mem(unsigned long base, unsigned long size)
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
75 {
|
5702
|
76 #ifdef ARCH_ALPHA
|
|
77 /* TODO: move it into sysdep */
|
|
78 base += bus_base();
|
|
79 #endif
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
80
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
81 #ifdef CONFIG_SVGAHELPER
|
9025
|
82 if ( (mem_fd = open(DEV_SVGA,O_RDWR)) == -1) {
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
83 perror("libdha: SVGAlib kernelhelper failed");
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
84 #ifdef CONFIG_DHAHELPER
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
85 goto dha_helper_way;
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
86 #else
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
87 goto dev_mem_way;
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
88 #endif
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
89 }
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
90 else
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
91 goto mmap;
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
92 #endif
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
93
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
94 #ifdef CONFIG_DHAHELPER
|
9219
|
95 #ifdef CONFIG_SVGAHELPER
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
96 dha_helper_way:
|
9219
|
97 #endif
|
9025
|
98 if ( (mem_fd = open("/dev/dhahelper",O_RDWR)) < 0)
|
4474
|
99 {
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
100 perror("libdha: DHA kernelhelper failed");
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
101 goto dev_mem_way;
|
4474
|
102 }
|
|
103 else
|
|
104 {
|
|
105 dhahelper_memory_t mem_req;
|
|
106
|
|
107 mem_req.operation = MEMORY_OP_MAP;
|
|
108 mem_req.start = base;
|
|
109 mem_req.offset = 0;
|
|
110 mem_req.size = size;
|
|
111
|
9025
|
112 if (ioctl(mem_fd, DHAHELPER_MEMORY, &mem_req) < 0)
|
4474
|
113 {
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
114 perror("libdha: DHA kernelhelper failed");
|
9025
|
115 close(mem_fd);
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
116 goto dev_mem_way;
|
4474
|
117 }
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
118 else
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
119 goto mmap;
|
4474
|
120 }
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
121 #endif
|
4474
|
122
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
123 dev_mem_way:
|
14567
|
124 #ifdef DEV_APERTURE
|
|
125 if ((mem_fd = open(DEV_APERTURE, O_RDWR)) == -1)
|
|
126 perror("libdha: opening aperture failed");
|
|
127 else {
|
|
128 void *p = mmap(0,size,PROT_READ|PROT_WRITE,MAP_SHARED,mem_fd,base);
|
|
129
|
|
130 if (p == MAP_FAILED) {
|
|
131 perror("libdha: mapping aperture failed");
|
|
132 close(mem_fd);
|
|
133 } else
|
|
134 return p;
|
|
135 }
|
|
136 #endif
|
|
137
|
9025
|
138 if ( (mem_fd = open(DEV_MEM,O_RDWR)) == -1)
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
139 {
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
140 perror("libdha: opening /dev/mem failed");
|
9219
|
141 return MAP_FAILED;
|
3973
|
142 }
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
143
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
144 mmap:
|
9025
|
145 return mmap(0,size,PROT_READ|PROT_WRITE,MAP_SHARED,mem_fd,base);
|
3973
|
146 }
|
|
147
|
5702
|
148 void unmap_phys_mem(void *ptr, unsigned long size)
|
3973
|
149 {
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
150 int res = munmap(ptr,size);
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
151
|
9219
|
152 if (res == (int)MAP_FAILED)
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
153 {
|
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
154 perror("libdha: unmapping memory failed");
|
9219
|
155 return;
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
156 }
|
9025
|
157
|
|
158 close(mem_fd);
|
|
159 mem_fd = -1;
|
|
160
|
|
161 return;
|
3973
|
162 }
|
|
163
|
10980
|
164 #endif /* Generic mmap (not win32, nor os2) */
|
|
165
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
166 unsigned char INPORT8(unsigned idx)
|
3973
|
167 {
|
|
168 return inb(idx);
|
|
169 }
|
|
170
|
3995
|
171 unsigned short INPORT16(unsigned idx)
|
3973
|
172 {
|
|
173 return inw(idx);
|
|
174 }
|
|
175
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
176 unsigned INPORT32(unsigned idx)
|
3973
|
177 {
|
|
178 return inl(idx);
|
|
179 }
|
|
180
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
181 void OUTPORT8(unsigned idx,unsigned char val)
|
3973
|
182 {
|
|
183 outb(idx,val);
|
|
184 }
|
|
185
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
186 void OUTPORT16(unsigned idx,unsigned short val)
|
3973
|
187 {
|
|
188 outw(idx,val);
|
|
189 }
|
|
190
|
8503
9dbb9c710480
svgalib kernelhelper support (based on patch by Matan Ziv-Av <matan@svgalib.org>) and some reordering/cleanup (part #1 ;)
alex
diff
changeset
|
191 void OUTPORT32(unsigned idx,unsigned val)
|
3973
|
192 {
|
|
193 outl(idx,val);
|
|
194 }
|