1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
|
/*
libgha.c - Library for direct hardware access
Copyrights:
1996/10/27 - Robin Cutshaw (robin@xfree86.org)
XFree86 3.3.3 implementation
1999 - Øyvind Aabling.
Modified for GATOS/win/gfxdump.
2002 - library implementation by Nick Kurshev
- dhahelper and some changes by Alex Beregszaszi
supported O/S's: SVR4, UnixWare, SCO, Solaris,
FreeBSD, NetBSD, 386BSD, BSDI BSD/386,
Linux, Mach/386, ISC
DOS (WATCOM 9.5 compiler), Win9x (with mapdev.vxd)
Licence: GPL
Original location: www.linuxvideo.org/gatos
*/
#include "config.h"
#include "libdha.h"
#include "AsmMacros.h"
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <unistd.h>
/* instead exit() use libdha_exit, and do the 'mother-application' deinit
only in this code */
void libdha_exit(const char *message, int level)
{
printf("libdha: FATAL: %s\n", message);
exit(level); /* FIXME */
}
#if defined(_WIN32)
#include "sysdep/libdha_win32.c"
#elif defined (__EMX__)
#include "sysdep/libdha_os2.c"
#else
#if defined(SVR4) || defined(SCO325)
# if !(defined(sun) && defined (i386) && defined (SVR4))
# define DEV_MEM "/dev/pmem"
# elif defined(PowerMAX_OS)
# define DEV_MEM "/dev/iomem"
# endif
# ifdef SCO325
# undef DEV_MEM
# define DEV_MEM "/dev/mem"
# endif
# endif /* SVR4 */
/* Generic version */
#include <sys/mman.h>
#ifndef DEV_MEM
#define DEV_MEM "/dev/mem"
#endif
#ifdef CONFIG_DHAHELPER
#include "kernelhelper/dhahelper.h"
static int mem=-1;
void *map_phys_mem(unsigned base, unsigned size)
{
if ( (mem = open("/dev/dhahelper",O_RDWR)) < 0)
{
if ( (mem = open(DEV_MEM,O_RDWR)) == -1) {
perror("libdha: open(/dev/mem) failed") ; exit(1) ;
}
}
else
{
dhahelper_memory_t mem_req;
mem_req.operation = MEMORY_OP_MAP;
mem_req.start = base;
mem_req.offset = 0;
mem_req.size = size;
if (ioctl(mem, DHAHELPER_MEMORY, &mem_req) < 0)
{
perror("libdha: failed mapping throught kernel helper");
return NULL;
}
}
return mmap(0,size,PROT_READ|PROT_WRITE,MAP_SHARED,mem,base) ;
}
#else
static int mem=-1;
void *map_phys_mem(unsigned base, unsigned size)
{
if ( (mem = open(DEV_MEM,O_RDWR)) == -1) {
perror("libdha: open(/dev/mem) failed") ; exit(1) ;
}
return mmap(0,size,PROT_READ|PROT_WRITE,MAP_SHARED,mem,base) ;
}
#endif /* CONFIG_DHAHELPER */
void unmap_phys_mem(void *ptr, unsigned size)
{
int res=munmap(ptr,size) ;
if (res == -1) { perror("libdha: munmap() failed") ; exit(1) ; }
close(mem);
}
#endif
unsigned char INPORT8(unsigned idx)
{
return inb(idx);
}
unsigned short INPORT16(unsigned idx)
{
return inw(idx);
}
unsigned INPORT32(unsigned idx)
{
return inl(idx);
}
void OUTPORT8(unsigned idx,unsigned char val)
{
outb(idx,val);
}
void OUTPORT16(unsigned idx,unsigned short val)
{
outw(idx,val);
}
void OUTPORT32(unsigned idx,unsigned val)
{
outl(idx,val);
}
|
