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
|
/* ----------------------------------------------------------------------- *
*
* Copyright 2007-2008 H. Peter Anvin - All Rights Reserved
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, Inc., 53 Temple Place Ste 330,
* Boston MA 02111-1307, USA; either version 2 of the License, or
* (at your option) any later version; incorporated herein by reference.
*
* ----------------------------------------------------------------------- */
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <stdbool.h>
#include "mystuff.h"
#include "ymsend.h"
#include "srecsend.h"
#include "io.h"
const char *program = "memdump";
void __attribute__ ((noreturn)) die(const char *msg)
{
puts(program);
puts(": ");
puts(msg);
putchar('\n');
exit(1);
}
#ifdef DEBUG
# define dprintf printf
#else
# define dprintf(...) ((void)0)
#endif
static inline __attribute__ ((const))
uint16_t ds(void)
{
uint16_t v;
asm("movw %%ds,%0":"=rm"(v));
return v;
}
#define GDT_ENTRY(flags,base,limit) \
(((uint64_t)(base & 0xff000000) << 32) | \
((uint64_t)flags << 40) | \
((uint64_t)(limit & 0x00ff0000) << 32) | \
((uint64_t)(base & 0x00ffff00) << 16) | \
((uint64_t)(limit & 0x0000ffff)))
static void get_bytes(void *buf, size_t len, struct file_info *finfo,
size_t pos)
{
size_t end;
static uint64_t gdt[6];
size_t bufl;
pos += (size_t) finfo->pvt; /* Add base */
end = pos + len;
if (end <= 0x100000) {
/* Can stay in real mode */
asm volatile ("movw %3,%%fs ; "
"fs; rep; movsl ; "
"movw %2,%%cx ; "
"rep; movsb"::"D" (buf), "c"(len >> 2),
"r"((uint16_t) (len & 3)), "rm"((uint16_t) (pos >> 4)),
"S"(pos & 15)
:"memory");
} else {
bufl = (ds() << 4) + (size_t) buf;
gdt[2] = GDT_ENTRY(0x0093, pos, 0xffff);
gdt[3] = GDT_ENTRY(0x0093, bufl, 0xffff);
asm volatile ("pushal ; int $0x15 ; popal"::"a" (0x8700),
"c"((len + 1) >> 1), "S"(&gdt)
:"memory");
}
}
int main(int argc, char *argv[])
{
uint16_t bios_ports[4];
const char *prefix;
char filename[1024];
int i;
static struct serial_if sif = {
.read = serial_read,
.write = serial_write,
};
struct file_info finfo;
const char ymodem_banner[] = "Now begin Ymodem download...\r\n";
bool srec = false;
if (argv[1][0] == '-') {
srec = argv[1][1] == 's';
argc--;
argv++;
}
if (argc < 4)
die("usage: memdump [-s] port prefix start,len...");
finfo.pvt = (void *)0x400;
get_bytes(bios_ports, 8, &finfo, 0); /* Get BIOS serial ports */
for (i = 0; i < 4; i++)
printf("ttyS%i (COM%i) is at %#x\n", i, i + 1, bios_ports[i]);
sif.port = strtoul(argv[1], NULL, 0);
if (sif.port <= 3) {
sif.port = bios_ports[sif.port];
}
if (serial_init(&sif))
die("failed to initialize serial port");
prefix = argv[2];
if (!srec) {
puts("Printing prefix...\n");
sif.write(&sif, ymodem_banner, sizeof ymodem_banner - 1);
}
for (i = 3; i < argc; i++) {
uint32_t start, len;
char *ep;
start = strtoul(argv[i], &ep, 0);
if (*ep != ',')
die("invalid range specification");
len = strtoul(ep + 1, NULL, 0);
sprintf(filename, "%s%#x-%#x.bin", prefix, start, len);
finfo.name = filename;
finfo.size = len;
finfo.pvt = (void *)start;
puts("Sending ");
puts(filename);
puts("...\n");
if (srec)
send_srec(&sif, &finfo, get_bytes);
else
send_ymodem(&sif, &finfo, get_bytes);
}
if (!srec) {
puts("Sending closing signature...\n");
end_ymodem(&sif);
}
return 0;
}
|
