|
|
1.1 root 1: //
2: // nono
1.1.1.2 root 3: // Copyright (C) 2020 nono project
4: // Licensed under nono-license.txt
1.1 root 5: //
6:
1.1.1.2 root 7: // LUNA-I の ROM エミュレーション
8:
9: // IODevice
10: // |
11: // +----------+----------+
12: // v v
13: // ROMDevice LunaPROMEmuDeivce (ROM エミュレーション)
14: // |
15: // v
16: // PROMDevice (実ROM)
17:
18: #include "romemu_luna.h"
1.1 root 19: #include "aout.h"
20: #include "bitmap.h"
21: #include "bt454.h"
1.1.1.2 root 22: #include "ethernet.h"
1.1 root 23: #include "ffs_dinode.h"
24: #include "ffs_dir.h"
25: #include "ffs_fs.h"
26: #include "mainapp.h"
27: #include "memorystream.h"
28: #include "mk48t02.h"
1.1.1.2 root 29: #include "mpu680x0.h"
1.1 root 30: #include "pio.h"
31: #include "ram.h"
32: #include "sio.h"
33: #include "spc.h"
34:
35: // ROM エミュレーションの状態遷移
36: enum {
37: STATE_CLOSED = 0, // バックドアは塞がれている
38: STATE_RESET, // リセット後、アクセス前
39: STATE_INIT, // プロンプト初期化中
40: STATE_PROMPT, // プロンプト実行中
41: };
42:
43: // コンストラクタ
44: LunaPROMEmuDevice::LunaPROMEmuDevice()
45: {
1.1.1.2 root 46: // LUNA-I の ROM の特定アドレスを読み出す人がいるので、
47: // サイズは実 ROM と同じにしておく必要がある。
48: devlen = 128 * 1024;
49: romdata.reset(new uint8 [devlen]);
1.1 root 50: }
51:
52: // デストラクタ
53: LunaPROMEmuDevice::~LunaPROMEmuDevice()
54: {
55: }
56:
57: bool
58: LunaPROMEmuDevice::Init()
59: {
60: // 都度都度 dynamic_cast は面倒なので、ここで一度代入しとく
61: nvram = dynamic_cast<MK48T02Device*>(gRTC.get());
62:
1.1.1.2 root 63: MemoryStreamBE ms(romdata.get());
1.1 root 64: ms.Write32(0x00002000); // +00: リセットベクタ SP
65: ms.Write32(0x41000400); // +04: リセットベクタ PC
66: ms.Write32(0); // +08
67: ms.Write32(0x41000500); // +0c: メモリサイズ格納先
68:
69: // リセット時に実行する命令
1.1.1.2 root 70: ms.SetPtr(&romdata[0x400]);
71: ms.Write16(0x2039); // move.l (ROMIO_INIT),d0
72: ms.Write32(ROMIO_INIT);
73: ms.Write16(0x660c); // bne _go ; 起動先あればGO
1.1 root 74: //_prompt:
1.1.1.2 root 75: ms.Write32(0x4e722500); // stop #0x2500 ; キー入力を待つ
76: ms.Write16(0x2039); // move.l (ROMIO_KEYIN),d0
77: ms.Write32(ROMIO_KEYIN); // ; キー入力処理
78: ms.Write16(0x67f4); // beq _prompt ; 起動先なければループ
1.1 root 79: //_go:
80: ms.Write16(0x2040); // move.l d0,a0 ; ジャンプ先を a0 にセット
1.1.1.2 root 81: ms.Write16(0x2039); // move.l (ROMIO_CLOSE),d0
82: ms.Write32(ROMIO_CLOSE); // ; 後始末
1.1 root 83: ms.Write16(0x4ed0); // jmp (a0) ; ジャンプ
84:
85: // Lv6 (SIO) 割り込みハンドラ
86: // キーボード割り込みが上がったら STOP 命令から戻ってくるだけでいい
1.1.1.2 root 87: ms.SetPtr(&romdata[0x600]);
1.1 root 88: ms.Write16(0x4e73); // rte
89:
1.1.1.2 root 90: // MAC アドレス
91: const macaddr_t macaddr = gEthernet->GetMacAddr();
92: strcpy((char *)&romdata[0x1ffd8], "ENADDR");
93: memcpy(&romdata[0x1ffe0], macaddr.to_string().c_str(), 12);
1.1 root 94:
95: // RAM にベクタを書き込む
96: // XXX VBR を 41000000 に向けるのとどっちが楽かはある
97: gRAM->Write32(0x78, 0x41000600); // +78: Lv6 割り込み
98:
99: return true;
100: }
101:
102: void
103: LunaPROMEmuDevice::ResetHard()
104: {
1.1.1.2 root 105: is_closed = false;
1.1 root 106: }
107:
108: // アドレスデコーダ
109: inline uint64
110: LunaPROMEmuDevice::Decoder(uint32 addr) const
111: {
1.1.1.2 root 112: // 折り返しなし
1.1 root 113: return addr - baseaddr;
114: }
115:
116: uint64
1.1.1.2 root 117: LunaPROMEmuDevice::Read8(uint32 addr)
118: {
119: uint64 offset = Decoder(addr);
120:
121: // 謎の IO 空間はロングワードアクセスのみ
122: return romdata[offset & (devlen - 1)];
123: }
124:
125: uint64
126: LunaPROMEmuDevice::Read16(uint32 addr)
127: {
128: uint64 offset = Decoder(addr);
129:
130: // 謎の IO 空間はロングワードアクセスのみ
131: return be16toh(*(uint16 *)&romdata[offset & (devlen - 1)]);
132: }
133:
134: uint64
1.1 root 135: LunaPROMEmuDevice::Read32(uint32 addr)
136: {
137: uint64 offset = Decoder(addr);
138:
139: // ロングワードアクセスでだけ謎の I/O 空間が見える
1.1.1.2 root 140: if (!is_closed) {
1.1 root 141: switch (offset) {
1.1.1.2 root 142: case ROMIO_INIT - baseaddr:
143: return ROM_Init();
1.1 root 144:
1.1.1.2 root 145: case ROMIO_KEYIN - baseaddr:
146: return ROM_Keyin();
1.1 root 147:
1.1.1.2 root 148: case ROMIO_CLOSE - baseaddr:
149: return ROM_Close();
1.1 root 150:
151: default:
152: break;
153: }
154: }
1.1.1.2 root 155: return be32toh(*(uint32 *)&romdata[offset & (devlen - 1)]);
156: }
157:
158: uint64
159: LunaPROMEmuDevice::Write8(uint32 addr, uint32 data)
160: {
161: return 0;
162: }
163:
164: uint64
165: LunaPROMEmuDevice::Write16(uint32 addr, uint32 data)
166: {
167: return 0;
168: }
169:
170: uint64
171: LunaPROMEmuDevice::Write32(uint32 addr, uint32 data)
172: {
173: return 0;
174: }
175:
176: uint64
177: LunaPROMEmuDevice::Peek8(uint32 addr)
178: {
179: uint64 offset = Decoder(addr);
180:
181: return romdata[offset & (devlen - 1)];
1.1 root 182: }
183:
184: // 起動時の処理を行う。
185: // 次段実行ファイルの読み込みに成功すればそのエントリポイントを返す。
186: // そうでなければ 0 を返すので、プロンプトに処理を移すこと。
187: uint32
1.1.1.2 root 188: LunaPROMEmuDevice::ROM_Init()
1.1 root 189: {
190: MemoryStreamBE ms;
191: uint32 entry;
192:
193: entrypoint = 0;
194:
195: // ROM 0x41000000.L リセットベクタ(SP,PC)もカーネルが参照している
196: // (これは Init() が用意している)
197: // ROM 0x4100000c.L メモリサイズ(バイト数)格納先アドレス
198: // ROM 0x410000b8.L プレーンマスク格納先アドレス
199:
200: // メモリサイズはとりあえず 0x41000500 に格納
1.1.1.2 root 201: ms.SetPtr(&romdata[0x500]);
1.1 root 202: ms.Write32(::ram_size);
203:
204: // プレーン数(1..4)をプレーンマスク(0x01..0x0f)に
205: int nplane = gBitmap->GetPlaneCount();
206: int planemask = (1 << nplane) - 1;
207: // 実際は RAM 上を指しているのだが、とりあえずすぐ隣に置いておく。
1.1.1.2 root 208: ms.SetPtr(&romdata[0xb8]);
1.1 root 209: ms.Write32(0x410000bc);
210: ms.Write32(planemask);
211:
212: // 初期パレット
213: gBT454->Write8(0, 14 << 4); // select palette
214: gBT454->Write8(1, 15 << 4); // R=15
215: gBT454->Write8(1, 15 << 4); // G=15
216: gBT454->Write8(1, 15 << 4); // B=15
217:
218: // SCSI
219: // BDID の書き込みによってホストデバイスがバスにアタッチされる構造なので。
220: gSPC->Write8(SPC::BDID, 7);
221:
1.1.1.2 root 222: // 内蔵 ROM: キーボード(chB)を初期化
223: gSIO->Write8(0x51000006, 0x01); // CR1
224: gSIO->Write8(0x51000006, 0x10); // RX Int(all char)
225: gSIO->Write8(0x51000006, 0x03); // CR3
226: gSIO->Write8(0x51000006, 0xc1); // RX Enable, 8bit
227: gSIO->Write8(0x51000006, 0x04); // CR4
228: gSIO->Write8(0x51000006, 0x44); // Stop 1bit
229: gSIO->Write8(0x51000006, 0x05); // CR5
230: gSIO->Write8(0x51000006, 0x68); // TX Enable, 8bit
231:
232: // 内蔵 ROM: スクリーンを初期化
1.1 root 233: text.Init(80, 32);
234: gBitmap->EmuConsoleOpen(&text);
1.1.1.2 root 235: inputbuf.clear();
236: inputpos = 0;
237: is_shift = false;
1.1.1.3 ! root 238: mousecnt = 0;
1.1.1.2 root 239: prompt_idx = 0;
240: prompt = default_prompt;
1.1 root 241:
242: text.Print(0, 0, "NONO %d.%d.%d Emulated ROM Monitor",
243: NONO_MAJOR_VER, NONO_MINOR_VER, NONO_PATCH_VER);
244: text.Locate(0, 2);
245:
246: // 表示環境が整ったところで NVRAM を照合
247: if (VerifyNVRAM() == false) {
248: InitNVRAM();
249: text.Print("** NVRAM Initialized.\n");
250: text.Print("\n");
251: return 0;
252: }
253:
254: // 実際の画面更新は EmuConsoleUpdate() を呼ぶことで行われるので、
255: // タイトルを Print してはいるが、エラーなくブートプログラムに制御を
256: // 渡せた場合にはそれすら表示せずにゲストに処理を移す。
257: // 意図して或いは意図せずプロンプトに降りる場合だけ Update が起きて
258: // 初めて画面が更新される。
259:
260: // DIPSW#1-1 が UP なら自動起動、DOWN なら ROM モニタ起動なので、
261: // これを真似する。
262: entry = 0;
263: if ((gPIO0->GetDIPSW1() & 1)) {
264: if (gMainApp.host_file) {
265: // ホストのファイルを読み込んでエントリポイントアドレスを
266: // この Read アクセスの読み出し値として返す。
267: // エラーがあればエラーメッセージは呼び出し先側で表示してある。
268: entry = LoadHostFile();
269: } else {
270: // NVRAM の設定に従ってブート先を探す。
271: errmsg.clear();
272: entry = LoadByNVRAM("");
273: if (entry == 0) {
274: text.Print("** %s\n", errmsg.c_str());
275: }
276: }
277: }
278:
1.1.1.2 root 279: if (entry == 0) {
280: ConsoleUpdate();
281: }
282:
1.1 root 283: return entry;
284: }
285:
286: // ROM 処理のクローズ。
287: // 次段プログラムにジャンプするための処理も含む。
288: uint32
1.1.1.2 root 289: LunaPROMEmuDevice::ROM_Close()
1.1 root 290: {
291: // ここでバックドアに蓋をする
1.1.1.2 root 292: is_closed = true;
1.1 root 293:
294: // コンソールクローズ
295: gBitmap->EmuConsoleClose();
296:
297: // NetBSD のブートローダがカーネルを読み込む時にはいくつかレジスタ
298: // 渡しのパラメータがあるので、ここで用意する。本当はターゲットが
299: // NetBSD カーネルの時に限定すべきのような気もするけど、とりあえず。
300: // ROM がブートローダを読み込む時にはそのような取り決め事は一切ない
301: // ので、ブートローダを読む時にも同じ値が入ってしまうが気にしない
302: // ことにする。
303: // 必要なパラメータは
304: // %d6 に bootdev、NetBSD/luna68k の場合は
305: // bootdev = $MACUPP00
306: // ||||++-- パーティション番号
307: // |||+---- SCSI ID (XXX ただしここでは 6 決め打ち)
308: // ||+----- unit (spc0 なら 0 のやつのはず)
309: // |+------ アダプタ (spc = 0、lance = 1)
310: // +------- magic ($a)
311: //
312: // %d7 に howto (0 でよい)
313: // (と %a0 にジャンプ先を入れるがこれは Init() が書き出した ROM
314: // アセンブラコード側で行っている)
315: m68kcpu *cpu = gMPU680x0->GetCPU();
316: RegD(6) = 0xa0060000;
317: RegD(7) = 0;
318:
319: // 戻り値は使わないのでなんでもいい
320: return 0;
321: }
322:
1.1.1.2 root 323: // ROM プロンプトのキー入力。
1.1 root 324: // VM 側の仮想マシンを回すため、ここでは入力待ちはしない。
325: // エントリポイントが取得できればそれを、そうでなければ 0 を返す。
326: uint32
1.1.1.2 root 327: LunaPROMEmuDevice::ROM_Keyin()
1.1 root 328: {
1.1.1.2 root 329: uint32 lunakey = gSIO->Read8(0x51000004);
1.1 root 330:
1.1.1.3 ! root 331: // マウス入力の 2, 3バイト目は無視
! 332: if (mousecnt > 0) {
! 333: mousecnt--;
! 334: return 0;
! 335: }
! 336:
1.1.1.2 root 337: // SHIFT キーだけ状態を持つので先に処理
338: if (lunakey == 0x0c || lunakey == 0x0d) { // 左右SHIFT押下
339: is_shift = true;
340: return 0;
341: }
342: if (lunakey == 0x8c || lunakey == 0x8d) { // 左右SHIFT開放
1.1 root 343: is_shift = false;
1.1.1.2 root 344: return 0;
345: }
1.1.1.3 ! root 346: // マウスデータの1バイト目なら、後続2バイトをスキップ
! 347: if ((lunakey & 0xf8) == 0x80) {
! 348: mousecnt = 2;
! 349: return 0;
! 350: }
! 351: // キー開放は無視してよい
1.1.1.2 root 352: if ((lunakey & 0x80)) {
353: return 0;
354: }
1.1 root 355:
1.1.1.2 root 356: switch (lunakey) {
357: case 0x11: // BS
358: if (inputpos > 0) {
359: inputbuf.erase(--inputpos);
1.1 root 360: }
1.1.1.2 root 361: break;
362: case 0x12: // Enter
363: {
364: // 現在位置のカーソルを消去
365: uint16 *rawbuf = text.GetRawBuf();
366: int curx = prompt.length() + inputpos;
367: rawbuf[text.GetY() * text.GetCol() + curx] &= ~TA::On;
368: // 改行
369: text.Putc('\n');
370: // コマンド処理。
371: // エントリポイントが見付かればもうここは放棄するので帰るだけ。
372: uint32 entry = Command();
373: if (entry != 0) {
374: return entry;
1.1 root 375: }
1.1.1.2 root 376: inputbuf.clear();
377: inputpos = 0;
378: break;
379: }
380: case 0x1d: // ←
381: if (inputpos > 0) {
382: inputpos--;
1.1 root 383: }
1.1.1.2 root 384: break;
385: case 0x1e: // →
386: if (inputpos < inputbuf.length()) {
1.1 root 387: inputpos++;
388: }
389: break;
1.1.1.2 root 390: default: // 通常文字
391: {
392: char asciicode;
393: if (is_shift) {
394: asciicode = lunakey2shifttable[lunakey];
395: } else {
396: asciicode = lunakey2asciitable[lunakey];
397: }
398: if (asciicode == 0) {
399: // 割り当てなし
400: return 0;
401: }
402: inputbuf.insert(inputbuf.begin() + inputpos, asciicode);
403: inputpos++;
404: break;
405: }
1.1 root 406: }
1.1.1.2 root 407: putmsg(2, "inputbuf=%zd|%s|", inputbuf.length(), inputbuf.c_str());
408: ConsoleUpdate();
409: return 0;
410: }
1.1 root 411:
1.1.1.2 root 412: // 画面を更新
413: void
414: LunaPROMEmuDevice::ConsoleUpdate()
415: {
1.1 root 416: // 入力行全体を都度更新 (面倒なので行をはみ出さないようにする)
417: std::string buf = prompt + inputbuf;
418: text.Print(0, text.GetY(), "%-79s", buf.c_str());
419: // カーソルを描画 (生バッファを触って属性を立てる)
420: uint16 *rawbuf = text.GetRawBuf();
421: int curx = prompt.length() + inputpos;
422: rawbuf[text.GetY() * text.GetCol() + curx] |= TA::On;
423: // 画面更新
424: gBitmap->EmuConsoleUpdate();
425: }
426:
427: // 入力コマンド処理
428: uint32
1.1.1.2 root 429: LunaPROMEmuDevice::Command()
1.1 root 430: {
1.1.1.2 root 431: std::vector<char> buf(inputbuf.length() + 1);
1.1 root 432: std::vector<std::string> arg;
433:
434: // 1ワードごとに分解
1.1.1.2 root 435: strcpy(&buf[0], inputbuf.c_str());
436: char *p = &buf[0];
1.1 root 437: char *s = p;
438: while (*p != '\0') {
439: if (*p == ' ') {
440: *p++ = '\0';
441: arg.push_back(std::string(s));
442: s = p;
443: } else {
444: p++;
445: }
446: }
447: if (p != s) {
448: arg.push_back(std::string(s));
449: }
450: if (loglevel >= 1) {
451: for (int i = 0; i < arg.size(); i++) {
452: putmsg("arg[%d]=|%s|", i, arg[i].c_str());
453: }
454: }
455:
456: // "k" コマンド中ならここで先に処理する
457: if (prompt_idx != 0) {
1.1.1.2 root 458: CommandK(arg);
1.1 root 459: return 0;
460: }
461:
462: // 空行
463: if (arg.size() == 0) {
464: return 0;
465: }
466:
467: // 1ワード目がコマンド
468: if (arg[0] == "h") {
469: // ヘルプメッセージ
470: text.Print("Commands\n");
471: text.Print(
472: " g [<filename>] : load program\n"
473: " gh : load host program (specified by -A option)\n"
474: " h : show this message\n"
475: " k : show/set boot constants\n"
476: " x : execute loaded program\n"
477: );
478: return 0;
479: }
480: if (arg[0] == "g") {
1.1.1.2 root 481: CommandG(arg);
1.1 root 482: return 0;
483: }
484: if (arg[0] == "gh") {
1.1.1.2 root 485: CommandGH();
1.1 root 486: return 0;
487: }
488: if (arg[0] == "k") {
1.1.1.2 root 489: CommandK(arg);
1.1 root 490: return 0;
491: }
492: if (arg[0] == "x") {
1.1.1.2 root 493: return CommandX();
1.1 root 494: }
495:
496: text.Print("** Unknown command: %s\n", arg[0].c_str());
497: return 0;
498: }
499:
500: // "g" コマンド
501: // g なら NVRAM の情報に従ってプログラムをロード。
502: // g <fname> なら NVRAM の fname だけ指定の名前を使ってロード。NVRAM には
503: // 書き込まない。
504: void
1.1.1.2 root 505: LunaPROMEmuDevice::CommandG(const std::vector<std::string>& arg)
1.1 root 506: {
507: std::string ctlr = nvram->PeekString(0x0030);
508: if (ctlr == "dk") { // harddisk
509: std::string fname {};
510:
511: switch (arg.size()) {
512: case 1:
513: break;
514: case 2:
515: fname = arg[1];
516: break;
517: default:
518: text.Print("** Invalid argument.\n");
519: return;
520: }
521: errmsg.clear();
522: entrypoint = LoadByNVRAM(fname);
523: if (entrypoint == 0) {
524: text.Print("** %s\n", errmsg.c_str());
525: }
526:
527: } else if (ctlr == "et" || // netboot
528: ctlr == "sd" || // cassette tape
529: ctlr == "fl" ) // floppy
530: {
531: text.Print("** %s boot not supported.\n", ctlr.c_str());
532: return;
533: } else {
534: // 起きないはず
535: text.Print("** Invalid boot controller name.\n");
536: return;
537: }
538:
539: if (entrypoint) {
540: text.Print("Loaded. Entry point = $%08x\n", entrypoint);
541: }
542: }
543:
544: // "gh" コマンド (勝手に拡張)
545: // -A オプションで指定されたホストプログラムをロードする。
546: void
1.1.1.2 root 547: LunaPROMEmuDevice::CommandGH()
1.1 root 548: {
549: entrypoint = 0;
550: if (gMainApp.host_file) {
551: // 指定されてたら読み込む
552: entrypoint = LoadHostFile();
553: } else {
554: text.Print("** Cannot loaded; host program is not specified.\n");
555: }
556: }
557:
558: // -A オプションで指定されたホストファイルをロードする。
559: // ロードできればエントリポイントを返す。
560: // host_file が指定されている時に呼ぶこと。
561: uint32
562: LunaPROMEmuDevice::LoadHostFile()
563: {
564: assert(gMainApp.host_file);
565:
566: uint32 entry = gRAM->LoadFile(gMainApp.host_file, AOUT_MID_M68K);
567: if (entry) {
568: text.Print("Host program loaded. Entry point = $%08x\n",
569: entry);
570: } else {
571: text.Print("** Couldn't load specified host program.\n");
572: }
573: return entry;
574: }
575:
576:
577: // k コマンドのパラメータ表
578: struct kinfo {
579: uint32 offset; // NVRAM 上のオフセット
580: const char * const name; // 表示名
581: int next; // 次インデックス
582: };
583: static const struct kinfo kinfo[] = {
584: { 0 }, // 0 は通常プロンプトを指すのでここでは使わない
585: { 0x0030, "controller", 0 }, // [1] BOOT (next は動的判定する)
586: { 0x0090, "drive unit", 3 }, // [2] DKUNIT
587: { 0x00b0, "partition ", 4 }, // [3] DKPART
588: { 0x00d0, "filename ", 0 }, // [4] FLNAME
589: { 0x0050, "hostname ", 6 }, // [5] HOST
590: { 0x0070, "servername", 7 }, // [6] SERVER
591: { 0x0190, "filename ", 8 }, // [7] ETBOOT
592: { 0x01b0, "", 0 }, // [8] ETFILE (ETBOOT と1行で処理する)
593: };
594:
595: // "k" コマンド
596: void
1.1.1.2 root 597: LunaPROMEmuDevice::CommandK(const std::vector<std::string>& arg)
1.1 root 598: {
599: uint32 offset;
600: const char *name;
601: int next;
602:
603: // 入力を処理
604: if (prompt_idx == 0) {
605: // ここは1行目表示前なので前行の入力はない。
606: next = 1;
607: } else {
608: std::string val;
609: bool rv;
610:
611: // 入力があれば更新
612: if (arg.size() != 0) {
613: rv = CommandKInput(arg[0]);
614: } else {
615: // [7] の時に入力があれば CommandKInput() の中で更新されるが、
616: // 入力がなければそこを通らないので、こっちでやらないといけない。
617: // うーん。
618: if (prompt_idx == 7) {
619: prompt_idx = kinfo[prompt_idx].next;
620: }
621: rv = true;
622: }
623:
624: // これ以降は更新後の prompt_idx を使う
625:
626: // 入力エラーがあった時はこの行を再入力するため
627: next = prompt_idx;
628:
629: if (rv == true) {
630: // 入力があっても空でも次インデックスへ。
631: if (prompt_idx == 1) {
632: // BOOT なら現在値によって次のインデックスが変わる
633: // "dk" なら [2]、"et" なら [5]。他は未対応
634: offset = kinfo[prompt_idx].offset;
635: val = nvram->PeekString(offset);
636: if (val == "dk") {
637: next = 2;
638: } else if (val == "et") {
639: next = 5;
640: } else {
641: // 起きることはないはず
642: text.Print("** Inconsistent boot parameter: %s\n",
643: val.c_str());
644: }
645: } else {
646: // それ以外はテーブルにかかれている通り
647: next = kinfo[prompt_idx].next;
648: }
649: }
650: }
651:
652: // この行のプロンプト文字列を作成
653: prompt_idx = next;
654: if (prompt_idx == 0) {
655: // 最終行なら元に戻す
656: prompt = default_prompt;
657: } else {
658: // 次のプロンプトに変更
659: name = kinfo[prompt_idx].name;
660: offset = kinfo[prompt_idx].offset;
661: std::string val = nvram->PeekString(offset);
662:
663: // [7] ETBOOT だけ1行で ETBOOT:ETFILE 形式
664: if (prompt_idx == 7) {
665: next = kinfo[prompt_idx].next; // ETFILE
666: offset = kinfo[next].offset;
667: val += ":";
668: val += nvram->PeekString(offset);
669: }
670:
671: prompt = string_format("%s: %s ?", name, val.c_str());
672: }
673: }
674:
675: // k コマンドの入力値を処理する部分。
676: // 成功すれば true を返す。
677: // 失敗すれば false を返す。
678: // 実機 ROM は入力値にエラーがあると黙って再入力を促す。
679: // エラーメッセージくらい表示してもいいかもだがとりあえず真似しておく。
680: bool
681: LunaPROMEmuDevice::CommandKInput(const std::string& val)
682: {
683: int offset;
684: bool rv = true;
685:
686: offset = kinfo[prompt_idx].offset;
687:
688: switch (prompt_idx) {
689: case 1: // BOOT
690: // 正常な入力値は "dk", "et", "sd", "fl" のみ。
691: if (val != "dk" && val != "et" && val != "sd" && val != "fl") {
692: return false;
693: }
694: rv = nvram->WriteString(offset, val);
695: if (rv == false) {
696: return false;
697: }
698: break;
699:
700: case 7: // ETBOOT
701: {
702: // こいつだけ ETBOOT:ETFILE 形式で2つのパラメータを同時に処理する
703:
704: // ':' で前後に分ける
705: int sep = val.find(':');
706: if (sep == std::string::npos) {
707: return false;
708: }
709: std::string etboot = val.substr(0, sep);
710: std::string etfile = val.substr(sep + 1, val.size() - sep + 1);
711: if (etboot.empty() || etfile.empty()) {
712: return false;
713: }
714:
715: // ETBOOT
716: rv = nvram->WriteString(offset, etboot);
717: if (rv == false) {
718: return false;
719: }
720:
721: // 次へ
722: prompt_idx = kinfo[prompt_idx].next;
723:
724: // ETFILE
725: offset = kinfo[prompt_idx].offset;
726: rv = nvram->WriteString(offset, etfile);
727: if (rv == false) {
728: return false;
729: }
730: break;
731: }
732:
733: default:
734: rv = nvram->WriteString(offset, val);
735: if (rv == false) {
736: return false;
737: }
738: break;
739: }
740:
741: WriteNVRAMCsum();
742: return rv;
743: }
744:
745: // "x" コマンド
746: // すでに読み込まれてるはずのエントリポイントにジャンプするだけ。
747: uint32
1.1.1.2 root 748: LunaPROMEmuDevice::CommandX()
1.1 root 749: {
750: if (entrypoint == 0) {
751: text.Print("** Program is not loaded.\n");
752: }
753: return entrypoint;
754: }
755:
756: // NVRAM のチェックサムを返す
757: uint8
758: LunaPROMEmuDevice::CalcNVRAMCsum()
759: {
760: uint8 eor = 0;
761: for (uint32 addr = 0x20; addr < 0x560; addr++) {
762: eor ^= nvram->Peek(addr);
763: }
764: return eor;
765: }
766:
767: // NVRAM のチェックサムを計算して書き込む
768: void
769: LunaPROMEmuDevice::WriteNVRAMCsum()
770: {
771: uint8 eor = CalcNVRAMCsum();
772:
773: nvram->Write(0x001c, eor);
774: nvram->Write(0x001d, eor);
775: nvram->Write(0x001e, eor);
776: }
777:
778: // NVRAM のマジックとチェックサムを照合する
779: bool
780: LunaPROMEmuDevice::VerifyNVRAM()
781: {
782: if (nvram->PeekString(0x0004) != "<nv>") {
783: return false;
784: }
785:
786: uint8 eor = CalcNVRAMCsum();
787: for (uint32 addr = 0x1c; addr < 0x1f; addr++) {
788: if (nvram->Peek(addr) != eor) {
789: return false;
790: }
791: }
792: return true;
793: }
794:
795: // NVRAM を初期化する
796: bool
797: LunaPROMEmuDevice::InitNVRAM()
798: {
799: // 初期値どうしたもんか
800: nvram->WriteString(0x0004, "<nv>");
801: nvram->WriteString(0x0020, "BOOT");
802: nvram->WriteString(0x0030, "dk");
803: nvram->WriteString(0x0040, "HOST");
804: nvram->WriteString(0x0050, "nono"); // 偽札的なアレ
805: nvram->WriteString(0x0060, "SERVER");
806: nvram->WriteString(0x0070, "servername");
807: nvram->WriteString(0x0080, "DKUNIT");
808: nvram->WriteString(0x0090, "0");
809: nvram->WriteString(0x00a0, "DKPART");
810: nvram->WriteString(0x00b0, "c");
811: nvram->WriteString(0x00c0, "DKFILE");
812: nvram->WriteString(0x00d0, "vmunix");
813: nvram->WriteString(0x00e0, "FLUNIT");
814: nvram->WriteString(0x00f0, "2");
815: nvram->WriteString(0x0100, "FLFILE");
816: nvram->WriteString(0x0110, "vmunix");
817: nvram->WriteString(0x0120, "STUNIT");
818: nvram->WriteString(0x0130, "0");
819: nvram->WriteString(0x0140, "STFLNO");
820: nvram->WriteString(0x0150, "1");
821: nvram->WriteString(0x0160, "STFILE");
822: nvram->WriteString(0x0170, "vmunix");
823: nvram->WriteString(0x0180, "ETBOOT");
824: nvram->WriteString(0x0190, "server");
825: nvram->WriteString(0x01a0, "ETFILE");
826: nvram->WriteString(0x01b0, "/vmunix");
827: nvram->WriteString(0x0560, "ENADDR");
828: nvram->WriteString(0x0570, ""); // どうするか
829:
830: // チェックサム再計算
831: WriteNVRAMCsum();
832:
833: return true;
834: }
835:
836: // キーコードから文字への変換
837: /*static*/ const uint8
838: LunaPROMEmuDevice::lunakey2asciitable[] = {
839: 0, 0, 0, 0, 0, 0, 0, 0,
840: 0, 0, 0, 0, 0, 0, 0, 0,
841: 0, 0, 0, 0, ' ', 0, 0, 0,
842: 0, 0, 0, 0, 0, 0, 0, 0,
843: 0, 0, '1', '2', '3', '4', '5', '6',
844: '7', '8', '9', '0', '-', '^', '\\', 0,
845: 0, 0, 'q', 'w', 'e', 'r', 't', 'y',
846: 'u', 'i', 'o', 'p', '@', '[', 0, 0,
847: 0, 0, 'a', 's', 'd', 'f', 'g', 'h',
848: 'j', 'k', 'l', ';', ':', ']', 0, 0,
849: 0, 0, 'z', 'x', 'c', 'v', 'b', 'n',
850: 'm', ',', '.', '/', 0, 0, 0, 0,
851: 0, 0, 0, 0, 0, 0, 0, 0, // XXX テンキー
852: 0, 0, 0, 0, 0, 0, 0, 0,
853: 0, 0, 0, 0, 0, 0, 0, 0,
854: 0, 0, 0, 0, 0, 0, 0, 0,
855: };
856: /*static*/ const uint8
857: LunaPROMEmuDevice::lunakey2shifttable[] = {
858: 0, 0, 0, 0, 0, 0, 0, 0,
859: 0, 0, 0, 0, 0, 0, 0, 0,
860: 0, 0, 0, 0, ' ', 0, 0, 0,
861: 0, 0, 0, 0, 0, 0, 0, 0,
862: 0, 0, '1', '2', '3', '4', '5', '6',
863: '7', '8', '9', '0', '=', '~', '|', 0,
864: 0, 0, 'Q', 'W', 'E', 'R', 'T', 'Y',
865: 'U', 'I', 'O', 'P', '`', '{', 0, 0,
866: 0, 0, 'A', 'S', 'D', 'F', 'G', 'H',
867: 'J', 'K', 'L', '+', '*', '}', 0, 0,
868: 0, 0, 'Z', 'X', 'C', 'V', 'B', 'N',
869: 'M', '<', '>', '?', '_', 0, 0, 0,
870: 0, 0, 0, 0, 0, 0, 0, 0, // XXX テンキー
871: 0, 0, 0, 0, 0, 0, 0, 0,
872: 0, 0, 0, 0, 0, 0, 0, 0,
873: 0, 0, 0, 0, 0, 0, 0, 0,
874: };
875:
876:
877: //
878: // UFS ブート
879: //
880:
881: // ディスクラベル (1セクタ目)
882: // svnweb.freebsd.org/csrg/sys/luna68k/stand/omron_disklabel.h
883: struct scd_dk_label
884: {
885: char asciilabel[128]; /* for compatibility */
886: char pad[512 - (128 + 8*8 + 11*2 + 4)];
887: uint16 badchk; /* checksum of bad track */
888: uint32 maxblk; /* # of total logical block */
889: uint16 dtype; /* disk drive type */
890: uint16 ndisk; /* # of disk drives */
891: uint16 ncyl; /* # of data cylinders */
892: uint16 acyl; /* # of altenate cylinders */
893: uint16 nhead; /* # of heads in this partition */
894: uint16 nsect; /* # of 512 byte sectors per track */
895: uint16 bhead; /* identifies proper label locations */
896: uint16 ppart; /* physical partition # */
897: struct { /* logical partitions */
898: uint32 blkno; /* starting block */
899: uint32 nblk; /* number of blocks */
900: } map[8];
901: uint16 magic; /* identifies this label format */
902: uint16 cksum; /* xor checksum of sector */
903:
904: static const uint16 DKL_MAGIC = 0xdabe;
905: };
906: static_assert(sizeof(scd_dk_label) == 512, "size must be 512");
907:
908: // オレオレ inode 情報クラス
1.1.1.2 root 909: class inodefile final
1.1 root 910: {
911: public:
912: inodefile(Device *dev) {
913: parent = dev;
914: }
1.1.1.2 root 915: ~inodefile() { }
1.1 root 916:
917: // ディレクトリエントリからファイルを検索
918: uint32 FindFile(const std::string& name);
919:
920: uint32 ino {}; // inode 番号
921: struct ufs1_dinode di {}; // disk inode 情報 (ゲストエンディアンで保持)
922: std::vector<uint8> data {}; // ファイル(またはディレクトリ)本文
923: private:
924: Device *parent {}; // 親デバイス
925: };
926:
927: // ファイルシステムハンドルっぽいもの
1.1.1.2 root 928: class Filesys final
1.1 root 929: {
930: public:
931: Filesys(Device *dev) {
932: parent = dev;
933: fs = &fs0;
934: }
1.1.1.2 root 935: ~Filesys() { }
1.1 root 936:
937: // ファイルシステムをオープン
938: bool Open(SCSIHD *hd_, uint32 start, uint32 size);
939: // inode 情報を読み込む
940: bool Readi(inodefile& inode);
941: // データを読み込む
942: bool ReadData(inodefile& inode);
943:
944: std::string errstr{}; // エラーメッセージ
945:
946: private:
947: Device *parent {}; // 親デバイス
948: SCSIHD *hd {}; // ターゲット SCSI HD
949: // パーティション情報
950: uint32 part_start {}; // パーティションの先頭セクタ
951: uint32 part_size {}; // パーティションのサイズ(セクタ数)
952: // スーパーブロック情報
953: // fs の(たぶんほとんどの)整数パラメータは読み込み時にホストエンディアン
954: // に変換してあるのでそのままアクセスしてよい。構造体とかまでは全部対応
955: // してないので、必要になったら書き足すこと。
956: struct fs *fs; // 体裁を揃えるためポインタを使いたい
957: struct fs fs0; // こっちが実体
958: };
959:
960: // NVRAM の設定に従って起動先を探す。
961: // fname が指定されればそれをファイル名に使う。empty なら NVRAM の DKFILE
962: // をファイル名に使う。
963: // 成功すればエントリポイントを返す。
964: // 失敗ならをエラーメッセージを errmsg にセットして 0 を返す。
965: uint32
966: LunaPROMEmuDevice::LoadByNVRAM(const std::string& fname)
967: {
968: // 起動先情報を NVRAM (mk48t02) に問い合わせる
969: // DKUNIT はとりあえず無視して SCSI ID=6
970: // DKPART は 'a'..'h' でパーティション。
971: // DKFILE が読み込むカーネル名 (NetBSD ではブートローダ)。
972: int dkunit = nvram->Peek(0x0090) - '0';
973: int dkpart = nvram->Peek(0x00b0) - 'a';
974: std::string dkfile_name;
975: if (!fname.empty()) {
976: dkfile_name = fname;
977: } else {
978: dkfile_name = nvram->PeekString(0x00d0);
979: }
980: putmsg(1, "%s DKUNIT=%d", __func__, dkunit);
981: putmsg(1, "%s DKPART=%c", __func__, dkpart + 'a');
982: putmsg(1, "%s DKFILE=|%s|", __func__, dkfile_name.c_str());
983:
984: // ユニット (今は SCSI ID=6 決め打ち)
985: int id = 6;
986: SCSITarget *target = gSPC->GetTarget(id);
987: if (target == NULL) {
988: errmsg = "No bootable disks";
989: putmsg(0, "%s", errmsg.c_str());
990: return 0;
991: }
1.1.1.3 ! root 992: if (target->GetDevType() != SCSI::DevType::HD) {
1.1 root 993: errmsg = "No bootable disks";
994: putmsg(0, "%s", errmsg.c_str());
995: return 0;
996: }
997:
998: SCSIHD *hd = dynamic_cast<SCSIHD*>(target);
999: putmsg(2, "%s SCSIHD[%d] found", __func__, id);
1000:
1001: // +0 セクタ目(512byte)に Sun disklabel
1002: scd_dk_label dk;
1003: if (hd->PeekImage(&dk, 0, sizeof(dk)) == false) {
1004: putmsg(0, "SCSIHD[%d] ReadSector failed", id);
1005: errmsg = string_format("dk%d Read disklabel failed.", dkunit);
1006: return 0;
1007: }
1008:
1009: // +$1fc の MAGIC をチェック
1010: uint32 magic = be16toh(dk.magic);
1011: if (magic != scd_dk_label::DKL_MAGIC) {
1012: putmsg(0, "SCSIHD[%d] Bad magic 0x%04x (!= 0x%x)",
1013: id, magic, scd_dk_label::DKL_MAGIC);
1014: errmsg = string_format("dk%d Bad disklabel magic.", dkunit);
1015: return 0;
1016: }
1017:
1018: // チェックサム照合は手抜きで省略
1019:
1020: // 指定パーティションの開始位置とサイズ
1021: if (loglevel >= 2) {
1022: // デバッグ用に全部表示
1023: for (int i = 0; i < 8; i++) {
1024: putmsg("%s partition %c: { start=%8u size=%8u }", __func__,
1025: 'a' + i,
1026: be32toh(dk.map[i].blkno),
1027: be32toh(dk.map[i].nblk));
1028: }
1029: }
1030: uint32 part_start = be32toh(dk.map[dkpart].blkno);
1031: uint32 part_size = be32toh(dk.map[dkpart].nblk);
1032: putmsg(1, "%s partition=%c, start=%u size=%u", __func__,
1033: dkpart + 'a', part_start, part_size);
1034:
1035: // ファイルシステムをオープン (マウントっぽいイメージ)
1036: Filesys fsys(this);
1037: if (fsys.Open(hd, part_start, part_size) == false) {
1038: putmsg(0, "SCSIHD[%d] %c: %s", id, dkpart + 'a', fsys.errstr.c_str());
1039: errmsg = string_format("dk%d Open ffs failed.", dkunit);
1040: return 0;
1041: }
1042:
1043: // XXX 以降エラーメッセージ全部同じ
1044: errmsg = string_format("dk%d Read ffs failed.", dkunit);
1045:
1046: std::vector<std::string> dkfile_paths;
1047: int idx = 0;
1048: inodefile dir(this);
1049: inodefile dkfile(this);
1050:
1051: enum {
1052: STATE_REG, // 通常ファイル (終了条件)
1053: STATE_PATH, // パス解析
1054: STATE_DIR, // ディレクトリ読み込み
1055: STATE_FIND, // ディレクトリからファイルを検索
1056: STATE_LINK, // シンボリックリンク
1057: } state;
1058:
1059: // DKFILE の先頭に '/' がなければここで足しておく。
1060: // ファイル名を分解する際にルートディレクトリマークが必要なので。
1061: if (dkfile_name[0] != '/') {
1062: dkfile_name.insert(0, 1, '/');
1063: }
1064: state = STATE_PATH;
1065:
1066: while (state != STATE_REG) {
1067: switch (state) {
1068: case STATE_PATH:
1069: // ファイル名をパスに分解
1070: // dkfile_name にパス名をセットしてからここに来ること。
1071: putmsg(1, "%s Path dkfile_name=|%s|", __func__,
1072: dkfile_name.c_str());
1073: if (dkfile_name.empty()) {
1074: putmsg(0, "SCSIHD[%d] %c: Filename empty?", id, dkpart + 'a');
1075: return 0;
1076: }
1077: dkfile_paths.clear();
1078: for (int s = 0; s < dkfile_name.size(); ) {
1079: int p = dkfile_name.find('/', s);
1080: if (p == std::string::npos) {
1081: p = dkfile_name.size();
1082: }
1083: // '/' が連続していなければパスコンポーネント
1084: if (p != s) {
1085: dkfile_paths.push_back(dkfile_name.substr(s, p - s));
1086: }
1087: s = p + 1;
1088: }
1089: idx = 0;
1090: if (loglevel >= 1) {
1091: for (int i = 0; i < dkfile_paths.size(); i++) {
1092: putmsg("%s dkfile_path[%d]=|%s|",
1093: __func__, i, dkfile_paths[i].c_str());
1094: }
1095: }
1096: // パスが '/' から始まっていればルートディレクトリの読み込みから。
1097: // そうでなければ現在のディレクトリでファイルの検索から。
1098: if (dkfile_name[0] == '/') {
1099: // ルートディレクトリの inode 番号は伝統的に #2 と
1100: // いうことになっている。
1101: dir.ino = 2;
1102: state = STATE_DIR;
1103: } else {
1104: state = STATE_FIND;
1105: }
1106: break;
1107:
1108: case STATE_DIR:
1109: // inode 番号からディレクトリエントリを取得。
1110: // dir.ino をセットしてからここに来ること。
1111: putmsg(1, "%s Readdir ino=%d", __func__, dir.ino);
1112: if (fsys.Readi(dir) == false) {
1113: putmsg(0, "SCSIHD[%d] %c: %s",
1114: id, dkpart + 'a', fsys.errstr.c_str());
1115: return 0;
1116: }
1117: // 中身(ディレクトリエントリ) を取得
1118: if (fsys.ReadData(dir) == false) {
1119: putmsg(0, "SCSIHD[%d] %c: %s",
1120: id, dkpart + 'a', fsys.errstr.c_str());
1121: return 0;
1122: }
1123: state = STATE_FIND;
1124: break;
1125:
1126: case STATE_FIND:
1127: // ディレクトリエントリ dir.data から
1128: // ファイル名 dkfile_paths[idx] を探す。
1129: putmsg(1, "%s FindFile %s", __func__, dkfile_paths[idx].c_str());
1130: dkfile.ino = dir.FindFile(dkfile_paths[idx]);
1131: if (dkfile.ino == 0) {
1132: putmsg(0, "SCSIHD[%d] %c: %s",
1133: id, dkpart + 'a', fsys.errstr.c_str());
1134: return 0;
1135: }
1136: // ファイルの inode 情報を取得。
1137: if (fsys.Readi(dkfile) == false) {
1138: putmsg(0, "SCSIHD[%d] %c: %s",
1139: id, dkpart + 'a', fsys.errstr.c_str());
1140: return 0;
1141: }
1142: switch (be16toh(dkfile.di.di_mode) & IFMT) {
1143: case IFREG: // 通常ファイル
1144: state = STATE_REG;
1145: break;
1146:
1147: case IFLNK: // シンボリックリンク
1148: state = STATE_LINK;
1149: break;
1150:
1151: case IFDIR: // ディレクトリ
1152: dir.ino = dkfile.ino;
1153: idx++;
1154: state = STATE_DIR;
1155: break;
1156:
1157: default: // それ以外は対応してないし来ないはず
1158: putmsg(0, "SCSIHD[%d] %c:%s invalid filemode %06o",
1159: id, dkpart + 'a', dkfile_name.c_str(),
1160: be16toh(dkfile.di.di_mode));
1161: return 0;
1162: }
1163: break;
1164:
1165: case STATE_LINK:
1166: // リンク先ファイル名を取り出す
1167: putmsg(1, "%s Readlink", __func__);
1168: if (fsys.ReadData(dkfile) == false) {
1169: return 0;
1170: }
1171: dkfile_name = std::string((const char *)dkfile.data.data(),
1172: dkfile.data.size());
1173: // パス解析へ
1174: state = STATE_PATH;
1175: break;
1176:
1177: default:
1178: __unreachable();
1179: }
1180: }
1181: // 通常ファイルに到達
1182:
1183: if (idx != dkfile_paths.size() - 1) {
1184: // パスの最後のコンポーネントじゃなければエラー
1185: putmsg(0, "SCSIHD[%d] %c:%s path not found",
1186: id, dkpart + 'a', dkfile_name.c_str());
1187: return 0;
1188: }
1189: // ファイル本体を読み込み
1190: if (fsys.ReadData(dkfile) == false) {
1191: putmsg(0, "SCSIHD[%d] %c: %s", id, dkpart + 'a', fsys.errstr.c_str());
1192: return 0;
1193: }
1194:
1195: // ロード
1196: uint32 entry;
1197: std::string name = string_format("SCSIHD %d,%c:%s",
1198: id, dkpart + 'a', dkfile_name.c_str());
1199: entry = gRAM->LoadFile(name.c_str(), dkfile.data.data(),
1200: dkfile.data.size(), AOUT_MID_M68K);
1201:
1202: return entry;
1203: }
1204:
1205: // パーティションを FFS としてオープンする(マウントのようなイメージ)。
1206: // start, size はこのパーティションの開始セクタとセクタ数。
1207: bool
1208: Filesys::Open(SCSIHD *hd_, uint32 start, uint32 size)
1209: {
1210: hd = hd_;
1211: part_start = start;
1212: part_size = size;
1213:
1214: // FFS の先頭にはブートブロックがあり、続けてスーパーブロックがある。
1215: // ブートブロックはブートローダのための領域で、ここもファイルシステムの
1216: // 内側という認識のようだ。
1217: //
1218: // ブートブロックの大きさはおそらくファイルシステムごとに固定で、
1219: // FFSv1(?) なら 8KB のようだ。ここは LUNA-I の ROM が解釈できるのと
1220: // 同じファイルシステムだけ扱えればよいので、8KB 固定とする。
1221: // 続いてスーパーブロックがある。ここにこのファイルシステムのパラメータ
1222: // が書いてある。
1223: //
1224: // +-------------+ 0 <- part_start (パーティション先頭)
1225: // | BootBlock |
1226: // +-------------+ 8KB
1227: // | SuperBlock |
1228: // | fs_iblkno ---+
1229: // +-------------+ |
1230: // : : |
1231: // |
1232: // : : |
1233: // +-------------+ <-+
1234: // | InodeBlock? |
1235: //
1236: // スーパーブロックの構造は <ufs/ffs/fs.h> の struct fs 参照。
1237:
1238: // スーパーブロックを読む
1239: hd->PeekImage(&fs0, part_start * 512 + 8192, sizeof(fs0));
1240: // 読み込んだスーパーブロックはゲストエンディアン(BE) なので
1241: // 使う前に (もう面倒なのでほぼ全部) ホストエンディアンにしておく。
1242: // ヘッダに定義してあるマクロをそのまま使いたいからだけど、正気かなこれ。
1243: fs->fs_firstfield = be32toh(fs->fs_firstfield);
1244: fs->fs_sblkno = be32toh(fs->fs_sblkno);
1245: fs->fs_cblkno = be32toh(fs->fs_cblkno);
1246: fs->fs_iblkno = be32toh(fs->fs_iblkno);
1247: fs->fs_dblkno = be32toh(fs->fs_dblkno);
1248: fs->fs_old_cgoffset = be32toh(fs->fs_old_cgoffset);
1249: fs->fs_old_cgmask = be32toh(fs->fs_old_cgmask);
1250: fs->fs_old_time = be32toh(fs->fs_old_time);
1251: fs->fs_old_size = be32toh(fs->fs_old_size);
1252: fs->fs_old_dsize = be32toh(fs->fs_old_dsize);
1253: fs->fs_ncg = be32toh(fs->fs_ncg);
1254: fs->fs_bsize = be32toh(fs->fs_bsize);
1255: fs->fs_fsize = be32toh(fs->fs_fsize);
1256: fs->fs_frag = be32toh(fs->fs_frag);
1257: fs->fs_minfree = be32toh(fs->fs_minfree);
1258: fs->fs_old_rotdelay = be32toh(fs->fs_old_rotdelay);
1259: fs->fs_old_rps = be32toh(fs->fs_old_rps);
1260: fs->fs_bmask = be32toh(fs->fs_bmask);
1261: fs->fs_fmask = be32toh(fs->fs_fmask);
1262: fs->fs_bshift = be32toh(fs->fs_bshift);
1263: fs->fs_fshift = be32toh(fs->fs_fshift);
1264: fs->fs_maxcontig = be32toh(fs->fs_maxcontig);
1265: fs->fs_maxbpg = be32toh(fs->fs_maxbpg);
1266: fs->fs_fragshift = be32toh(fs->fs_fragshift);
1267: fs->fs_fsbtodb = be32toh(fs->fs_fsbtodb);
1268: fs->fs_sbsize = be32toh(fs->fs_sbsize);
1269: //fs->fs_spare1[2]
1270: fs->fs_nindir = be32toh(fs->fs_nindir);
1271: fs->fs_inopb = be32toh(fs->fs_inopb);
1272: fs->fs_old_nspf = be32toh(fs->fs_old_nspf);
1273: fs->fs_optim = be32toh(fs->fs_optim);
1274: fs->fs_old_npsect = be32toh(fs->fs_old_npsect);
1275: fs->fs_old_interleave = be32toh(fs->fs_old_interleave);
1276: fs->fs_old_trackskew = be32toh(fs->fs_old_trackskew);
1277: fs->fs_id[0] = be32toh(fs->fs_id[0]);
1278: fs->fs_id[1] = be32toh(fs->fs_id[1]);
1279: fs->fs_old_csaddr = be32toh(fs->fs_old_csaddr);
1280: fs->fs_cssize = be32toh(fs->fs_cssize);
1281: fs->fs_cgsize = be32toh(fs->fs_cgsize);
1282: fs->fs_spare2 = be32toh(fs->fs_spare2);
1283: fs->fs_old_nsect = be32toh(fs->fs_old_nsect);
1284: fs->fs_old_spc = be32toh(fs->fs_old_spc);
1285: fs->fs_old_ncyl = be32toh(fs->fs_old_ncyl);
1286: fs->fs_old_cpg = be32toh(fs->fs_old_cpg);
1287: fs->fs_ipg = be32toh(fs->fs_ipg);
1288: fs->fs_fpg = be32toh(fs->fs_fpg);
1289: //struct csum fs_old_cstotal
1290: //u_char fs_fsmnt[MAXMNTLEN]
1291: //u_char fs_volname[MAXVOLLEN]
1292: fs->fs_swuid = be64toh(fs->fs_swuid);
1293: fs->fs_pad = be32toh(fs->fs_pad);
1294: fs->fs_cgrotor = be32toh(fs->fs_cgrotor);
1295: //void *fs_ocsp[NOCSPTRS]
1296: //struct csum *fs_csp
1297: //uint32_t *fs_maxcluster
1298: //u_char *fs_active
1299: fs->fs_old_cpc = be32toh(fs->fs_old_cpc);
1300: fs->fs_maxbsize = be32toh(fs->fs_maxbsize);
1301: fs->fs_journal_flags = be32toh(fs->fs_journal_flags);
1302: //uint64_t fs->fs_journallocs[4]
1303: fs->fs_quota_magic = be32toh(fs->fs_quota_magic);
1304: //uint64_t fs->fs_quotafile[2]
1305: //uint64_t fs->fs_sparecon64[9]
1306: fs->fs_sblockloc = be64toh(fs->fs_sblockloc);
1307: //struct csum_total fs_cstotal
1308: fs->fs_time = be64toh(fs->fs_time);
1309: fs->fs_size = be64toh(fs->fs_size);
1310: fs->fs_dsize = be64toh(fs->fs_dsize);
1311: fs->fs_csaddr = be64toh(fs->fs_csaddr);
1312: fs->fs_pendingblocks = be64toh(fs->fs_pendingblocks);
1313: fs->fs_pendinginodes = be32toh(fs->fs_pendinginodes);
1314: // uint32_t fs->fs_snapinum[FSMAXSNAP]
1315: fs->fs_avgfilesize = be32toh(fs->fs_avgfilesize);
1316: fs->fs_avgfpdir = be32toh(fs->fs_avgfpdir);
1317: fs->fs_save_cgsize = be32toh(fs->fs_save_cgsize);
1318: // uint32_t fs->fs_sparecon32[26]
1319: fs->fs_flags = be32toh(fs->fs_flags);
1320: fs->fs_contigsumsize = be32toh(fs->fs_contigsumsize);
1321: fs->fs_maxsymlinklen = be32toh(fs->fs_maxsymlinklen);
1322: fs->fs_old_inodefmt = be32toh(fs->fs_old_inodefmt);
1323: fs->fs_maxfilesize = be64toh(fs->fs_maxfilesize);
1324: fs->fs_qbmask = be64toh(fs->fs_qbmask);
1325: fs->fs_qfmask = be64toh(fs->fs_qfmask);
1326: fs->fs_state = be32toh(fs->fs_state);
1327: fs->fs_old_postblformat = be32toh(fs->fs_old_postblformat);
1328: fs->fs_old_nrpos = be32toh(fs->fs_old_nrpos);
1329: // uint32_t fs->fs_spare5[2]
1330: fs->fs_magic = be32toh(fs->fs_magic);
1331:
1332: // マジック
1333: if (fs->fs_magic != FS_UFS1_MAGIC) {
1334: errstr = string_format("Bad superblock magic 0x%08x (!= 0x%08x)",
1335: fs->fs_magic, FS_UFS1_MAGIC);
1336: return false;
1337: }
1338:
1339: // なんとなく主要なパラメータを表示してみるか
1340: if (parent->loglevel >= 2) {
1341: uint32 sblkno = fs->fs_sblkno; // super block in filesys
1342: uint32 cblkno = fs->fs_cblkno; // cylinder group block in filesys
1343: uint32 iblkno = fs->fs_iblkno; // inode block in filesys
1344: uint32 dblkno = fs->fs_dblkno; // data block in filesys
1345: uint32 bsize = fs->fs_bsize; // size of basic blocks
1346: uint32 ipg = fs->fs_ipg; // inodes per group
1347: uint32 fpg = fs->fs_fpg; // blocks per group x fs_frag
1348: uint32 old_cgoffset = fs->fs_old_cgoffset; // cg. offset in cyl.
1349:
1350: parent->putmsg("%s fs.fs_sblkno=0x%x (0x%x)",
1351: __func__, sblkno, sblkno * 512);
1352: parent->putmsg("%s fs.fs_cblkno=0x%x (0x%x)",
1353: __func__, cblkno, cblkno * 512);
1354: parent->putmsg("%s fs.fs_dblkno=0x%x (0x%x)",
1355: __func__, dblkno, dblkno * 512);
1356: parent->putmsg("%s fs.fs_iblkno=0x%x (0x%x)",
1357: __func__, iblkno, iblkno * 512);
1358: parent->putmsg("%s fs.fs_bsize=0x%x", __func__, bsize);
1359: parent->putmsg("%s fs.fs_ipg=0x%x", __func__, ipg);
1360: parent->putmsg("%s fs.fs_fpg=0x%x", __func__, fpg);
1361: parent->putmsg("%s fs.fs_old_cgoffset=0x%x", __func__, old_cgoffset);
1362: }
1363:
1364: return true;
1365: }
1366:
1367: // inode.ino で指定された disk inode 情報を inode.di に返す
1368: bool
1369: Filesys::Readi(inodefile& inode)
1370: {
1371: // di は inode のディスク上の記録構造で 128 バイト長。
1372: // 詳細は <ufs/ufs/dinode.h> の ufs1_dinode 参照。
1373: // 基本的には inode ブロックにこの dinode が配列のように並んでいるが
1374: // シリンダグループを越えるためには謎のマクロを使う。
1375: // sys/lib/libsa/ufs.c 参照。
1376: //
1377: // dinode のうち、ここで関係するかも知れないのは
1378: // di_mode (のうちファイルモード)
1379: // di_size (ファイルサイズ)
1380: // di_db[] (直接ブロック)
1381: // di_ib[] (間接ブロック)
1382: // di_blocks (ブロック数)
1383: // くらいか。
1384:
1385: uint32 ino = inode.ino;
1386: struct ufs1_dinode *di = &inode.di;
1387:
1388: // ino が含まれるブロックを読み込む
1.1.1.2 root 1389: std::vector<char> buf(fs->fs_bsize);
1.1 root 1390: uint32 ino_sector = FFS_FSBTODB(fs, ino_to_fsba(fs, ino));
1.1.1.2 root 1391: hd->PeekImage(&buf[0], part_start + ino_sector * 512, buf.size());
1.1 root 1392:
1393: // ino で示される inode を取得
1.1.1.2 root 1394: *di = ((ufs1_dinode *)(&buf[0]))[ino_to_fsbo(fs, ino)];
1.1 root 1395: uint16 di_mode = be16toh(di->di_mode);
1396: uint16 di_nlink = be16toh(di->di_nlink);
1397: uint64 di_size = be64toh(di->di_size);
1398: parent->putmsg(2, "%s di[%d].di_mode=%05o di_nlink=%d di_size=%" PRIu64,
1399: __func__, ino, di_mode, di_nlink, di_size);
1400:
1401: return true;
1402: }
1403:
1404: // inode.di で指定されたファイル(またはディレクトリ)の本文を
1405: // inode.data に返す
1406: bool
1407: Filesys::ReadData(inodefile& inode)
1408: {
1409: // di (ufs1_dinode) にはこの inode (ファイルまたはディレクトリ)の
1410: // データの格納ブロックが記録されている。ディレクトリとは中身が
1411: // ディレクトリエントリであるファイルと同じ構造のもの。
1412: // di_db[] (直接ブロック)
1413: // di_ib[] (間接ブロック)
1414: // di_blocks (実際に使用しているブロック数)
1415: //
1416: // 直接ブロック di_db[] は12要素の配列で、データブロックの位置が
1417: // 記録されている (未使用なら 0 のようだ)。
1418: // データブロックは fs->fs_bsize でたぶん基本 4KB のやつ。
1419: // これもパーティション先頭からのセクタ番号で表記される。なので
1420: // ディスク上で連続しているファイルなら di_db[N] と di_db[N + 1] は
1421: // 8 ずつ増えてるのが見えるはず。
1422: // 例えば以下のサンプル断片は、直接ブロック2つでセクタ 100 から
1423: // セクタ 115 までの連続する 16KB を所有している様子を示している。
1424: //
1425: // #100 #101 #102 #107
1426: // +------+------+------+- .. -+------+
1427: // di_db[0] = 100 ---> | Data | Data | Data | | Data |
1428: // +------+------+------+- .. -+------+
1429: //
1430: // #108 #115
1431: // +------+------+------+- .. -+------+
1432: // di_db[1] = 108 ---> | Data | Data | Data | | Data |
1433: // +------+------+------+- .. -+------+
1434: //
1435: // 間接ブロック di_ib[0], [1], [2] はそれぞれ一次、二次、三次の
1436: // 間接記録になっている。一次間接だとこういう感じ。
1437: //
1438: // #120
1439: // +--------+ +------+- ..
1440: // di_ib[0] = 120 ---> | #200 ------> #200 | Data |
1441: // | | +------+- ..
1442: // | #208 ------> #208 | Data |
1443: // +--------+ +------+- ..
1444: //
1445:
1446: uint32 ino = inode.ino;
1447: struct ufs1_dinode *di = &inode.di;
1448: std::vector<uint8>& data = inode.data;
1449: uint64 bsize64 = (uint64)fs->fs_bsize;
1450:
1451: uint64 di_size = be64toh(di->di_size);
1452: uint32 di_blocks = be32toh(di->di_blocks);
1453: // di->di_db[] にファイル(またはディレクトリ)の内容の位置が並んでいる
1454: if (parent->loglevel >= 2) {
1455: parent->putmsg("%s di[%d].di_blocks=%u", __func__, ino, di_blocks);
1456:
1457: std::string dbstr;
1458: for (int i = 0; i < UFS_NDADDR; i++) {
1459: dbstr += string_format(" %u", be32toh(di->di_db[i]));
1460: }
1461: parent->putmsg("%s di[%d].di_db[]=%s",
1462: __func__, ino, dbstr.c_str() + 1);
1463:
1464: std::string distr;
1465: for (int i = 0; i < UFS_NIADDR; i++) {
1466: distr += string_format(" %u", be32toh(di->di_ib[i]));
1467: }
1468: parent->putmsg("%s di[%d].di_ib[]=%s",
1469: __func__, ino, distr.c_str() + 1);
1470: }
1471:
1472: uint64 offset = 0; // 次に読み込む位置 (ここまでに読み込んだバイト数)
1473:
1474: // サイズが分かっているのであらかじめ確保しておく
1475: data.resize(di_size);
1476:
1477: // 直接ブロック
1478: for (int i = 0; i < countof(di->di_db); i++) {
1479: uint64 remain = di_size - offset; // 残りバイト数
1480: uint32 nbytes = std::min(remain, bsize64); // 今回読み込み分
1481: hd->PeekImage(&data[offset], be32toh(di->di_db[i]) * 512, nbytes);
1482: offset += nbytes;
1483: if (offset >= di_size)
1484: break;
1485: }
1486: // 一次間接ブロック
1.1.1.2 root 1487: std::vector<uint32> ib0buf(fs->fs_bsize / sizeof(uint32));
1488: hd->PeekImage(&ib0buf[0], be32toh(di->di_ib[0]) * 512,
1489: ib0buf.size() * sizeof(uint32));
1.1 root 1490: if (parent->loglevel >= 2) {
1491: std::string distr;
1.1.1.2 root 1492: for (const auto& x : ib0buf) {
1493: if (x == 0)
1.1 root 1494: break;
1.1.1.2 root 1495: distr += string_format(" %u", be32toh(x));
1.1 root 1496: }
1497: parent->putmsg("%s di[%d].di_ib[0]=%s",
1498: __func__, ino, distr.c_str() + 1);
1499: }
1.1.1.2 root 1500: for (const auto& x : ib0buf) {
1.1 root 1501: uint64 remain = di_size - offset; // 残りバイト数
1502: uint32 nbytes = std::min(remain, bsize64); // 今回読み込み分
1.1.1.2 root 1503: hd->PeekImage(&data[offset], be32toh(x) * 512, nbytes);
1.1 root 1504: offset += nbytes;
1505: if (offset >= di_size)
1506: break;
1507: }
1508:
1509: // 二次、三次ブロックは未対応
1510: if (offset < di_size) {
1511: PANIC("di_ib[1] not supported");
1512: }
1513:
1514: return true;
1515: }
1516:
1517: // ディレクトリエントリ dirbuf から name で指定されるファイル名に対応する
1518: // inode 番号を返す。見付からなければ 0 を返す。
1519: uint32
1520: inodefile::FindFile(const std::string& name)
1521: {
1522: // ディレクトリエントリは可変長で並んでいる。
1523: // d->d_reclen がこの1つ分のエントリの長さなので、次のエントリ位置は
1524: // このエントリの頭から d->d_reclen を足したところになる。
1525: // 最終エントリの d_reclen を足すとバッファ末尾になるようになっている
1526: // ようだ。
1527: const char *dp = (const char *)(data.data());
1528: const char *dend = dp + data.size();
1529: uint32 file_ino;
1530: uint16 reclen;
1531:
1532: for (; dp < dend; dp += reclen) {
1533: const struct direct *d = (const struct direct *)dp;
1534: file_ino = be32toh(d->d_fileno);
1535: reclen = be16toh(d->d_reclen);
1536:
1537: std::string str = string_format("ino=%u reclen=%u name=|%s|",
1538: file_ino, reclen, d->d_name);
1539: if (strcmp(name.c_str(), d->d_name) == 0) {
1540: parent->putmsg(2, "%s %s found", __func__, str.c_str());
1.1.1.2 root 1541: return file_ino;
1.1 root 1542: } else {
1543: parent->putmsg(2, "%s %s skip", __func__, str.c_str());
1544: }
1545: }
1.1.1.2 root 1546: parent->putmsg(2, "%s %s not found", __func__, name.c_str());
1547: return 0;
1.1 root 1548: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.