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
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
|
/* $NetBSD: misc.c,v 1.3 1994/10/27 04:21:18 cgd Exp $ */
#include "proto.h"
#if defined(DEBUG)
void
DUMP_STRUCT(char *s, u_char *p, u_int ps) {
int i;
printf("struct %s (@0x%x %d bytes): ", s, p, ps);
for (i=0; i<ps; i++)
printf("%x ", *(p+i));
printf("\n");
}
#else
void
DUMP_STRUCT(char *s, u_char *p, u_int ps) {
}
#endif
char *
strncpy(char *dst, const char *src, int len) {
char *p=dst;
while (*src && len--)
*p++ = *src++;
*p = 0;
return dst;
}
int
strlen(const char *s) {
int len = 0;
while (*s++)
len++;
return len;
}
char *
strncat(char *s, const char *append, int len) {
int offset = strlen(s);
strncpy(s+offset, append, len);
return s;
}
int
strcmp(const char *s, const char *t) {
while (*s == *t++)
if (*s++ == '\0')
return 0;
return *s - *--t;
}
int
bcmp(const void *p, const void *q, int len) {
while (len--)
if (*((const char *)p)++ != *((const char *)q)++)
return 1;
return 0;
}
void volatile exit(int v) {
#ifdef DEBUG
L: goto L;
#else
ExitToBios();
#endif
}
#define RTC_ADDR 0x70
#define RTC_DATA 0x71
#define RTC_SECONDS 0x00
#define RTC_MINUTES 0x02
#define RTC_HOURS 0x04
#define RTC_STATUS_A 0x0a
#define RTC_BASEMEM_LO 0x15
#define RTC_BASEMEM_HI 0x16
#define RTC_EXPMEM_LO 0x30
#define RTC_EXPMEM_HI 0x31
static u_char
ReadRtcRam(u_short addr) {
for (;;) {
/* wait if updating */
outb(RTC_ADDR, RTC_STATUS_A);
if (!(inb(RTC_DATA) & 0x80))
break;
}
outb(RTC_ADDR, addr);
return inb(RTC_DATA);
}
static void
getrtc(u_long *hrs, u_long *mins, u_long *secs) {
/* TBD - replace args with single arg - struct or sec of day */
/*
* Get real time clock values (they are in BCD)
*/
#ifdef USE_BIOS
asm("
call _prot_to_real
movb $0x02,%ah # read real time clock
int $0x1a
.byte 0x66
call _real_to_prot
xor %eax, %eax
movb %dh, %al
mov %%eax, %0
movb %cl, %al
mov %eax, %1
movb %ch, %al
mov %eax, %2
" : "=g" (secs), "=g" (mins), "=g" (hrs));
#else
*secs = ReadRtcRam(RTC_SECONDS);
*mins = ReadRtcRam(RTC_MINUTES);
*hrs = ReadRtcRam(RTC_HOURS);
#endif
}
static inline u_long
bcd2dec(u_long arg) {
return ((arg & 0xF0) >> 4) * 10 + (arg & 0x0F);
}
u_long
timer(void) {
/* TBD - replace with StartCountdown()/CountdownAtZero() routines,
isolate the span-midnight problem to inside these routines
*/
/*
* Return the current time in seconds
*/
u_long sec, min, hour;
/* BIOS time is stored in bcd */
getrtc(&hour, &min, &sec);
sec = bcd2dec(sec);
min = bcd2dec(min);
hour = bcd2dec(hour);
#if 0
printe("time h%d m%d s%d = sum%d\n", hour, min, sec, hour * 3600L + min * 60L + sec);
#endif
return hour * 3600L + min * 60L + sec;
}
/*
* Simple random generator
*/
static u_long next = 1;
void
srand(u_int seed) {
next = seed;
}
int
rand(void) {
next = next * 1103515245L + 12345;
return (u_int)(next / 65536) % 32768;
}
u_short
GetMemSize(u_short s) {
#ifdef USE_BIOS
u_short result;
asm("
push %%ebx
mov %1, %%ebx
call _prot_to_real
cmpb $0x1, %%bl
.byte 0x66
je 1f
sti
int $0x12
cli
.byte 0x66
jmp 2f
1: movb $0x88, %%ah
sti
int $0x15
cli
2: mov %%eax, %%ebx
.byte 0x66
call _real_to_prot
mov %%bx, %0
pop %%ebx
" : "=g" (result) : "g" (s));
return result;
#else
u_long result;
if (s)
result = ((u_long)ReadRtcRam(RTC_EXPMEM_HI)<<8) + ReadRtcRam(RTC_EXPMEM_LO);
else
result = ((u_long)ReadRtcRam(RTC_BASEMEM_HI)<<8) + ReadRtcRam(RTC_BASEMEM_LO);
return result;
#endif
}
void
ResetCpu(void) {
#ifdef USE_BIOS
asm("
call _prot_to_real # enter real mode
int $0x19
" );
#else
while (inb(0x64)&2); /* wait input ready */
outb(0x64, 0xFE); /* Reset Command */
#endif
}
|
