int
tsftomsu(
u_long tsf,
int round
)
{
register long val_ui, val_uf;
register long tmp_ui, tmp_uf;
register int i;
/*
* Essentially, multiply by 10 three times in l_fp form.
* The integral part is the milliseconds.
*/
val_ui = 0;
val_uf = tsf;
for (i = 3; i > 0; i--) {
M_LSHIFT(val_ui, val_uf);
tmp_ui = val_ui;
tmp_uf = val_uf;
M_LSHIFT(val_ui, val_uf);
M_LSHIFT(val_ui, val_uf);
M_ADD(val_ui, val_uf, tmp_ui, tmp_uf);
}
/*
* Round the value if need be, then return it.
*/
if (round && (val_uf & 0x80000000))
val_ui++;
return (int)val_ui;
}
static struct tm *
get_struct_tm(
const vint64 *stamp,
int local)
{
struct tm *tm = NULL;
int32 folds = 0;
time_t ts;
#ifdef HAVE_INT64
int64 tl;
ts = tl = stamp->q_s;
/*
* If there is chance of truncation, try to fix it. Let the
* compiler find out if this can happen at all.
*/
while (ts != tl) { /* truncation? */
if (tl < 0) {
if (--folds < MINFOLD)
return NULL;
tl += SOLAR_CYCLE_SECS;
} else {
if (++folds > MAXFOLD)
return NULL;
tl -= SOLAR_CYCLE_SECS;
}
ts = tl; /* next try... */
}
#else
/*
* since we do not have 64-bit scalars, it's not likely we have
* 64-bit time_t. Assume 32 bits and properly reduce the value.
*/
u_int32 hi, lo;
hi = stamp->D_s.hi;
lo = stamp->D_s.lo;
while ((hi && ~hi) || ((hi ^ lo) & 0x80000000u)) {
if (M_ISNEG(hi, lo)) {
if (--folds < MINFOLD)
return NULL;
M_ADD(hi, lo, 0, SOLAR_CYCLE_SECS);
} else {
if (++folds > MAXFOLD)
return NULL;
M_SUB(hi, lo, 0, SOLAR_CYCLE_SECS);
}
}
ts = (int32)lo;
#endif
/*
* 'ts' should be a suitable value by now. Just go ahead, but
* with care:
*
* There are some pathological implementations of 'gmtime()'
* and 'localtime()' out there. No matter if we have 32-bit or
* 64-bit 'time_t', try to fix this by solar cycle warping
* again...
*
* At least the MSDN says that the (Microsoft) Windoze
* versions of 'gmtime()' and 'localtime()' will bark on time
* stamps < 0.
*/
while ((tm = (*(local ? localtime : gmtime))(&ts)) == NULL)
if (ts < 0) {
if (--folds < MINFOLD)
return NULL;
ts += SOLAR_CYCLE_SECS;
} else if (ts >= (time_t)SOLAR_CYCLE_SECS) {
if (++folds > MAXFOLD)
return NULL;
ts -= SOLAR_CYCLE_SECS;
} else
return NULL; /* That's truly pathological! */
/* 'tm' surely not NULL here! */
NTP_INSIST(tm != NULL);
if (folds != 0) {
tm->tm_year += folds * SOLAR_CYCLE_YEARS;
if (tm->tm_year <= 0 || tm->tm_year >= 200)
return NULL; /* left warp range... can't help here! */
}
return tm;
}
int s2650_execute(int cycles)
{
s2650_ICount = cycles;
do
{
S.ppc = S.page + S.iar;
S.ir = ROP();
s2650_ICount -= S2650_Cycles[S.ir];
S.r = S.ir & 3; /* register / value */
switch (S.ir) {
case 0x00: /* LODZ,0 */
case 0x01: /* LODZ,1 */
case 0x02: /* LODZ,2 */
case 0x03: /* LODZ,3 */
M_LOD( R0, S.reg[S.r] );
break;
case 0x04: /* LODI,0 v */
case 0x05: /* LODI,1 v */
case 0x06: /* LODI,2 v */
case 0x07: /* LODI,3 v */
M_LOD( S.reg[S.r], ARG() );
break;
case 0x08: /* LODR,0 (*)a */
case 0x09: /* LODR,1 (*)a */
case 0x0a: /* LODR,2 (*)a */
case 0x0b: /* LODR,3 (*)a */
REL_EA( S.page );
M_LOD( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x0c: /* LODA,0 (*)a(,X) */
case 0x0d: /* LODA,1 (*)a(,X) */
case 0x0e: /* LODA,2 (*)a(,X) */
case 0x0f: /* LODA,3 (*)a(,X) */
ABS_EA();
M_LOD( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x10: /* illegal */
case 0x11: /* illegal */
break;
case 0x12: /* SPSU */
M_SPSU();
break;
case 0x13: /* SPSL */
M_SPSL();
break;
case 0x14: /* RETC,0 (zero) */
case 0x15: /* RETC,1 (plus) */
case 0x16: /* RETC,2 (minus) */
M_RET( (S.psl >> 6) == S.r );
break;
case 0x17: /* RETC,3 (always) */
M_RET( 1 );
break;
case 0x18: /* BCTR,0 (*)a */
case 0x19: /* BCTR,1 (*)a */
case 0x1a: /* BCTR,2 (*)a */
M_BRR( (S.psl >> 6) == S.r );
break;
case 0x1b: /* BCTR,3 (*)a */
M_BRR( 1 );
break;
case 0x1c: /* BCTA,0 (*)a */
case 0x1d: /* BCTA,1 (*)a */
case 0x1e: /* BCTA,2 (*)a */
M_BRA( (S.psl >> 6) == S.r );
break;
case 0x1f: /* BCTA,3 (*)a */
M_BRA( 1 );
break;
case 0x20: /* EORZ,0 */
case 0x21: /* EORZ,1 */
case 0x22: /* EORZ,2 */
case 0x23: /* EORZ,3 */
M_EOR( R0, S.reg[S.r] );
break;
case 0x24: /* EORI,0 v */
case 0x25: /* EORI,1 v */
case 0x26: /* EORI,2 v */
case 0x27: /* EORI,3 v */
M_EOR( S.reg[S.r], ARG() );
break;
case 0x28: /* EORR,0 (*)a */
case 0x29: /* EORR,1 (*)a */
case 0x2a: /* EORR,2 (*)a */
case 0x2b: /* EORR,3 (*)a */
REL_EA( S.page );
M_EOR( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x2c: /* EORA,0 (*)a(,X) */
case 0x2d: /* EORA,1 (*)a(,X) */
case 0x2e: /* EORA,2 (*)a(,X) */
case 0x2f: /* EORA,3 (*)a(,X) */
ABS_EA();
M_EOR( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x30: /* REDC,0 */
case 0x31: /* REDC,1 */
case 0x32: /* REDC,2 */
case 0x33: /* REDC,3 */
S.reg[S.r] = cpu_readport(S2650_CTRL_PORT);
SET_CC( S.reg[S.r] );
break;
case 0x34: /* RETE,0 */
case 0x35: /* RETE,1 */
case 0x36: /* RETE,2 */
M_RETE( (S.psl >> 6) == S.r );
break;
case 0x37: /* RETE,3 */
M_RETE( 1 );
break;
case 0x38: /* BSTR,0 (*)a */
case 0x39: /* BSTR,1 (*)a */
case 0x3a: /* BSTR,2 (*)a */
M_BSR( (S.psl >> 6) == S.r );
break;
case 0x3b: /* BSTR,R3 (*)a */
M_BSR( 1 );
break;
case 0x3c: /* BSTA,0 (*)a */
case 0x3d: /* BSTA,1 (*)a */
case 0x3e: /* BSTA,2 (*)a */
M_BSA( (S.psl >> 6) == S.r );
break;
case 0x3f: /* BSTA,3 (*)a */
M_BSA( 1 );
break;
case 0x40: /* HALT */
S.iar = (S.iar - 1) & PMSK;
S.halt = 1;
if (s2650_ICount > 0)
s2650_ICount = 0;
break;
case 0x41: /* ANDZ,1 */
case 0x42: /* ANDZ,2 */
case 0x43: /* ANDZ,3 */
M_AND( R0, S.reg[S.r] );
break;
case 0x44: /* ANDI,0 v */
case 0x45: /* ANDI,1 v */
case 0x46: /* ANDI,2 v */
case 0x47: /* ANDI,3 v */
M_AND( S.reg[S.r], ARG() );
break;
case 0x48: /* ANDR,0 (*)a */
case 0x49: /* ANDR,1 (*)a */
case 0x4a: /* ANDR,2 (*)a */
case 0x4b: /* ANDR,3 (*)a */
REL_EA( S.page );
M_AND( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x4c: /* ANDA,0 (*)a(,X) */
case 0x4d: /* ANDA,1 (*)a(,X) */
case 0x4e: /* ANDA,2 (*)a(,X) */
case 0x4f: /* ANDA,3 (*)a(,X) */
ABS_EA();
M_AND( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x50: /* RRR,0 */
case 0x51: /* RRR,1 */
case 0x52: /* RRR,2 */
case 0x53: /* RRR,3 */
M_RRR( S.reg[S.r] );
break;
case 0x54: /* REDE,0 v */
case 0x55: /* REDE,1 v */
case 0x56: /* REDE,2 v */
case 0x57: /* REDE,3 v */
S.reg[S.r] = cpu_readport( ARG() );
SET_CC(S.reg[S.r]);
break;
case 0x58: /* BRNR,0 (*)a */
case 0x59: /* BRNR,1 (*)a */
case 0x5a: /* BRNR,2 (*)a */
case 0x5b: /* BRNR,3 (*)a */
M_BRR( S.reg[S.r] );
break;
case 0x5c: /* BRNA,0 (*)a */
case 0x5d: /* BRNA,1 (*)a */
case 0x5e: /* BRNA,2 (*)a */
case 0x5f: /* BRNA,3 (*)a */
M_BRA( S.reg[S.r] );
break;
case 0x60: /* IORZ,0 */
case 0x61: /* IORZ,1 */
case 0x62: /* IORZ,2 */
case 0x63: /* IORZ,3 */
M_IOR( R0, S.reg[S.r] );
break;
case 0x64: /* IORI,0 v */
case 0x65: /* IORI,1 v */
case 0x66: /* IORI,2 v */
case 0x67: /* IORI,3 v */
M_IOR( S.reg[S.r], ARG() );
break;
case 0x68: /* IORR,0 (*)a */
case 0x69: /* IORR,1 (*)a */
case 0x6a: /* IORR,2 (*)a */
case 0x6b: /* IORR,3 (*)a */
REL_EA( S.page );
M_IOR( S.reg[S. r],RDMEM(S.ea) );
break;
case 0x6c: /* IORA,0 (*)a(,X) */
case 0x6d: /* IORA,1 (*)a(,X) */
case 0x6e: /* IORA,2 (*)a(,X) */
case 0x6f: /* IORA,3 (*)a(,X) */
ABS_EA();
M_IOR( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x70: /* REDD,0 */
case 0x71: /* REDD,1 */
case 0x72: /* REDD,2 */
case 0x73: /* REDD,3 */
S.reg[S.r] = cpu_readport(S2650_DATA_PORT);
SET_CC(S.reg[S.r]);
break;
case 0x74: /* CPSU */
M_CPSU();
break;
case 0x75: /* CPSL */
M_CPSL();
break;
case 0x76: /* PPSU */
M_PPSU();
break;
case 0x77: /* PPSL */
M_PPSL();
break;
case 0x78: /* BSNR,0 (*)a */
case 0x79: /* BSNR,1 (*)a */
case 0x7a: /* BSNR,2 (*)a */
case 0x7b: /* BSNR,3 (*)a */
M_BSR( S.reg[S.r] );
break;
case 0x7c: /* BSNA,0 (*)a */
case 0x7d: /* BSNA,1 (*)a */
case 0x7e: /* BSNA,2 (*)a */
case 0x7f: /* BSNA,3 (*)a */
M_BSA( S.reg[S.r] );
break;
case 0x80: /* ADDZ,0 */
case 0x81: /* ADDZ,1 */
case 0x82: /* ADDZ,2 */
case 0x83: /* ADDZ,3 */
M_ADD( R0,S.reg[S.r] );
break;
case 0x84: /* ADDI,0 v */
case 0x85: /* ADDI,1 v */
case 0x86: /* ADDI,2 v */
case 0x87: /* ADDI,3 v */
M_ADD( S.reg[S.r], ARG() );
break;
case 0x88: /* ADDR,0 (*)a */
case 0x89: /* ADDR,1 (*)a */
case 0x8a: /* ADDR,2 (*)a */
case 0x8b: /* ADDR,3 (*)a */
REL_EA(S.page);
M_ADD( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x8c: /* ADDA,0 (*)a(,X) */
case 0x8d: /* ADDA,1 (*)a(,X) */
case 0x8e: /* ADDA,2 (*)a(,X) */
case 0x8f: /* ADDA,3 (*)a(,X) */
ABS_EA();
M_ADD( S.reg[S.r], RDMEM(S.ea) );
break;
case 0x90: /* illegal */
case 0x91: /* illegal */
break;
case 0x92: /* LPSU */
S.psu = R0 & ~PSU34;
break;
case 0x93: /* LPSL */
/* change register set ? */
if ((S.psl ^ R0) & RS)
SWAP_REGS;
S.psl = R0;
break;
case 0x94: /* DAR,0 */
case 0x95: /* DAR,1 */
case 0x96: /* DAR,2 */
case 0x97: /* DAR,3 */
M_DAR( S.reg[S.r] );
break;
case 0x98: /* BCFR,0 (*)a */
case 0x99: /* BCFR,1 (*)a */
case 0x9a: /* BCFR,2 (*)a */
M_BRR( (S.psl >> 6) != S.r );
break;
case 0x9b: /* ZBRR (*)a */
M_ZBRR();
break;
case 0x9c: /* BCFA,0 (*)a */
case 0x9d: /* BCFA,1 (*)a */
case 0x9e: /* BCFA,2 (*)a */
M_BRA( (S.psl >> 6) != S.r );
break;
case 0x9f: /* BXA (*)a */
M_BXA();
break;
case 0xa0: /* SUBZ,0 */
case 0xa1: /* SUBZ,1 */
case 0xa2: /* SUBZ,2 */
case 0xa3: /* SUBZ,3 */
M_SUB( R0, S.reg[S.r] );
break;
case 0xa4: /* SUBI,0 v */
case 0xa5: /* SUBI,1 v */
case 0xa6: /* SUBI,2 v */
case 0xa7: /* SUBI,3 v */
M_SUB( S.reg[S.r], ARG() );
break;
case 0xa8: /* SUBR,0 (*)a */
case 0xa9: /* SUBR,1 (*)a */
case 0xaa: /* SUBR,2 (*)a */
case 0xab: /* SUBR,3 (*)a */
REL_EA(S.page);
M_SUB( S.reg[S.r], RDMEM(S.ea) );
break;
case 0xac: /* SUBA,0 (*)a(,X) */
case 0xad: /* SUBA,1 (*)a(,X) */
case 0xae: /* SUBA,2 (*)a(,X) */
case 0xaf: /* SUBA,3 (*)a(,X) */
ABS_EA();
M_SUB( S.reg[S.r], RDMEM(S.ea) );
break;
case 0xb0: /* WRTC,0 */
case 0xb1: /* WRTC,1 */
case 0xb2: /* WRTC,2 */
case 0xb3: /* WRTC,3 */
cpu_writeport(S2650_CTRL_PORT,S.reg[S.r]);
break;
case 0xb4: /* TPSU */
M_TPSU();
break;
case 0xb5: /* TPSL */
M_TPSL();
break;
case 0xb6: /* illegal */
case 0xb7: /* illegal */
break;
case 0xb8: /* BSFR,0 (*)a */
case 0xb9: /* BSFR,1 (*)a */
case 0xba: /* BSFR,2 (*)a */
M_BSR( (S.psl >> 6) != S.r );
break;
case 0xbb: /* ZBSR (*)a */
M_ZBSR();
break;
case 0xbc: /* BSFA,0 (*)a */
case 0xbd: /* BSFA,1 (*)a */
case 0xbe: /* BSFA,2 (*)a */
M_BSA( (S.psl >> 6) != S.r );
break;
case 0xbf: /* BSXA (*)a */
M_BSXA();
break;
case 0xc0: /* NOP */
break;
case 0xc1: /* STRZ,1 */
case 0xc2: /* STRZ,2 */
case 0xc3: /* STRZ,3 */
M_LOD( S.reg[S.r], R0 );
break;
case 0xc4: /* illegal */
case 0xc5: /* illegal */
case 0xc6: /* illegal */
case 0xc7: /* illegal */
break;
case 0xc8: /* STRR,0 (*)a */
case 0xc9: /* STRR,1 (*)a */
case 0xca: /* STRR,2 (*)a */
case 0xcb: /* STRR,3 (*)a */
REL_EA(S.page);
M_STR( S.ea, S.reg[S.r] );
break;
case 0xcc: /* STRA,0 (*)a(,X) */
case 0xcd: /* STRA,1 (*)a(,X) */
case 0xce: /* STRA,2 (*)a(,X) */
case 0xcf: /* STRA,3 (*)a(,X) */
ABS_EA();
M_STR( S.ea, S.reg[S.r] );
break;
case 0xd0: /* RRL,0 */
case 0xd1: /* RRL,1 */
case 0xd2: /* RRL,2 */
case 0xd3: /* RRL,3 */
M_RRL( S.reg[S.r] );
break;
case 0xd4: /* WRTE,0 v */
case 0xd5: /* WRTE,1 v */
case 0xd6: /* WRTE,2 v */
case 0xd7: /* WRTE,3 v */
cpu_writeport( ARG(), S.reg[S.r] );
break;
case 0xd8: /* BIRR,0 (*)a */
case 0xd9: /* BIRR,1 (*)a */
case 0xda: /* BIRR,2 (*)a */
case 0xdb: /* BIRR,3 (*)a */
M_BRR( ++S.reg[S.r] );
break;
case 0xdc: /* BIRA,0 (*)a */
case 0xdd: /* BIRA,1 (*)a */
case 0xde: /* BIRA,2 (*)a */
case 0xdf: /* BIRA,3 (*)a */
M_BRA( ++S.reg[S.r] );
break;
case 0xe0: /* COMZ,0 */
case 0xe1: /* COMZ,1 */
case 0xe2: /* COMZ,2 */
case 0xe3: /* COMZ,3 */
M_COM( R0, S.reg[S.r] );
break;
case 0xe4: /* COMI,0 v */
case 0xe5: /* COMI,1 v */
case 0xe6: /* COMI,2 v */
case 0xe7: /* COMI,3 v */
M_COM( S.reg[S.r], ARG() );
break;
case 0xe8: /* COMR,0 (*)a */
case 0xe9: /* COMR,1 (*)a */
case 0xea: /* COMR,2 (*)a */
case 0xeb: /* COMR,3 (*)a */
REL_EA(S.page);
M_COM( S.reg[S.r], RDMEM(S.ea) );
break;
case 0xec: /* COMA,0 (*)a(,X) */
case 0xed: /* COMA,1 (*)a(,X) */
case 0xee: /* COMA,2 (*)a(,X) */
case 0xef: /* COMA,3 (*)a(,X) */
ABS_EA();
M_COM( S.reg[S.r], RDMEM(S.ea) );
break;
case 0xf0: /* WRTD,0 */
case 0xf1: /* WRTD,1 */
case 0xf2: /* WRTD,2 */
case 0xf3: /* WRTD,3 */
cpu_writeport(S2650_DATA_PORT, S.reg[S.r]);
break;
case 0xf4: /* TMI,0 v */
case 0xf5: /* TMI,1 v */
case 0xf6: /* TMI,2 v */
case 0xf7: /* TMI,3 v */
M_TMI( S.reg[S.r] );
break;
case 0xf8: /* BDRR,0 (*)a */
case 0xf9: /* BDRR,1 (*)a */
case 0xfa: /* BDRR,2 (*)a */
case 0xfb: /* BDRR,3 (*)a */
M_BRR( --S.reg[S.r] );
break;
case 0xfc: /* BDRA,0 (*)a */
case 0xfd: /* BDRA,1 (*)a */
case 0xfe: /* BDRA,2 (*)a */
case 0xff: /* BDRA,3 (*)a */
M_BRA( --S.reg[S.r] );
break;
}
} while( s2650_ICount > 0 );
return cycles - s2650_ICount;
}
static void add_a_xr1(void) { M_ADD(intRAM[R1 & 0x7f]); }
static void add_a_xr0(void) { M_ADD(intRAM[R0 & 0x7f]); }
static void add_a_r7(void) { M_ADD(R7); }
static void add_a_r6(void) { M_ADD(R6); }
static void add_a_r5(void) { M_ADD(R5); }
static void add_a_r4(void) { M_ADD(R4); }
static void add_a_r3(void) { M_ADD(R3); }
static void add_a_r2(void) { M_ADD(R2); }
static void add_a_r1(void) { M_ADD(R1); }
static void add_a_r0(void) { M_ADD(R0); }
static void add_a_n(void) { M_ADD(M_RDMEM_OPCODE()); }