--- nono/m680x0/m68030subr.cpp 2026/04/29 17:04:44 1.1.1.5 +++ nono/m680x0/m68030subr.cpp 2026/04/29 17:04:52 1.1.1.8 @@ -8,16 +8,15 @@ #include "m68030bus.h" #include "m68030fpu.h" #include "debugger.h" +#include "scheduler.h" -static void m68030_update_vtime(m68kcpu *cpu); static void m68030_change_intr(m68kcpu *, int); static void m68030_set_intr(m68kcpu *, int); static void m68030_double_bus_fault(m68kcpu *, const char *); // CPU コアの領域を確保して初期化 -// reset_vector はリセット例外時に 0 番地に見せる(通常ROMの)アドレス。 m68kcpu * -m68030_init(uint32 reset_vector) +m68030_init() { m68kcpu *cpu; @@ -31,33 +30,39 @@ m68030_init(uint32 reset_vector) // あるため、A6 を概ね RAM のあるあたりに指定しておく…。 RegA(6) = 0x000ccccc; - // 手抜きのためリセットベクタを知っている - cpu->reset_vector = reset_vector; - return cpu; } -// 仕掛中のサイクルを仮想時刻に反映させる。 -void -m68030_update_vtime(m68kcpu *cpu) -{ - if (cpu->used_cycle > cpu->goal_cycle) { - cpu->goal_cycle = cpu->used_cycle; - } else { - cpu->goal_cycle -= cpu->used_cycle; - } - cpu->total_vtime += cpu->Cycle2Vtime(cpu->used_cycle); - cpu->used_cycle = 0; -} - // 仮想時刻を返す uint64 m68030_get_vtime(m68kcpu *cpu) { - if (cpu->used_cycle != 0) { - m68030_update_vtime(cpu); + return cpu->total_vtime + cpu->Cycle2Vtime(cpu->used_cycle); +} + +// クロックを設定する。 +void +m68030_set_clockspeed(m68kcpu *cpu, uint32 clock_khz_) +{ + cpu->clock_khz = clock_khz_; + + // サイクル数を nsec に変換する際の係数。25MHz なら c2v は 40 [nsec/clock] + cpu->c2v = 1000 * 1000 / cpu->clock_khz; + + // nsec をクロック数に変換する際の係数、つまり c2v の逆数。 + // (http://hp.vector.co.jp/authors/VA003988/how_to_o.htm#27_2) + int b = 32 - __builtin_clz(cpu->c2v) - 1; + int r = 32 + b; + // 小数部を近接丸め(0捨1入)するため一桁余分に計算しておいて.. + uint64 f = (1ULL << (r + 1)) / cpu->c2v; + // 最下位ビットを丸める + if ((f & 1) != 0) { + f += 1; } - return cpu->total_vtime; + f >>= 1; + + cpu->v2c_factor = f; + cpu->v2c_shift = r; } // 二重バスフォールト @@ -72,6 +77,19 @@ m68030_double_bus_fault(m68kcpu *cpu, co } } +// 電源オン +void +m68030_power_on(m68kcpu *cpu) +{ + // 履歴を初期化。電源(再)投入時のみ行う。 + cpu->exhist.Clear(); + cpu->brhist.Clear(); + + // この後起きるリセット例外で PC を初期化する前に参照することになるので + // これだけここでも初期化しておく。 + RegPC = 0; +} + // リセット例外を発生させる。(外部ルーチン) void m68030_request_reset_exception(m68kcpu *cpu) @@ -85,16 +103,13 @@ m68030_request_reset_exception(m68kcpu * void m68030_exception_reset(m68kcpu *cpu) { - // 履歴を初期化。リセット前の履歴いらんよな? - cpu->exhist.Clear(); - cpu->brhist.Clear(); - // 例外履歴に記録 (例外発生はブランチ履歴にも記録) - // リセット例外発生時の PC にはあまり意味がないので 0 にするか。 + // m68k では今の所リセット例外発生時の PC にはあまり意味がないけど、 + // m88k と動作を揃えておく。 // 履歴のリセットベクタは 0 の代わりに 1 を使う仕様になっている。 const uint vector = 0; - cpu->exhist.AddEntry(0 | 1, 0, 0x8000 | (vector + 1)); - cpu->brhist.AddEntry(0 | 1, 0, 0x8000 | (vector + 1)); + cpu->exhist.AddEntry(RegPC | 1, 0, 0x8000 | (vector + 1)); + cpu->brhist.AddEntry(RegPC | 1, 0, 0x8000 | (vector + 1)); // デバッガに通知 (例外ブレーク用)。こっちのベクタは 0 のままでよい。 debugger_notify_exception(vector); @@ -102,9 +117,11 @@ m68030_exception_reset(m68kcpu *cpu) // 2. S をセット、M をクリア // 3. 割り込みレベルを 7 - // 受け付け中だった割り込みをクリア + // 受け付け中だった割り込みをクリア。 + // STOP 状態とホールト状態を解除。 cpu->intr_pending = 0; - cpu->atomic_reqflag &= ~CPU_REQ_INTR; + cpu->atomic_reqflag &= ~(CPU_REQ_INTR | CPU_REQ_STOP | CPU_REQ_HALT); + cpu->reg.state = Scheduler::SCHED_CPU_NORMAL; // ここは set_sr を使わずに設定する。 cpu->reg.s = true; @@ -128,14 +145,12 @@ m68030_exception_reset(m68kcpu *cpu) // 10. PC をロード // 手抜き。 - // XXX 本当は ROM を 0番地に見せかけてから 0番地からロードするのだが - // ぶっちゃけそれを外部から観測する手段もないのでなー。 // XXX FC を気にしないといけない // XXX 読めなければ二重バスフォールト // 本当はアドレスエラーもチェックするのだが、起きないので省略。 try { - RegA(7) = m68030_read_32(cpu, cpu->reset_vector); - RegPC = m68030_read_32(cpu, cpu->reset_vector + 4); + RegA(7) = m68030_read_32(cpu, 0); + RegPC = m68030_read_32(cpu, 4); // リセットベクタは常に 0, 4 番地から取得したことになっている cpu->brhist.AddEntry(0x00000004 | 1, RegPC, 0x8000); } catch (int) {