tilem-2.0/emu/z80.c

/*
 * libtilemcore - Graphing calculator emulation library
 *
 * Copyright (C) 2009-2011 Benjamin Moody
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public License
 * as published by the Free Software Foundation; either version 2.1 of
 * the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, see
 * <http://www.gnu.org/licenses/>.
 */

#ifdef HAVE_CONFIG_H
# include <config.h>
#endif

#include <stdio.h>
#include <stdlib.h>
#include "tilem.h"
#include "z80.h"

/* Timer manipulation */

/*
static void dumptimers(TilemZ80* z80)
{
	int tmr;
	int t;

	printf("*** RT:");
	for (tmr = z80->timer_rt; tmr; tmr = z80->timers[tmr].next) {
		t = z80->timers[tmr].count - z80->clock;
		printf(" %d:%d", tmr, t);
	}
	printf("\n*** CPU:");
	for (tmr = z80->timer_cpu; tmr; tmr = z80->timers[tmr].next) {
		t = z80->timers[tmr].count - z80->clock;
		printf(" %d:%d", tmr, t);
	}
	printf("\n*** Free:");
	for (tmr = z80->timer_free; tmr; tmr = z80->timers[tmr].next) {
		printf(" %d", tmr);
	}
	printf("\n");
}
*/

static inline void timer_free(TilemZ80* z80, int tmr)
{
	z80->timers[tmr].callback = NULL;
	z80->timers[tmr].callbackdata = NULL;
	z80->timers[tmr].next = z80->timer_free;
	z80->timers[tmr].prev = 0;
	z80->timer_free = tmr;
}

static inline int timer_alloc(TilemZ80* z80)
{
	int tmr, i;

	if (z80->timer_free) {
		tmr = z80->timer_free;
		z80->timer_free = z80->timers[tmr].next;
		z80->timers[tmr].next = 0;
		return tmr;
	}

	i = z80->ntimers;
	z80->ntimers = i * 2 + 1;
	z80->timers = tilem_renew(TilemZ80Timer, z80->timers, z80->ntimers);
	while (i < z80->ntimers) {
		timer_free(z80, i);
		i++;
	}

	tmr = z80->timer_free;
	z80->timer_free = z80->timers[tmr].next;
	z80->timers[tmr].next = 0;
	return tmr;
}

static inline int timer_earlier(TilemZ80* z80, int tmr1, int tmr2)
{
	dword count1, count2;

	count1 = z80->timers[tmr1].count + 10000 - z80->clock;
	count2 = z80->timers[tmr2].count + 10000 - z80->clock;

	return (count1 < count2);
}

static inline void timer_insert(TilemZ80* z80, int* list, int tmr)
{
	int prev, next;

	if (!*list || timer_earlier(z80, tmr, *list)) {
		z80->timers[tmr].prev = 0;
		z80->timers[tmr].next = *list;
		z80->timers[*list].prev = tmr;
		*list = tmr;
		return;
	}

	prev = *list;
	next = z80->timers[prev].next;

	while (next && timer_earlier(z80, next, tmr)) {
		prev = next;
		next = z80->timers[prev].next;
	}

	z80->timers[prev].next = tmr;
	z80->timers[next].prev = tmr;
	z80->timers[tmr].prev = prev;
	z80->timers[tmr].next = next;
}

static inline void timer_set(TilemZ80* z80, int tmr, dword count,
			     dword period, int rt, dword extra)
{
	dword clocks;
	qword kclocks;

	if (!count) {
		/* leave timer disabled */
		z80->timers[tmr].prev = 0;
		z80->timers[tmr].next = 0;
	}
	else if (rt) {
		kclocks = z80->clockspeed;
		kclocks *= count;
		clocks = (kclocks + 500) / 1000 - extra;
		z80->timers[tmr].count = z80->clock + clocks;
		z80->timers[tmr].period = period;
		timer_insert(z80, &z80->timer_rt, tmr);
	}
	else {
		clocks = count - extra;
		z80->timers[tmr].count = z80->clock + clocks;
		z80->timers[tmr].period = period;
		timer_insert(z80, &z80->timer_cpu, tmr);
	}
}

static inline void timer_unset(TilemZ80* z80, int tmr)
{
	int prev, next;

	if (tmr == z80->timer_cpu)
		z80->timer_cpu = z80->timers[tmr].next;
	if (tmr == z80->timer_rt)
		z80->timer_rt = z80->timers[tmr].next;

	prev = z80->timers[tmr].prev;
	next = z80->timers[tmr].next;
	z80->timers[prev].next = next;
	z80->timers[next].prev = prev;
	z80->timers[tmr].prev = 0;
	z80->timers[tmr].next = 0;
}


/* Breakpoint manipulation */

static inline void bp_free(TilemZ80* z80, int bp)
{
	z80->breakpoints[bp].type = 0;
	z80->breakpoints[bp].testfunc = NULL;
	z80->breakpoints[bp].testdata = NULL;
	z80->breakpoints[bp].next = z80->breakpoint_free;
	z80->breakpoints[bp].prev = 0;
	z80->breakpoint_free = bp;
}

static inline int bp_alloc(TilemZ80* z80)
{
	int bp, i;

	if (z80->breakpoint_free) {
		bp = z80->breakpoint_free;
		z80->breakpoint_free = z80->breakpoints[bp].next;
		return bp;
	}

	i = z80->nbreakpoints;
	z80->nbreakpoints = i * 2 + 2;
	z80->breakpoints = tilem_renew(TilemZ80Breakpoint, z80->breakpoints,
				       z80->nbreakpoints);
	while (i < z80->nbreakpoints) {
		bp_free(z80, i);
		i++;
	}

	bp = z80->breakpoint_free;
	z80->breakpoint_free = z80->breakpoints[bp].next;
	return bp;
}

static int* bp_head(TilemCalc *calc, int type)
{
	if (type & TILEM_BREAK_DISABLED)
		return &calc->z80.breakpoint_disabled;

	switch (type & TILEM_BREAK_TYPE_MASK) {
	case TILEM_BREAK_MEM_READ:
		return (type & TILEM_BREAK_PHYSICAL
			? &calc->z80.breakpoint_mpr
			: &calc->z80.breakpoint_mr);

	case TILEM_BREAK_MEM_EXEC:
		return (type & TILEM_BREAK_PHYSICAL
			? &calc->z80.breakpoint_mpx
			: &calc->z80.breakpoint_mx);

	case TILEM_BREAK_MEM_WRITE:
		return (type & TILEM_BREAK_PHYSICAL
			? &calc->z80.breakpoint_mpw
			: &calc->z80.breakpoint_mw);

	case TILEM_BREAK_PORT_READ:
		return &calc->z80.breakpoint_pr;

	case TILEM_BREAK_PORT_WRITE:
		return &calc->z80.breakpoint_pw;

	case TILEM_BREAK_EXECUTE:
		return &calc->z80.breakpoint_op;

	default:
		tilem_internal(calc, "invalid bp type");
		return 0;
	}
}

static int bp_add(TilemCalc *calc, int bp, int type)
{
	int *head = bp_head(calc, type);

	if (!head) {
		bp_free(&calc->z80, bp);
		return 0;
	}

	calc->z80.breakpoints[bp].next = *head;
	calc->z80.breakpoints[*head].prev = *head ? bp : 0;
	*head = bp;

	return bp;
}

static void bp_rem(TilemCalc *calc, int bp, int type)
{
	int prev, next;
	int *head = bp_head(calc, type);

	prev = calc->z80.breakpoints[bp].prev;
	next = calc->z80.breakpoints[bp].next;

	if (bp == *head)
		*head = next;

	calc->z80.breakpoints[prev].next = prev ? next : 0;
	calc->z80.breakpoints[next].prev = next ? prev : 0;
}

static void invoke_ptimer(TilemCalc* calc, void* data)
{
	(*calc->hw.z80_ptimer)(calc, TILEM_PTR_TO_DWORD(data));
}

/* Z80 API */

void tilem_z80_reset(TilemCalc* calc)
{
	int i;

	AF = BC = DE = HL = AF2 = BC2 = DE2 = HL2 = 0xffff;
	IX = IY = IR = SP = WZ = WZ2 = 0xffff;
	PC = 0;
	Rh = 0x80;
	IFF1 = IFF2 = IM = 0;
	calc->z80.interrupts = 0;
	calc->z80.halted = 0;

	/* Set up hardware timers */
	if (!calc->z80.ntimers) {
		calc->z80.ntimers = (calc->hw.nhwtimers
				+ TILEM_NUM_SYS_TIMERS + 1);
		tilem_free(calc->z80.timers);
		calc->z80.timers = tilem_new(TilemZ80Timer, calc->z80.ntimers);

		for (i = 1; i < calc->z80.ntimers; i++) {
			calc->z80.timers[i].next = 0;
			calc->z80.timers[i].prev = 0;
			calc->z80.timers[i].count = 0;
			calc->z80.timers[i].period = 0;
			calc->z80.timers[i].callback = &invoke_ptimer;
			calc->z80.timers[i].callbackdata = TILEM_DWORD_TO_PTR(i);
		}

		calc->z80.timers[TILEM_TIMER_LCD_DELAY].callback
			= &tilem_lcd_delay_timer;
		calc->z80.timers[TILEM_TIMER_FLASH_DELAY].callback
			= tilem_flash_delay_timer;
		calc->z80.timers[TILEM_TIMER_LINK_ASSIST].callback
			= tilem_linkport_assist_timer;

		for (i = 0; i < TILEM_MAX_USER_TIMERS; i++) {
			calc->z80.timers[TILEM_TIMER_USER1 + i].callback
				= tilem_user_timer_expired;
			calc->z80.timers[TILEM_TIMER_USER1 + i].callbackdata
				= TILEM_DWORD_TO_PTR(i);
		}
	}
}

void tilem_z80_stop(TilemCalc* calc, dword reason)
{
	if (!(reason & calc->z80.stop_mask)) {
		calc->z80.stop_reason |= reason;
		calc->z80.stopping = 1;
	}
}

void tilem_z80_exception(TilemCalc* calc, unsigned type)
{
	calc->z80.exception |= type;
}

void tilem_z80_set_speed(TilemCalc* calc, int speed)
{
	int tmr;
	qword t;
	int oldspeed = calc->z80.clockspeed;

	if (oldspeed == speed)
		return;

	for (tmr = calc->z80.timer_rt; tmr; tmr = calc->z80.timers[tmr].next) {
		if ((calc->z80.clock - calc->z80.timers[tmr].count) < 10000)
			continue;

		t = calc->z80.timers[tmr].count - calc->z80.clock;
		t = (t * speed + oldspeed / 2) / oldspeed;
		calc->z80.timers[tmr].count = calc->z80.clock + t;
	}

	calc->z80.clockspeed = speed;
}

int tilem_z80_add_timer(TilemCalc* calc, dword count, dword period,
			int rt, TilemZ80TimerFunc func, void* data)
{
	int id;

	id = timer_alloc(&calc->z80);
	calc->z80.timers[id].callback = func;
	calc->z80.timers[id].callbackdata = data;
	timer_set(&calc->z80, id, count, period, rt, 0);
	return id;
}

void tilem_z80_set_timer(TilemCalc* calc, int id, dword count,
			 dword period, int rt)
{
	if (id < 1 || id > calc->z80.ntimers
	    || !calc->z80.timers[id].callback) {
		tilem_internal(calc, "setting invalid timer %d", id);
		return;
	}
	timer_unset(&calc->z80, id);
	timer_set(&calc->z80, id, count, period, rt, 0);
}

void tilem_z80_set_timer_period(TilemCalc* calc, int id, dword period)
{
	if (id < 1 || id > calc->z80.ntimers
	    || !calc->z80.timers[id].callback) {
		tilem_internal(calc, "setting invalid timer %d", id);
		return;
	}

	calc->z80.timers[id].period = period;
}

void tilem_z80_remove_timer(TilemCalc* calc, int id)
{
	if (id <= calc->hw.nhwtimers + TILEM_NUM_SYS_TIMERS
	    || id > calc->z80.ntimers || !calc->z80.timers[id].callback) {
		tilem_internal(calc, "removing invalid timer %d", id);
		return;
	}
	timer_unset(&calc->z80, id);
	timer_free(&calc->z80, id);
}

int tilem_z80_timer_running(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.ntimers
	    || !calc->z80.timers[id].callback) {
		tilem_internal(calc, "querying invalid timer %d", id);
		return 0;
	}

	if (id == calc->z80.timer_rt || id == calc->z80.timer_cpu)
		return 1;
	if (calc->z80.timers[id].prev)
		return 1;
	return 0;
}

int tilem_z80_get_timer_clocks(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.ntimers
	    || !calc->z80.timers[id].callback) {
		tilem_internal(calc, "querying invalid timer %d", id);
		return 0;
	}
	return (calc->z80.timers[id].count - calc->z80.clock);
}

int tilem_z80_get_timer_microseconds(TilemCalc* calc, int id)
{
	int n = tilem_z80_get_timer_clocks(calc, id);

	if (n < 0) {
		n = ((((qword) -n * 1000) + (calc->z80.clockspeed / 2))
		     / calc->z80.clockspeed);
		return -n;
	}
	else {
		n = ((((qword) n * 1000) + (calc->z80.clockspeed / 2))
		     / calc->z80.clockspeed);
		return n;
	}
}

int tilem_z80_add_breakpoint(TilemCalc* calc, int type,
			     dword start, dword end, dword mask,
			     TilemZ80BreakpointFunc func,
			     void* data)
{
	int bp;

	bp = bp_alloc(&calc->z80);

	calc->z80.breakpoints[bp].type = type;
	calc->z80.breakpoints[bp].start = start;
	calc->z80.breakpoints[bp].end = end;
	calc->z80.breakpoints[bp].mask = mask;
	calc->z80.breakpoints[bp].testfunc = func;
	calc->z80.breakpoints[bp].testdata = data;
	calc->z80.breakpoints[bp].prev = 0;

	return bp_add(calc, bp, type);
}

void tilem_z80_remove_breakpoint(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to remove invalid breakpoint %d", id);
		return;
	}

	bp_rem(calc, id, calc->z80.breakpoints[id].type);

	bp_free(&calc->z80, id);
}

void tilem_z80_enable_breakpoint(TilemCalc* calc, int id)
{
	int type = tilem_z80_get_breakpoint_type(calc, id);
	tilem_z80_set_breakpoint_type(calc, id, type & ~TILEM_BREAK_DISABLED);
}

void tilem_z80_disable_breakpoint(TilemCalc* calc, int id)
{
	int type = tilem_z80_get_breakpoint_type(calc, id);
	tilem_z80_set_breakpoint_type(calc, id, type | TILEM_BREAK_DISABLED);
}

int tilem_z80_breakpoint_enabled(TilemCalc* calc, int id)
{
	int type = tilem_z80_get_breakpoint_type(calc, id);
	return !(type & TILEM_BREAK_DISABLED);
}

int tilem_z80_get_breakpoint_type(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to access invalid breakpoint %d", id);
		return -1;
	}

	return calc->z80.breakpoints[id].type;
}

dword tilem_z80_get_breakpoint_address_start(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to access invalid breakpoint %d", id);
		return -1;
	}

	return calc->z80.breakpoints[id].start;
}

dword tilem_z80_get_breakpoint_address_end(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to access invalid breakpoint %d", id);
		return -1;
	}

	return calc->z80.breakpoints[id].end;
}

dword tilem_z80_get_breakpoint_address_mask(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to access invalid breakpoint %d", id);
		return -1;
	}

	return calc->z80.breakpoints[id].mask;
}

TilemZ80BreakpointFunc tilem_z80_get_breakpoint_callback(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to access invalid breakpoint %d", id);
		return 0;
	}

	return calc->z80.breakpoints[id].testfunc;
}

void* tilem_z80_get_breakpoint_data(TilemCalc* calc, int id)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to access invalid breakpoint %d", id);
		return 0;
	}

	return calc->z80.breakpoints[id].testdata;
}

void tilem_z80_set_breakpoint_type(TilemCalc* calc, int id, int type)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to modify invalid breakpoint %d", id);
		return;
	}

	if (type == calc->z80.breakpoints[id].type)
		return;

	bp_rem(calc, id, calc->z80.breakpoints[id].type);

	calc->z80.breakpoints[id].type = type;

	bp_add(calc, id, type);
}

void tilem_z80_set_breakpoint_address_start(TilemCalc* calc, int id, dword start)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to modify invalid breakpoint %d", id);
		return;
	}

	calc->z80.breakpoints[id].start = start;
}

void tilem_z80_set_breakpoint_address_end(TilemCalc* calc, int id, dword end)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to modify invalid breakpoint %d", id);
		return;
	}

	calc->z80.breakpoints[id].end = end;
}

void tilem_z80_set_breakpoint_address_mask(TilemCalc* calc, int id, dword mask)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to modify invalid breakpoint %d", id);
		return;
	}

	calc->z80.breakpoints[id].mask = mask;
}

void tilem_z80_set_breakpoint_callback(TilemCalc* calc, int id,
				       TilemZ80BreakpointFunc func)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to modify invalid breakpoint %d", id);
		return;
	}

	calc->z80.breakpoints[id].testfunc = func;
}

void tilem_z80_set_breakpoint_data(TilemCalc* calc, int id, void* data)
{
	if (id < 1 || id > calc->z80.nbreakpoints
	    || !calc->z80.breakpoints[id].type) {
		tilem_internal(calc,
			       "attempt to modify invalid breakpoint %d", id);
		return;
	}

	calc->z80.breakpoints[id].testdata = data;
}


static inline void check_timers(TilemCalc* calc)
{
	int tmr;
	dword t;
	TilemZ80TimerFunc callback;
	void* callbackdata;

	while (calc->z80.timer_cpu) {
		tmr = calc->z80.timer_cpu;
		t = calc->z80.clock - calc->z80.timers[tmr].count;
		if (t >= 10000)
			break;

		callback = calc->z80.timers[tmr].callback;
		callbackdata = calc->z80.timers[tmr].callbackdata;

		timer_unset(&calc->z80, tmr);
		timer_set(&calc->z80, tmr, calc->z80.timers[tmr].period,
			  calc->z80.timers[tmr].period, 0, t);

		(*callback)(calc, callbackdata);
	}

	while (calc->z80.timer_rt) {
		tmr = calc->z80.timer_rt;
		t = calc->z80.clock - calc->z80.timers[tmr].count;
		if (t >= 10000)
			break;

		callback = calc->z80.timers[tmr].callback;
		callbackdata = calc->z80.timers[tmr].callbackdata;

		timer_unset(&calc->z80, tmr);
		timer_set(&calc->z80, tmr, calc->z80.timers[tmr].period,
			  calc->z80.timers[tmr].period, 1, t);

		(*callback)(calc, callbackdata);
	}
}

static inline void check_breakpoints(TilemCalc* calc, int list, dword addr)
{
	dword masked;
	int bp;
	TilemZ80BreakpointFunc testfunc;
	void* testdata;

	for (bp = list; bp; bp = calc->z80.breakpoints[bp].next) {
		masked = addr & calc->z80.breakpoints[bp].mask;
		if (masked < calc->z80.breakpoints[bp].start
		    || masked > calc->z80.breakpoints[bp].end)
			continue;

		testfunc = calc->z80.breakpoints[bp].testfunc;
		testdata = calc->z80.breakpoints[bp].testdata;

		if (testfunc && !(*testfunc)(calc, addr, testdata))
			continue;

		calc->z80.stop_breakpoint = bp;
		tilem_z80_stop(calc, TILEM_STOP_BREAKPOINT);
	}
}

static inline void check_mem_breakpoints(TilemCalc* calc, int list_l,
					 int list_p, dword addr)
{
	check_breakpoints(calc, list_l, addr);

	if (list_p) {
		addr = (*calc->hw.mem_ltop)(calc, addr);
		check_breakpoints(calc, list_p, addr);
	}
}

static inline byte z80_readb_m1(TilemCalc* calc, dword addr)
{
	byte b;
	addr &= 0xffff;
	b = (*calc->hw.z80_rdmem_m1)(calc, addr);
	check_mem_breakpoints(calc, calc->z80.breakpoint_mx,
			      calc->z80.breakpoint_mpx, addr);
	Rl++;
	return b;
}

static inline byte z80_readb(TilemCalc* calc, dword addr)
{
	byte b;
	addr &= 0xffff;
	b = (*calc->hw.z80_rdmem)(calc, addr);
	check_mem_breakpoints(calc, calc->z80.breakpoint_mr,
			      calc->z80.breakpoint_mpr, addr);
	return b;
}

static inline dword z80_readw(TilemCalc* calc, dword addr)
{
	dword v;
	addr &= 0xffff;
	v = (*calc->hw.z80_rdmem)(calc, addr);
	check_mem_breakpoints(calc, calc->z80.breakpoint_mr,
			      calc->z80.breakpoint_mpr, addr);
	addr = (addr + 1) & 0xffff;
	v |= (*calc->hw.z80_rdmem)(calc, addr) << 8;
	check_mem_breakpoints(calc, calc->z80.breakpoint_mr,
			      calc->z80.breakpoint_mpr, addr);
	return v;
}

static inline byte z80_input(TilemCalc* calc, dword addr)
{
	byte b;
	addr &= 0xffff;
	check_timers(calc);
	b = (*calc->hw.z80_in)(calc, addr);
	check_breakpoints(calc, calc->z80.breakpoint_pr, addr);
	return b;
}

static inline void z80_writeb(TilemCalc* calc, dword addr, byte value)
{
	addr &= 0xffff;
	(*calc->hw.z80_wrmem)(calc, addr, value);
	check_mem_breakpoints(calc, calc->z80.breakpoint_mw,
			      calc->z80.breakpoint_mpw, addr);
	calc->z80.lastwrite = calc->z80.clock;
}

static inline void z80_writew(TilemCalc* calc, dword addr, word value)
{
	addr &= 0xffff;
	(*calc->hw.z80_wrmem)(calc, addr, value);
	check_mem_breakpoints(calc, calc->z80.breakpoint_mw,
			      calc->z80.breakpoint_mpw, addr);
	addr = (addr + 1) & 0xffff;
	value >>= 8;
	(*calc->hw.z80_wrmem)(calc, addr, value);
	check_mem_breakpoints(calc, calc->z80.breakpoint_mw,
			      calc->z80.breakpoint_mpw, addr);
	calc->z80.lastwrite = calc->z80.clock;
}

static inline void z80_output(TilemCalc* calc, dword addr, byte value)
{
	addr &= 0xffff;
	check_timers(calc);
	(*calc->hw.z80_out)(calc, addr, value);
	check_breakpoints(calc, calc->z80.breakpoint_pw, addr);
}

#define readb_m1(aaa)     z80_readb_m1(calc, aaa)
#define readb(aaa)        z80_readb(calc, aaa)
#define readw(aaa)        z80_readw(calc, aaa)
#define input(aaa)        z80_input(calc, aaa)
#define writeb(aaa, vvv)  z80_writeb(calc, aaa, vvv)
#define writew(aaa, vvv)  z80_writew(calc, aaa, vvv)
#define output(aaa, vvv)  z80_output(calc, aaa, vvv)
#define delay(nnn)        calc->z80.clock += (nnn)

#include "z80cmds.h"

static dword z80_execute_opcode(TilemCalc* calc, byte op)
{
	byte tmp1;
	word tmp2;
	int offs;
#ifdef DISABLE_Z80_WZ_REGISTER
	TilemZ80Reg temp_wz, temp_wz2;
#endif

 opcode_main:
#include "z80main.h"
	return op;

 opcode_cb:
#include "z80cb.h"
	return op | 0xcb00;

 opcode_ed:
#include "z80ed.h"
	return op | 0xed00;

#define PREFIX_DD
 opcode_dd:
#include "z80ddfd.h"
	return op | 0xdd00;
 opcode_ddcb:
#include "z80cb.h"
	return op | 0xddcb0000;
#undef PREFIX_DD

#define PREFIX_FD
 opcode_fd:
#include "z80ddfd.h"
	return op | 0xfd00;
 opcode_fdcb:
#include "z80cb.h"
	return op | 0xfdcb0000;
#undef PREFIX_FD
}

static void z80_execute(TilemCalc* calc)
{
	TilemZ80* z80 = &calc->z80;
	byte busbyte;
	dword op;
	dword t1, t2;

	z80->stopping = 0;
	z80->stop_reason = 0;
	z80->stop_breakpoint = 0;

	if (!z80->timer_cpu && !z80->timer_rt) {
		tilem_internal(calc, "No timers set");
		return;
	}

	while (!z80->stopping) {
		z80->exception = 0;
		op = (*calc->hw.z80_rdmem_m1)(calc, PC);
		PC++;
		Rl++;
		op = z80_execute_opcode(calc, op);
		check_breakpoints(calc, z80->breakpoint_op, op);
		check_timers(calc);

		if (z80->interrupts && IFF1 && op != 0xfb
		    && op != 0xddfb && op != 0xfdfb) {
			IFF1 = IFF2 = 0;
			Rl++;
			z80->halted = 0;

			/* Depending on the calculator, this value
			   varies somewhat randomly from one interrupt
			   to the next (making IM 2 rather difficult
			   to use, and IM 0 essentially worthless.)
			   Most likely, there is nothing connected to
			   the data bus at interrupt time.  I seem to
			   remember somebody (sigma, perhaps?)
			   experimenting with this on the TI-83+ and
			   finding it usually 3F, 7F, BF, or FF.  Or
			   maybe I'm completely wrong.  In any case it
			   is unwise for programs to depend on this
			   value! */

			busbyte = rand() & 0xff;

			switch (IM) {
			case 0:
				delay(2);
				z80_execute_opcode(calc, busbyte);
				break;

			case 1:
				push(PC);
				PC = 0x0038;
				delay(13);
				break;

			case 2:
				/* FIXME: does accepting an IM 2
				   interrupt affect WZ?  It seems very
				   likely. */
				push(PC);
				PC = readw((IR & 0xff00) | busbyte);
				delay(19);
			}
			check_mem_breakpoints(calc, z80->breakpoint_mx, z80->breakpoint_mpx, PC);
			check_timers(calc);
		}
		else if (op != 0x76) {
			check_mem_breakpoints(calc, z80->breakpoint_mx, z80->breakpoint_mpx, PC);
		}
		else {
			z80->halted = 1;
			PC--;
			if (z80->stopping)
				break;

			/* CPU halted: fast-forward to next timer event */
			if (z80->timer_cpu && z80->timer_rt) {
				t1 = (z80->timers[z80->timer_cpu].count
				      - z80->clock);
				t2 = (z80->timers[z80->timer_rt].count
				      - z80->clock);
				if (t1 > t2)
					t1 = t2;
			}
			else if (z80->timer_cpu) {
				t1 = (z80->timers[z80->timer_cpu].count
				      - z80->clock);
			}
			else if (z80->timer_rt) {
				t1 = (z80->timers[z80->timer_rt].count
				      - z80->clock);
			}
			else {
				tilem_internal(calc, "No timers set");
				return;
			}

			z80->clock += t1 & ~3;
			Rl += t1 / 4;
			check_timers(calc);
		}

		if (TILEM_UNLIKELY(z80->exception)) {
			if (z80->emuflags & TILEM_Z80_BREAK_EXCEPTIONS)
				tilem_z80_stop(calc, TILEM_STOP_EXCEPTION);
			if (!(z80->emuflags & TILEM_Z80_IGNORE_EXCEPTIONS))
				tilem_calc_reset(calc);
		}
	}
}

static void tmr_stop(TilemCalc* calc, void* data TILEM_ATTR_UNUSED)
{
	tilem_z80_stop(calc, TILEM_STOP_TIMEOUT);
}

dword tilem_z80_run(TilemCalc* calc, int clocks, int* remaining)
{
	int tmr = tilem_z80_add_timer(calc, clocks, 0, 0, &tmr_stop, 0);
	z80_execute(calc);
	if (remaining)
		*remaining = tilem_z80_get_timer_clocks(calc, tmr);
	tilem_z80_remove_timer(calc, tmr);
	return calc->z80.stop_reason;
}

dword tilem_z80_run_time(TilemCalc* calc, int microseconds, int* remaining)
{
	int tmr = tilem_z80_add_timer(calc, microseconds, 0, 1, &tmr_stop, 0);
	z80_execute(calc);
	if (remaining)
		*remaining = tilem_z80_get_timer_microseconds(calc, tmr);
	tilem_z80_remove_timer(calc, tmr);
	return calc->z80.stop_reason;
}