![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to m680x0core.cpp CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Isaki's NoNo m68k/m88k emulator] / nono / m680x0|
Return to m680x0core.cpp CVS log | Up to [Isaki's NoNo m68k/m88k emulator] / nono / m680x0 |
1.1 root 1: //
2: // nono
3: // Copyright (C) 2020 nono project
4: // Licensed under nono-license.txt
5: //
6:
7: #include "mpu680x0.h"
8: #include "bitops.h"
9: #include "debugger.h"
10: #include "interrupt.h"
11: #include "mainbus.h"
12: #include "scheduler.h"
13: #include "vectortable.h"
14:
15: #define OP_FUNC(name) __CONCAT(op_,name)()
16:
17: // 1命令実行する。
18: // 割り込みチェックなどを省いたショート版。
19: void
20: MPU680x0Device::ExecShort(Event& ev)
21: {
22: uint64 cycle_start = used_cycle;
23:
24: buswait = 0;
25:
26: try {
27: // 1命令版では switch-case を使うしかない。
28: ppc = reg.pc;
29: flag_pi = 0;
30: flag_pd = 0;
31: ir = fetch_2();
32:
33: // uint16 を 6ビット右シフトしたら 1024 以上になるはずは
34: // ないのだが、デフォルトでは gcc/clang どちらも律儀に
35: // 1024 以上かどうか比較して分岐しようとする。
36: // gcc は __assume() を入れることでこの比較・分岐を出力
37: // しないようにすることが出来た(がパフォーマンスの差は
38: // 見えない程度でしかなかった)。
39: // clang ではどうやったら効くか不明。
40: uint16 ir6 = ir >> 6;
41: __assume(ir6 < 1024);
42: switch (ir6) {
43: #include "m680x0switch.h"
44: }
45:
46: if (__predict_false(icache_enable == false)) {
47: used_cycle += cycle_nocache;
48: cycle_nocache = 0;
49: }
50: } catch (uint vector) {
51: // ここで(C++の)例外スローをキャッチするのは
52: // - メモリ空間をアクセスした先でのバスエラー例外
53: // - EA パース中の不当命令例外
54: // のみ。それ以外の命令途中例外はその場で処理できる。
55: if (__predict_false(loglevel >= 2)) {
56: const char *name = vectortable->GetExceptionName(vector);
57: if (__predict_true(name)) {
58: putlogn("%s", name);
59: } else {
60: putlogn("vector 0x%x", vector);
61: }
62: }
63: if (vector == M68K::EXCEP_BUSERR) {
64: ExceptionBuserr(vector);
65: } else if (vector == M68K::EXCEP_ILLEGAL) {
66: op_illegal();
67: } else {
68: Exception(vector);
69: }
70: }
71:
72: // 外部割り込みの起動は VM 側で処理している。
73:
74: int cycle = used_cycle - cycle_start;
75: ev.time = cycle * clock_nsec + buswait;
76: scheduler->StartEvent(ev);
77: }
78:
79: // 二重バスフォールト
80: void
81: MPU680x0Device::DoubleBusFault(const char *where)
82: {
83: // where をログに出す?
84:
85: // ホールト状態へ移行
86: Halt();
87: }
88:
89: // SR (と CCR) をセットする。
90: // リセット例外以外から使う (リセット例外はやや異なるため)。
91: //
92: // 割り込みマスクが変わる場合は、ここで次の命令実行コールバックを差し替える。
93: void
94: MPU680x0Device::SetSR(uint16 data)
95: {
96: bool oldS = reg.s;
97: bool oldM = reg.m;
98:
99: // 現在の SP を保存
100: if (oldS == false) {
101: reg.usp = reg.A[7];
102: } else if (oldM == false) {
103: reg.isp = reg.A[7];
104: } else {
105: reg.msp = reg.A[7];
106: }
107:
108: reg.ccr.Set(data);
109: reg.s = ((data & M68K::SR_S) != 0);
110: reg.m = ((data & M68K::SR_M) != 0);
111:
112: // 割り込みマスクレジスタを更新して..
113: uint new_mask = (data >> 8) & 7;
114: if (reg.intr_mask != new_mask) {
115: reg.intr_mask = new_mask;
116:
117: // 次の命令境界で割り込みをチェックさせる
118: MakeNextFull();
119: }
120:
121: // 新しい SP を用意
122: if (reg.s == false) {
123: reg.A[7] = reg.usp;
124: } else if (reg.m == false) {
125: reg.A[7] = reg.isp;
126: } else {
127: reg.A[7] = reg.msp;
128: }
129:
130: // FC2-0
131: fc_inst = BusAddr::Fetch | busaddr::SU(reg.s);
132: fc_data = BusAddr::D | busaddr::SU(reg.s);
133:
134: // XXX 他に何か状態変えないといけないことあったっけか。
135: }
136:
137: // 命令中に (An)+ で変化したアドレスレジスタを命令実行前の状態に巻き戻す。
138: // flag_pi は bit7..0 が save_pi[7..0] の A7..A0 に対応している。
139: void
140: MPU680x0Device::restore_reg_pi()
141: {
142: for (int i = 7; flag_pi; i--) {
143: if ((int8)flag_pi < 0) {
144: reg.A[i] = save_pi[i];
145: }
146: flag_pi <<= 1;
147: }
148: }
149:
150: // 命令中に -(An) で変化したアドレスレジスタを命令実行前の状態に巻き戻す。
151: // flag_pd は bit7..0 が save_pd[7..0] の A7..A0 に対応している。
152: void
153: MPU680x0Device::restore_reg_pd()
154: {
155: for (int i = 7; flag_pd; i--) {
156: if ((int8)flag_pd < 0) {
157: reg.A[i] = save_pd[i];
158: }
159: flag_pd <<= 1;
160: }
161: }
162:
163: // vector にジャンプする。vector はベクタ番号(アドレスではない)。
164: void
165: MPU680x0Device::JumpVector(uint vector, bool from_buserr)
166: {
167: uint32 vecaddr;
168: uint32 newpc;
169:
170: vecaddr = reg.vbr + vector * 4;
171: newpc = read_4(vecaddr);
172: // VBR 込みのジャンプ先が確定したところで今度はブランチ履歴に記録。
173: // この時のブランチ元はベクタアドレス
174: // (reg.pc は fetch によって進んでしまうので先に保存)
175: uint32 inst = BranchHistory_m680x0::VectorJump;
176: brhist.AddEntry(vecaddr | (IsSuper() ? 1 : 0), newpc, inst);
177:
178: // 奇数番地ならアドレスエラー
179: if (__predict_false((newpc & 1) != 0)) {
180: if (from_buserr) {
181: // バスエラー処理中ならダブルバスフォールト。
182: throw M68K::EXCEP_ADDRERR;
183: } else {
184: ExceptionBuserr(M68K::EXCEP_ADDRERR);
185: }
186: return;
187: }
188: reg.pc = newpc;
189:
190: // 実際はここでパイプライン充填のために3ワードフェッチするので、
191: // ベクタテーブルはフェッチ出来たけどそのジャンプ先がバスエラーに
192: // なるケースはここでバスエラーが出なければいけないが、まだ
193: // キャッシュを実装していないので、ここで1ワードフェッチしてみて
194: // PC を戻すあほっぽい方法を取る。
195: fetch_2();
196: reg.pc -= 2;
197: }
198:
199: // 例外スタックフレーム $0 を生成する。
200: // vector はベクタ番号。
201: // sr は例外発生時の SR。
202: // pc はスタックに積むプログラムカウンタの値 (例外によって、この命令位置か
203: // 次の命令位置かが異なる)。
204: inline void
205: MPU680x0Device::GenerateExframe0(uint vector, uint16 sr, uint32 pc)
206: {
207: // 例外スタックフレーム $0
208: // SP+$00.W STATUS REGISTER
209: // +$02.L PROGRAM COUNTER ; 例外ごとに異なる
210: // +$06.W %0000 | VECTOR
211:
212: push_2((0 << 12) | (vector << 2));
213: push_4(pc);
214: push_2(sr);
215: }
216:
217: // 例外スタックフレーム $2 を生成する。
218: // vector はベクタ番号。
219: // 例外によって pc と addr の内容が異なるので呼び出す側で適切にセットすること。
220: //
221: // - CHK*、TRAP*、ゼロ除算:
222: // PC = 次の命令
223: // Addr = 例外を起こした命令
224: // - 68040 のアドレスエラー:
225: // PC = アドレスエラーを起こした命令
226: // Addr = 参照したアドレス - 1
227: inline void
228: MPU680x0Device::GenerateExframe2(uint vector, uint16 sr,
229: uint32 pc, uint32 addr)
230: {
231: // 例外スタックフレーム $2
232: // SP+$00.W STATUS REGISTER
233: // +$02.L PROGRAM COUNTER ; こっちが pc
234: // +$06.W %0010 | VECTOR
235: // +$08.L ADDRESS ; こっちが addr
236:
237: push_4(addr); // ADDRESS
238: push_2((2 << 12) | (vector << 2));
239: push_4(pc); // PROGRAM COUNTER
240: push_2(sr);
241: }
242:
1.1.1.2 ! root 243: // 例外スタックフレーム $4 を生成する。(68LC040 only)
! 244: inline void
! 245: MPU680x0Device::GenerateExframe4(uint vector, uint16 sr, uint32 ea)
! 246: {
! 247: // 公式の図 (のオフセット) が雑すぎる。
! 248: //
! 249: // SP->| STATUS REGISTER
! 250: // +$02 | PROGRAM COUNTER (H) ; こっちは次の命令
! 251: // +$04 | (L)
! 252: // +$06 | %0100 | VECTOR OFFSET
! 253: // +$08 | EFFECTIVE ADDRESS (H)
! 254: // +$0a | (L)
! 255: // +$0c | PC OF FAULTED INSTRUCTION (H)
! 256: // +$0e | (L)
! 257:
! 258: push_4(ppc);
! 259: push_4(ea);
! 260: push_2((4 << 12) | (vector << 2));
! 261: push_4(reg.pc);
! 262: push_2(sr);
! 263: }
! 264:
1.1 root 265: // 例外スタックフレーム $7 を生成する。(68040 only)
266: inline void
267: MPU680x0Device::GenerateExframe7(uint vector, uint16 sr)
268: {
269: uint16 ssw;
270: uint32 fault_addr;
271: uint32 pc;
272: uint32 ea = 0;
273: uint16 wb1s = 0;
274: uint16 wb2s = 0;
275: uint32 wb1a = 0;
276: uint32 wb2a = 0;
277: uint32 wb1d = 0;
278: uint32 wb2d = 0;
279:
280: // 再実行について。
281: //
282: // MOVEM の途中でバスエラーが起きた場合、
283: // 本来は RTE が SSW の CM ビットを見て途中の状態から処理を再開した上で
284: // 次の命令に戻る、らしいが、
285: // ここでは再アクセスに副作用はないものとして、CM ビットは立てず、RTE でも
286: // 何もせずに MOVEM 自体を再実行する。
287: //
288: // それ以外の命令でバスエラーが起きた場合も、単に命令を再実行する。
289: // そのため -(An), (An)+ は例外発生時に常に巻き戻してある。
290:
291: // 例外スタックフレーム $7
292: // SP+$00.W STATUS REGISTER
293: // +$02.L PROGRAM COUNTER
294: // +$06.W %0111 | VECTOR
295: // +$08.L EFFECTIVE ADDRESS (EA)
296: // +$0c.W SPECIAL STATUS REGISTER (SSW)
297: // +$0e.W $00 | WRITE-BACK 3 STATUS (WB3S)
298: // +$10.W $00 | WRITE-BACK 2 STATUS (WB2S)
299: // +$12.W $00 | WRITE-BACK 1 STATUS (WB1S)
300: // +$14.L FAULT ADDRESS (FA)
301: // +$18.L WRITE-BACK 3 ADDRESS (WB3A)
302: // +$1c.L WRITE-BACK 3 DATA (WB3D)
303: // +$20.L WRITE-BACK 2 ADDRESS (WB2A)
304: // +$24.L WRITE-BACK 2 DATA (WB2D)
305: // +$28.L WRITE-BACK 1 ADDRESS (WB1A)
306: // +$2c.L WRITE-BACK 1 DATA / PUSH DATA LW0 (WB1D/PD0)
307: // +$30.L PUSH DATA LW1 (PD1)
308: // +$34.L PUSH DATA LW2 (PD2)
309: // +$38.L PUSH DATA LW3 (PD3)
310: // +$40
311: // こっちから上に向かって PUSH
312:
313: // SSW
314: // 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0
315: // +---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+
316: // |CP |CU |CT |CM |MA |ATC|LK |RW | - | SIZE | TT | TM |
317: // +---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+
318:
319: // この後のスタック操作で bus が変化する前に保存。
320: fault_addr = bus.laddr.Addr();
321:
322: ssw = bus.laddr.GetFC(); // TM
323: ssw |= (bus.size & 3) << 5;
324: bool is_write = bus.IsWrite();
325: if (is_write == false) {
326: ssw |= M68040::SSW_RW;
327: }
328: if (bus.atcfault) {
329: ssw |= M68040::SSW_ATC;
330: bus.atcfault = false;
331:
332: if (bus.atcfault2) {
333: ssw |= M68040::SSW_MA;
334: bus.atcfault2 = false;
335: }
336: }
337: // 再実行のため、例外を発生した命令に戻る。
338: pc = ppc;
339:
340: push_4(0); // PD3
341: push_4(0); // PD2
342: push_4(0); // PD1
343: push_4(wb1d); // WB1D
344: push_4(wb1a); // WB1A
345: push_4(wb2d); // WB2D
346: push_4(wb2a); // WB2A
347: push_4(0); // WB3D
348: push_4(0); // WB3A
349: push_4(fault_addr);
350: push_2(wb1s); // WB1S
351: push_2(wb2s); // WB2S
352: push_2(0); // WB3S
353: push_2(ssw);
354: push_4(ea);
355: push_2(0x7000 | vector);
356: push_4(pc);
357: push_2(sr);
358: }
359:
360: // 例外スタックフレーム $B を生成する。(68030 only)
361: inline void
362: MPU680x0Device::GenerateExframeB(uint vector, uint16 sr)
363: {
364: uint16 ssw;
365: uint32 fault_addr;
366: uint32 stageBaddr;
367:
368: stageBaddr = reg.pc + 2;
369: // この後のスタック操作で bus が変化する前に保存
370: fault_addr = bus.laddr.Addr();
371:
372: // DF は常に立てる必要がある??
373: ssw = bus.laddr.GetSSW() | M68030::SSW_SIZE(bus.size) | M68030::SSW_DF;
374: if (mmu_enable && (ssw & M68K::FC_DATA) != 0) {
375: // 命令アクセスなら RB をセット。
376: ssw |= M68030::SSW_RB;
377: }
378:
379: // 例外スタックフレーム $B
380: // SP+$00.W STATUS REGISTER
381: // +$02.L PROGRAM COUNTER
382: // +$06.W %1011 | VECTOR
383: // +$08.W (internal register)
384: // +$0a.W SPECIAL STATUS REGISTER ; SSW
385: // +$0c.W INSTRUCTION PIPE STAGE C
386: // +$0e.W INSTRUCTION PIPE STAGE B
387: // +$10.L DATA CYCLE FAULT ADDRESS
388: // +$14.W*2 (internal register)
389: // +$18.L DATA OUTPUT BUFFER
390: // +$1c.W*4 (internal register, 4 words)
391: // +$24.L STAGE B ADDRESS
392: // +$28.W*2 (internal register, 2 words)
393: // +$2c.L DATA INPUT BUFFER
394: // +$30.W*3 (internal register, 3 words)
395: // +$36.W VERSION# | internal information
396: // +$38.W*18 (internal register, 18 words)
397: // +$5a
398: // こっちから上に向かって PUSH
399:
400: // internal registers, 18 words
401: // 内部レジスタ18ワードのうち、ここでは17ワード分を save_pd[8] (16ワード)、
402: // flag_pd (1ワード) として使うことにする。
403: // -(An) でバスエラーが起きると An は減算された状態になるが、DF ビットが
404: // 立っていて再実行する時には現行構造では命令先頭から再実行せざるをえず、
405: // そうするともう一度プリデクリメントが動いてしまう。そのため、RTE の時点
406: // で DF=1 ならプリデクリメント発生前の An に戻すという処理をする。
407: // RTE 時点で DF=0 なら命令を再実行しないため An も巻き戻してはならず、
408: // そのためプリデクリメント分の巻き戻しは RTE 時点まで行えない。
409: // 一方、ポストインクリメントのケースはこの少し下の
410: // ExceptionBuserr() 内のコメント参照。
411: for (int i = 7; i >= 0; i--) {
412: push_4(save_pd[i]);
413: }
414: push_2(flag_pd);
415: reg.A[7] -= 2;
416:
417: reg.A[7] -= 2; // VERSION#
418: reg.A[7] -= 6;
419: push_4(0); // DATA INPUT BUFFER
420: reg.A[7] -= 4;
421: push_4(stageBaddr); // STAGE B ADDRESS
422: reg.A[7] -= 8;
423: push_4(0); // DATA OUTPUT BUFFER
424: reg.A[7] -= 4;
425: push_4(fault_addr); // DATA CYCLE FAULT ADDRESS
426: push_2(0); // INSTRUCTION PIPE STAGE B
427: push_2(0); // INSTRUCTION PIPE STAGE C
428: push_2(ssw);
429: reg.A[7] -= 2;
430: push_2(0xb000 | (vector << 2));
431: // 本当は現在の PC だが、再実行のため PPC を積む。
432: push_4(ppc); // PC
433: push_2(sr); // 例外入り口で保存した SR
434: }
435:
436: // 例外処理について。
437: //
438: // 0. リセット例外
439: // リセット例外は外部から ExceptionReset() を呼び出す。
440: //
441: // 1. バスエラー例外
442: // MMU による論理アドレスでのバスエラーは (Translate*() が false を返した後)
443: // m68030bus.cpp ルーチンが (C++の) 例外をスローする。
444: // 物理アドレス空間アクセス後のバスエラーは (VM側の Read*()/Write*() が
445: // BusErr を返した後) m68030bus.cpp ルーチンが (C++) の例外をスローする。
446: // どちらのケースも m68030core.cpp のメインループで catch し、その catch
447: // ブロック内で ExceptionBuserr() を呼び出す。
448: //
449: // 2. アドレスエラー例外
450: // アドレスエラーは Jump() 内でのみ発生するはずで、その場で
451: // ExceptionBuserr() を呼んで処理する。
452: //
453: // 3. 命令中で起きる例外
454: // 命令途中で起きる(確定的な)例外は基本的に Exception() を呼び出す。
455: // これに該当するのは
456: // o 特権違反
457: // o A系列/F系列命令
458: // o TRAP* 系命令、CHK/CHK2 命令
459: // o トレース例外 (未実装)
460: // o ゼロ除算?
461: // o MMU 構成例外
462: // o 不当命令 (*)
463: // である。
464: // ただし、不当命令についてはどこで不当命令と判定されるかによって
465: // フローが複数存在することに注意。
466: // o 1ワード目が不当命令
467: // -> 命令がそれぞれ Exception() で処理。
468: // o 1ワード目の EA が不当命令
469: // -> (C++の)例外をスローして catch 内で Exception() を実行。
470: // o 2ワード目が不当命令
471: // -> 命令がそれぞれ Exception() で処理。
472: //
473: // 4. 割り込み例外
474: // 別コメント(下のほう)参照。
475: //
476:
477: // リセット例外処理。
478: // 各レジスタを所定の状態にして、リセットベクタを読み込む。
479: // リセットベクタが読み込めなければ HALT 状態に移行。
480: // 戻り値は消費したサイクル数。
481: int
482: MPU680x0Device::ExceptionReset()
483: {
484: uint64 cycle_start = used_cycle;
485:
486: // 例外履歴に記録 (例外発生はブランチ履歴にも記録)
487: // m68k では今の所リセット例外発生時の PC にはあまり意味がないけど、
488: // m88k と動作を揃えておく。
489: const uint vector = 0;
490: excep_counter[0]++;
491: exhist.AddEntry(reg.pc | 1, 0, BranchHistory_m680x0::Exception | 0);
492: brhist.AddEntry(reg.pc | 1, 0, BranchHistory_m680x0::Exception | 0);
493: // デバッガに通知 (例外ブレーク用)。こっちのベクタは 0 のままでよい。
494: debugger->NotifyExceptionMain(vector);
495:
496: // RESET 信号線をネゲートしてから SP の読み込み開始まで 4クロック
497: // (Section 7.8, Figure 7-64)
498: used_cycle += 4;
499:
500: // STOP 状態とホールト状態を解除。
501: ChangeState(CPU_STATE_NORMAL);
502:
503: // 1. T0, T1 クリア
504: // 2. S をセット、M をクリア
505: // 3. 割り込みレベルを 7
506:
507: // ここは SetSR を使わずに設定する。
508: reg.s = true;
509: reg.m = false;
510: fc_inst = BusAddr::S | BusAddr::Fetch;
511: fc_data = BusAddr::S | BusAddr::D;
512: // ここは割り込みレベル変化のチェックは不要でセットだけでいい。
513: reg.intr_mask = 7;
514:
515: // 4. VBR をクリア
516: reg.vbr = 0;
517:
518: // 5. キャッシュの EI|ED, FI|FD, IBE|DBE, WA をクリア
519: // 6. キャッシュエントリをすべてクリア (CI|CD)
520: cycle_nocache = 0;
521: ResetCache();
522:
523: // 7. TC:E、TTn:E をクリア
524: ResetMMU();
525:
526: // ところでたぶん FPU もリセットされるはず?
527: ResetFPU(true);
528:
529: // 8. リセットベクタ生成
530: // 9. SP をロード
531: // 10. PC をロード
532: try {
533: reg.pc = 0;
534: reg.A[7] = fetch_4();
535: uint32 pc = fetch_4();
536: // 大丈夫のはずだけど fetch_4() が reg.pc を書き換えるので一応
537: reg.pc = pc;
538: // リセットベクタは常に 0, 4 番地から取得したことになっている
539: uint32 inst = BranchHistory_m680x0::VectorJump;
540: brhist.AddEntry(0x00000004 | 1, reg.pc, inst);
541: } catch (uint) {
542: DoubleBusFault("reset exception");
543: }
544:
545: // SP のアドレスエラーはリセット例外ではチェックしないようだ。
546: // PC のアドレスエラーは本来ならここにあるはずの3ワードのプリフェッチで
547: // 行われるのだが、それがないので、とりあえずここで。
548: if ((reg.pc & 1) != 0) {
549: DoubleBusFault("reset exception");
550: }
551:
552: return used_cycle - cycle_start;
553: }
554:
555: // 汎用の例外処理を行う。vector はベクタ番号。
556: // ただし以下の例外はここではなくそれぞれ固有のを呼ぶこと。
557: // o リセット例外は ExceptionReset()
558: // o 割り込み例外は ExceptionInterrupt()
559: // o TRAP#15 例外は ExceptionTrap15()
560: // o バスエラー・アドレスエラーは ExceptionBuserr()
561: void
562: MPU680x0Device::Exception(uint vector)
563: {
564: uint32 inst = BranchHistory_m680x0::Exception | vector;
565: ExceptionGeneric(vector, inst);
566: }
567:
568: // TRAP #15 の例外処理を行う。
569: // 処理自体は汎用の Exception() とまったく同じだが、
570: // IOCS コールの時には分岐履歴の出力が変わるため入口を分けてある。
571: void
572: MPU680x0Device::ExceptionTrap15()
573: {
574: // 今発生した TRAP #15 が IOCS コールっぽいかどうか調べる。
575: //
576: // Human68k 方面をやってる時は TRAP #15 は IOCS コールで表示してほしい。
577: // 一方、NetBSD のカーネル内では TRAP #15 は IOCS コールではない別用途
578: // なので IOCS コールかのように表示されるのは紛らわしい。さらに言えば
579: // NetBSD でもブートローダの時点はまだ IOCS コールを使うので、出来れば
580: // 今呼ばれたこれが IOCS コールなのか、そうでない TRAP #15 なのかは
581: // 区別したい。
582: //
583: // IOCS コールかどうかは厳密には分からないが、これが呼ばれた時点で
584: // ワークエリアの $cbc == 0x03、$cbe == 0xff であれば IOCS コールと
585: // 判定することにする。
586: // $cbc は MPU 種別で 3:68030。
587: // $cbe は MMU 有無で 0xff:有り。
588: // 今の所 68030/MMU有り しかサポートしていないので。
589: // だめならまた考える。
590:
591: const uint vector = M68K::EXCEP_TRAP15;
592: uint32 inst;
593: if (mainbus->Peek1(0xcbc) == 0x03 && mainbus->Peek1(0xcbe) == 0xff) {
594: // IOCS コールっぽい
595: inst = BranchHistory_m680x0::IOCSCall | (reg.D[0] & 0xff);
596: } else {
597: // TRAP#15 っぽい
598: inst = BranchHistory_m680x0::Exception | vector;
599: }
600: ExceptionGeneric(vector, inst);
601: }
602:
603: // 汎用の例外処理本体。
604: // ext_vector は下位8ビットがベクタ番号、
605: // 8ビット目が %1 なら浮動小数点未実装命令例外 (vector は F ライン)。
606: void
607: MPU680x0Device::ExceptionGeneric(uint ext_vector, uint32 inst)
608: {
609: uint vector = ext_vector & 0xff;
610:
611: // 例外履歴に記録 (例外発生はブランチ履歴にも記録)
612: excep_counter[vector]++;
613: uint32 from = ppc | (IsSuper() ? 1 : 0);
614: exhist.AddEntry(from, 0, inst);
615: brhist.AddEntry(from, 0, inst);
616: // デバッガに通知 (例外ブレーク用)
617: debugger->NotifyExceptionMain(vector);
618:
619: // 状態を保存
620: uint16 sr = GetSR();
621:
622: // S を立てて T1,T0 を落とす
623: SetSR((GetSR() | M68K::SR_S) & ~M68K::SR_T);
624:
625: try {
626: switch (ext_vector) {
627: case M68K::EXCEP_ILLEGAL: // 不当命令
628: case M68K::EXCEP_PRIV: // 特権違反例外
629: case M68K::EXCEP_ALINE: // Aライン命令例外
630: case M68K::EXCEP_FLINE: // Fライン命令例外
631: case M68K::EXCEP_FORMAT: // フォーマットエラー例外
632: // スタックに積む PC はこの命令のアドレス
633: GenerateExframe0(vector, sr, ppc);
634: break;
635:
636: case M68K::EXCEP_TRAP0 // TRAP#0
637: ... M68K::EXCEP_TRAP15: // TRAP#15
638: // スタックに積む PC は次の命令
639: GenerateExframe0(vector, sr, reg.pc);
640: break;
641:
642: case M68K::EXCEP_ZERODIV: // ゼロ除算
643: case M68K::EXCEP_CHK: // CHK
644: case M68K::EXCEP_TRAPV: // TRAPV
645: case M68K::EXCEP_MMU_CONFIG: // MMU 構成例外
646: GenerateExframe2(vector, sr, reg.pc, ppc);
647: break;
648:
649: case M68K::EXCEP_FP_UNIMPL: // 68040 の浮動小数点未実装命令例外
650: case M68K::EXCEP_FP_UNSUPP: // 68040 の FPU 未実装データ型例外
651: // スタックに積む PC は次の命令、ADDRESS は計算した EA。
652: GenerateExframe2(vector, sr, reg.pc, fpu40.ea);
653: break;
654:
655: default:
656: PANIC("$%08x exception vector %u ?", ppc, vector);
657: break;
658: }
659:
660: // ベクタにジャンプ
661: JumpVector(vector, false);
662: } catch (uint vector2) {
663: assertmsg(vector2 == M68K::EXCEP_BUSERR, "vector=%u", vector);
664:
665: // バスエラー処理へ
666: ExceptionBuserr(vector2);
667: }
668: }
669:
670: // バスエラー・アドレスエラー例外処理を行う。
671: // 他の例外とは違いが多いので分けた。
672: void
673: MPU680x0Device::ExceptionBuserr(uint vector)
674: {
675: assertmsg((vector == M68K::EXCEP_BUSERR || vector == M68K::EXCEP_ADDRERR),
676: "vector=%u", vector);
677:
678: // 例外履歴に記録 (例外発生はブランチ履歴にも記録)
679: excep_counter[vector]++;
680: uint32 from = ppc | (IsSuper() ? 1 : 0);
681: uint32 inst = BranchHistory_m680x0::Exception | vector;
682: exhist.AddEntry(from, 0, inst);
683: brhist.AddEntry(from, 0, inst);
684: // デバッガに通知 (例外ブレーク用)
685: debugger->NotifyExceptionMain(vector);
686:
687: // 状態を保存
688: uint16 sr = GetSR();
689:
690: if (mpu_type == m680x0MPUType::M68030) {
691: // 68030 なら、
692: // ここで (An)+ で変化したレジスタを命令実行前の状態に巻き戻す。
693: // EA 処理の時点で先にインクリメントしているのだが、バスエラーが
694: // 起きたということは実際にはポストインクリメントは発生しないので、
695: // ここで無条件に巻き戻してよい。SR を書き換えると A7 が切り替わって
696: // しまうので、この巻き戻しは SR を書き換える前のここで行うこと。
697: // 一方、プリデクリメントのケースはこの少し上の ExframeB の中の
698: // コメント参照。
699: restore_reg_pi();
700: } else {
701: // 68040 なら、
702: // (An)+, -(An) どちらも命令実行前の状態に巻き戻す。
703: // 少し上の frame7 の中のコメントも参照。
704: restore_reg_pi();
705: restore_reg_pd();
706: }
707:
708: // S を立てて T1,T0 を落とす
709: SetSR((GetSR() | M68K::SR_S) & ~M68K::SR_T);
710:
711: try {
712: // フレームを作成。
713: if (mpu_type == m680x0MPUType::M68030) {
714: // 実際はショート($A)、ロング($B)の2種類あって、本来ならショートが
715: // 使えればショートを使うのだが、ここでは全部ロングを使う。
716: GenerateExframeB(vector, sr);
717: } else {
718: // 68040 ではバスエラーは $7、アドレスエラーは $2 を使う。
719: if (__predict_true(vector == M68K::EXCEP_BUSERR)) {
720: GenerateExframe7(vector, sr);
721: } else {
722: uint32 fault_addr = bus.laddr.Addr();
723: GenerateExframe2(vector, sr, ppc, fault_addr - 1);
724: }
725: }
726: // ベクタにジャンプ
727: JumpVector(vector, true);
728: } catch (uint vector2) {
729: // ここに来るのはバスエラーかアドレスエラーだけのはず
730: assertmsg(vector2 == M68K::EXCEP_BUSERR ||
731: vector2 == M68K::EXCEP_ADDRERR, "vector=%u", vector);
732:
733: // バスエラー・アドレスエラー処理中のバスエラーは
734: // ダブルバスフォールト。
735: DoubleBusFault("bus/address error handling");
736: }
737: }
738:
739: // 割り込み例外処理を行う。
740: // 割り込みの受け付けとレベルのチェック等の後、次命令境界で呼ばれるやつ。
741: // この処理にかかる時間 [nsec] を返す。
742: uint64
743: MPU680x0Device::ExceptionInterrupt()
744: {
745: uint64 cycle_start = used_cycle;
746: uint level = intr_level;
747:
748: // ユーザーズマニュアル(日本語) p.399 図8-5 の中ほど
749: // 「/IPEND をネゲート、割り込みアクノリッジサイクルを実行」
750: // 以降に相当。
751:
752: // STOP なら解除
753: ChangeState(CPU_STATE_NORMAL);
754:
755: // 割り込みアクノリッジサイクルを実行
756: uint32 vector;
757: busdata bd = interruptdev->InterruptAcknowledge(level);
758: if (__predict_false(bd.IsBusErr())) {
759: // 外部回路がバスエラーを返すと Spurious を発行する。(7.4.1.3)
760: vector = M68K::EXCEP_SPURIOUS;
761: } else {
762: vector = bd.Data();
763: if ((int32)vector < 0) {
764: // オートベクタ要求 (7.4.1.2)
765: // (負数(-1)ならオートベクタということにしている)
766: vector = M68K::EXCEP_LEVEL_BASE + level;
767: }
768: }
769:
770: // 例外履歴に記録 (例外発生はブランチ履歴にも記録)
771: excep_counter[vector]++;
772: uint32 from = ppc | (IsSuper() ? 1 : 0);
773: uint32 inst = BranchHistory_m680x0::Exception | vector;
774: exhist.AddEntry(from, 0, inst);
775: brhist.AddEntry(from, 0, inst);
776: // デバッガに通知 (例外ブレーク用)
777: debugger->NotifyExceptionMain(vector);
778:
779: // 状態を保存
780: uint16 oldsr = GetSR();
781:
782: // S を立てて T1,T0 を落とす。割り込みレベルも変更。
783: uint16 newsr = GetSR() & ~(M68K::SR_T | M68K::SR_IMASK);
784: newsr |= M68K::SR_S;
785: newsr |= level << 8;
786: SetSR(newsr);
787:
788: try {
789: // 例外スタックフレーム $0 を生成。
790: // スタックに積む PC は次の命令位置。
791: // M ビットは未実装なのでスローアウェイとか無視
792: GenerateExframe0(vector, oldsr, reg.pc);
793:
794: // ベクタにジャンプ
795: JumpVector(vector, false);
796: } catch (uint vector2) {
797: assertmsg(vector2 == M68K::EXCEP_BUSERR, "vector=%u", vector);
798:
799: // バスエラー処理へ
800: ExceptionBuserr(vector2);
801: }
802:
803: return (used_cycle - cycle_start) * clock_nsec + bd.GetWait();
804: }
805:
1.1.1.2 ! root 806: // LC040 の未実装浮動小数点命令例外。
! 807: void
! 808: MPU680x0Device::ExceptionFPLC(uint32 ea)
! 809: {
! 810: const uint vector = M68K::EXCEP_FLINE;
! 811: const uint32 inst = BranchHistory_m680x0::Exception | vector;
! 812:
! 813: // 例外履歴に記録 (例外発生はブランチ履歴にも記録)
! 814: excep_counter[vector]++;
! 815: uint32 from = ppc | (IsSuper() ? 1 : 0);
! 816: exhist.AddEntry(from, 0, inst);
! 817: brhist.AddEntry(from, 0, inst);
! 818: // デバッガに通知 (例外ブレーク用)
! 819: debugger->NotifyExceptionMain(vector);
! 820:
! 821: // 状態を保存
! 822: uint16 sr = GetSR();
! 823:
! 824: // S を立てて T1,T0 を落とす
! 825: SetSR((GetSR() | M68K::SR_S) & ~M68K::SR_T);
! 826:
! 827: try {
! 828: GenerateExframe4(vector, sr, ea);
! 829:
! 830: // ベクタにジャンプ
! 831: JumpVector(vector, false);
! 832: } catch (uint vector2) {
! 833: assertmsg(vector2 == M68K::EXCEP_BUSERR, "vector=%u", vector);
! 834:
! 835: // バスエラー処理へ
! 836: ExceptionBuserr(vector2);
! 837: }
! 838: }
! 839:
1.1 root 840: // RTE 命令。
841: // 例外処理の近くに置いておくほうが便利なので。
842: void
843: MPU680x0Device::ops_rte()
844: {
845: uint32 pc;
846: uint16 sr;
847: uint16 frame;
848: uint32 type;
849:
850: try {
851: sr = pop_2();
852: pc = pop_4();
853: frame = pop_2();
854: type = frame >> 12;
855: switch (type) {
856: case 0:
857: CYCLE2(18, 20);
858: SetSR(sr);
859: Jump(pc);
860: break;
861:
862: case 2:
863: CYCLE2(18, 20);
864: // +08.L (INSTRUCTION) ADDRESS を読み捨てる。
865: reg.A[7] += 4;
866: SetSR(sr);
867: Jump(pc);
868: break;
869:
1.1.1.2 ! root 870: case 0x04:
! 871: {
! 872: // 68LC040 only
! 873: if (GetFPUType().Is4060LC() == false) {
! 874: Exception(M68K::EXCEP_FORMAT);
! 875: return;
! 876: }
! 877: reg.A[7] += 8;
! 878: SetSR(sr);
! 879: Jump(pc);
! 880: break;
! 881: }
! 882:
1.1 root 883: case 0x07:
884: {
885: // 68040 only
886: if (mpu_type != m680x0MPUType::M68040) {
887: Exception(M68K::EXCEP_FORMAT);
888: return;
889: }
890: uint16 ssw;
891: reg.A[7] += 4;
892: ssw = pop_2();
893: putlog(2, "RTE (Frame7): SSW=$%04x", ssw);
894: reg.A[7] += 46;
895: SetSR(sr);
896: Jump(pc);
897: break;
898: }
899:
900: case 0x0b:
901: {
902: // 68030 only
903: if (mpu_type != m680x0MPUType::M68030) {
904: Exception(M68K::EXCEP_FORMAT);
905: return;
906: }
907:
908: uint32 stage_b;
909: uint16 ssw;
910:
911: CYCLE(76);
912: reg.A[7] += 2; // $08.W
913: ssw = pop_2(); // $0a.W SSW
914: reg.A[7] += 4 * 6; // $0c.L*6
915: stage_b = pop_4(); // $24.L Stage B
916: reg.A[7] += 2 * 9; // $28.W*9
917: // $3a..$58 ここが save_pd の取り出し
918: flag_pd = pop_2();
919: for (int i = 0; i < 8; i++) {
920: save_pd[i] = pop_4();
921: }
922: // A7 レジスタをリストアするかもしれない前に Super/User を
923: // 復帰しておかないといけない。
924: SetSR(sr);
925:
926: // DFビットセットなら命令を再実行するため、-(An) で変化
927: // したレジスタを巻き戻す。
928: // DFビットクリアなら例外要因の命令はハンドラで処理された
929: // とみなして、次の命令に進む。
930: if ((ssw & M68030::SSW_DF)) {
931: restore_reg_pd();
932: } else {
933: pc = stage_b - 2;
934: }
935: Jump(pc);
936: break;
937: }
938:
939: default:
940: if (mpu_type == m680x0MPUType::M68030) {
941: switch (type) {
942: case 0x01:
943: case 0x08:
944: case 0x09:
945: case 0x0a:
946: // CPU は本来対応しているが、
947: // エミュレータが対応していない (遭遇しないはず)。
948: VMPANIC("RTE frame=$%x not supported", type);
949: default:
950: break;
951: }
952: } else /* 68040 */ {
953: switch (type) {
954: case 0x01:
955: case 0x03:
956: // CPU は本来対応しているが、
957: // エミュレータが対応していない (遭遇しないはず)。
958: VMPANIC("RTE frame=$%x not supported", type);
959: default:
960: break;
961: }
962: }
963: // CPU が対応していないフレームタイプはフォーマットエラー例外。
964: Exception(M68K::EXCEP_FORMAT);
965: break;
966: }
967: } catch (uint vector2) {
968: assertmsg(vector2 == M68K::EXCEP_BUSERR, "vector2=%u", vector2);
969:
970: // RTE 処理中のバスエラーはダブルバスフォールト。
971: DoubleBusFault("bus/address error handling");
972: }
973: }
974:
975: // STOP 命令。
976: void
977: MPU680x0Device::ops_stop()
978: {
979: uint32 data = fetch_2();
980: SetSR(data);
981: ChangeState(CPU_STATE_STOP);
982:
983: MakeNextFull();
984: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.