mirror of
https://github.com/hoglet67/AtomBusMon.git
synced 2024-12-22 16:30:06 +00:00
6809: eliminate usage of log0
Change-Id: Iddf14f72e9e848703aba07208708b55968d100af
This commit is contained in:
David Banks
parent
ec53c9d54f
commit
15c212f4b6
@ -18,24 +18,6 @@
|
|||||||
#include <avr/pgmspace.h>
|
#include <avr/pgmspace.h>
|
||||||
#include "AtomBusMon.h"
|
#include "AtomBusMon.h"
|
||||||
|
|
||||||
unsigned char get_memb(unsigned int addr) {
|
|
||||||
loadAddr(addr);
|
|
||||||
return readMemByteInc();
|
|
||||||
}
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
|
|
||||||
typedef unsigned char tt_u8;
|
|
||||||
typedef signed char tt_s8;
|
|
||||||
typedef unsigned short tt_u16;
|
|
||||||
typedef signed short tt_s16;
|
|
||||||
|
|
||||||
|
|
||||||
unsigned int get_memw(unsigned int addr) {
|
|
||||||
loadAddr(addr);
|
|
||||||
return (readMemByteInc() << 8) + readMemByteInc();
|
|
||||||
}
|
|
||||||
|
|
||||||
enum opcodes {
|
enum opcodes {
|
||||||
OP_UU ,
|
OP_UU ,
|
||||||
OP_XX ,
|
OP_XX ,
|
||||||
@ -312,15 +294,15 @@ TSTB";
|
|||||||
|
|
||||||
// The first byte is the opcode index
|
// The first byte is the opcode index
|
||||||
// The second byte is <length><mode>
|
// The second byte is <length><mode>
|
||||||
// modes:
|
// modes:
|
||||||
// 1 immediate
|
// 1 immediate
|
||||||
// 2 direct
|
// 2 direct
|
||||||
// 3 indexed
|
// 3 indexed
|
||||||
// 4 extended
|
// 4 extended
|
||||||
// 5 inherent
|
// 5 inherent
|
||||||
// 6 relative
|
// 6 relative
|
||||||
|
|
||||||
static const unsigned char map0[] PROGMEM = {
|
static const uint8_t map0[] PROGMEM = {
|
||||||
OP_NEG , 0x22,
|
OP_NEG , 0x22,
|
||||||
OP_XX , 0x22,
|
OP_XX , 0x22,
|
||||||
OP_XX , 0x12,
|
OP_XX , 0x12,
|
||||||
@ -579,142 +561,110 @@ static const unsigned char map0[] PROGMEM = {
|
|||||||
OP_STU , 0x34,
|
OP_STU , 0x34,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const unsigned char map1[] PROGMEM = {
|
static const uint8_t map1[] PROGMEM = {
|
||||||
33, OP_LBRN, 0x46,
|
33, OP_LBRN, 0x46,
|
||||||
34, OP_LBHI, 0x46,
|
34, OP_LBHI, 0x46,
|
||||||
35, OP_LBLS, 0x46,
|
35, OP_LBLS, 0x46,
|
||||||
36, OP_LBCC, 0x46,
|
36, OP_LBCC, 0x46,
|
||||||
37, OP_LBLO, 0x46,
|
37, OP_LBLO, 0x46,
|
||||||
38, OP_LBNE, 0x46,
|
38, OP_LBNE, 0x46,
|
||||||
39, OP_LBEQ, 0x46,
|
39, OP_LBEQ, 0x46,
|
||||||
40, OP_LBVC, 0x46,
|
40, OP_LBVC, 0x46,
|
||||||
41, OP_LBVS, 0x46,
|
41, OP_LBVS, 0x46,
|
||||||
42, OP_LBPL, 0x46,
|
42, OP_LBPL, 0x46,
|
||||||
43, OP_LBMI, 0x46,
|
43, OP_LBMI, 0x46,
|
||||||
44, OP_LBGE, 0x46,
|
44, OP_LBGE, 0x46,
|
||||||
45, OP_LBLT, 0x46,
|
45, OP_LBLT, 0x46,
|
||||||
46, OP_LBGT, 0x46,
|
46, OP_LBGT, 0x46,
|
||||||
47, OP_LBLE, 0x46,
|
47, OP_LBLE, 0x46,
|
||||||
63, OP_SWI2, 0x25,
|
63, OP_SWI2, 0x25,
|
||||||
131, OP_CMPD, 0x41,
|
131, OP_CMPD, 0x41,
|
||||||
140, OP_CMPY, 0x41,
|
140, OP_CMPY, 0x41,
|
||||||
142, OP_LDY , 0x41,
|
142, OP_LDY , 0x41,
|
||||||
147, OP_CMPD, 0x32,
|
147, OP_CMPD, 0x32,
|
||||||
156, OP_CMPY, 0x32,
|
156, OP_CMPY, 0x32,
|
||||||
158, OP_LDY , 0x32,
|
158, OP_LDY , 0x32,
|
||||||
159, OP_STY , 0x32,
|
159, OP_STY , 0x32,
|
||||||
163, OP_CMPD, 0x33,
|
163, OP_CMPD, 0x33,
|
||||||
172, OP_CMPY, 0x33,
|
172, OP_CMPY, 0x33,
|
||||||
174, OP_LDY , 0x33,
|
174, OP_LDY , 0x33,
|
||||||
175, OP_STY , 0x33,
|
175, OP_STY , 0x33,
|
||||||
179, OP_CMPD, 0x44,
|
179, OP_CMPD, 0x44,
|
||||||
188, OP_CMPY, 0x44,
|
188, OP_CMPY, 0x44,
|
||||||
190, OP_LDY , 0x44,
|
190, OP_LDY , 0x44,
|
||||||
191, OP_STY , 0x44,
|
191, OP_STY , 0x44,
|
||||||
206, OP_LDS , 0x41,
|
206, OP_LDS , 0x41,
|
||||||
222, OP_LDS , 0x32,
|
222, OP_LDS , 0x32,
|
||||||
223, OP_STS , 0x32,
|
223, OP_STS , 0x32,
|
||||||
238, OP_LDS , 0x33,
|
238, OP_LDS , 0x33,
|
||||||
239, OP_STS , 0x33,
|
239, OP_STS , 0x33,
|
||||||
254, OP_LDS , 0x44,
|
254, OP_LDS , 0x44,
|
||||||
255, OP_STS , 0x44,
|
255, OP_STS , 0x44,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const unsigned char map2[] PROGMEM = {
|
static const uint8_t map2[] PROGMEM = {
|
||||||
63, OP_SWI3, 0x25,
|
63, OP_SWI3, 0x25,
|
||||||
131, OP_CMPU, 0x41,
|
131, OP_CMPU, 0x41,
|
||||||
140, OP_CMPS, 0x41,
|
140, OP_CMPS, 0x41,
|
||||||
147, OP_CMPU, 0x32,
|
147, OP_CMPU, 0x32,
|
||||||
156, OP_CMPS, 0x32,
|
156, OP_CMPS, 0x32,
|
||||||
163, OP_CMPU, 0x33,
|
163, OP_CMPU, 0x33,
|
||||||
172, OP_CMPS, 0x33,
|
172, OP_CMPS, 0x33,
|
||||||
179, OP_CMPU, 0x44,
|
179, OP_CMPU, 0x44,
|
||||||
188, OP_CMPS, 0x44,
|
188, OP_CMPS, 0x44,
|
||||||
255, OP_XX , 0x10
|
255, OP_XX , 0x10
|
||||||
};
|
};
|
||||||
|
|
||||||
static const char regi[] = { 'X', 'Y', 'U', 'S' };
|
static const char regi[] = { 'X', 'Y', 'U', 'S' };
|
||||||
|
|
||||||
static const char *exgi[] = { "D", "X", "Y", "U", "S", "PC", "??", "??", "A",
|
static const char *exgi[] = { "D", "X", "Y", "U", "S", "PC", "??", "??", "A",
|
||||||
"B", "CC", "DP", "??", "??", "??", "??" };
|
"B", "CC", "DP", "??", "??", "??", "??" };
|
||||||
|
|
||||||
static const char *pshsregi[] = { "PC", "U", "Y", "X", "DP", "B", "A", "CC" };
|
static const char *pshsregi[] = { "PC", "U", "Y", "X", "DP", "B", "A", "CC" };
|
||||||
|
|
||||||
static const char *pshuregi[] = { "PC", "S", "Y", "X", "DP", "B", "A", "CC" };
|
static const char *pshuregi[] = { "PC", "S", "Y", "X", "DP", "B", "A", "CC" };
|
||||||
|
|
||||||
/* disassemble one instruction at adress adr and return its size */
|
extern const char statusString[];
|
||||||
|
|
||||||
char hexdigit(tt_u16 v)
|
static uint8_t get_memb(addr_t addr) {
|
||||||
{
|
loadAddr(addr);
|
||||||
v &= 0xf;
|
return readMemByteInc();
|
||||||
if (v <= 9)
|
|
||||||
return '0' + v;
|
|
||||||
else
|
|
||||||
return 'A' - 10 + v;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
char *hex8str(tt_u8 v)
|
static uint16_t get_memw(addr_t addr) {
|
||||||
{
|
loadAddr(addr);
|
||||||
static char tmpbuf[3] = " ";
|
return (readMemByteInc() << 8) + readMemByteInc();
|
||||||
|
|
||||||
tmpbuf[1] = hexdigit(v);
|
|
||||||
tmpbuf[0] = hexdigit(v >> 4);
|
|
||||||
|
|
||||||
return tmpbuf;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
char *hex16str(tt_u16 v)
|
static char *strcc(char *ptr, uint8_t val) {
|
||||||
{
|
uint8_t i;
|
||||||
static char tmpbuf[5] = " ";
|
|
||||||
|
|
||||||
tmpbuf[3] = hexdigit(v);
|
|
||||||
v >>= 4;
|
|
||||||
tmpbuf[2] = hexdigit(v);
|
|
||||||
v >>= 4;
|
|
||||||
tmpbuf[1] = hexdigit(v);
|
|
||||||
v >>= 4;
|
|
||||||
tmpbuf[0] = hexdigit(v);
|
|
||||||
|
|
||||||
return tmpbuf;
|
|
||||||
}
|
|
||||||
|
|
||||||
extern char *statusString;
|
|
||||||
|
|
||||||
char *ccstr(tt_u8 val)
|
|
||||||
{
|
|
||||||
static char tempbuf[9] = " ";
|
|
||||||
int i;
|
|
||||||
|
|
||||||
for (i = 0; i < 8; i++) {
|
for (i = 0; i < 8; i++) {
|
||||||
if (val & 0x80)
|
*ptr++ = (val & 0x80) ? statusString[i] : '.';
|
||||||
tempbuf[i] = statusString[i];
|
|
||||||
else
|
|
||||||
tempbuf[i] = '.';
|
|
||||||
val <<= 1;
|
val <<= 1;
|
||||||
}
|
}
|
||||||
|
return ptr;
|
||||||
return tempbuf;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
unsigned int disassemble(unsigned int addr)
|
/* disassemble one instruction at address addr and return the address of the next instruction */
|
||||||
{
|
|
||||||
int d = get_memb(addr);
|
addr_t disassemble(addr_t addr) {
|
||||||
int s, i;
|
uint8_t d = get_memb(addr);
|
||||||
tt_u8 pb;
|
uint8_t s;
|
||||||
|
int8_t i;
|
||||||
|
uint8_t pb;
|
||||||
char reg;
|
char reg;
|
||||||
const unsigned char *map = NULL;
|
char *ptr;
|
||||||
|
static char buffer[64];
|
||||||
|
const uint8_t *map = NULL;
|
||||||
|
|
||||||
// Default for most undefined opcodes
|
// Default for most undefined opcodes
|
||||||
unsigned char sm = 0x10; // size_mode byte
|
unsigned char sm = 0x10; // size_mode byte
|
||||||
unsigned char oi = OP_XX; // opcode index
|
unsigned char oi = OP_XX; // opcode index
|
||||||
|
|
||||||
FILE *stream = &ser0stream;
|
|
||||||
|
|
||||||
if (d == 0x10) {
|
if (d == 0x10) {
|
||||||
d = get_memb(addr + 1);
|
d = get_memb(addr + 1);
|
||||||
map = map1;
|
map = map1;
|
||||||
}
|
} else if (d == 0x11) {
|
||||||
|
|
||||||
if (d == 0x11) {
|
|
||||||
d = get_memb(addr + 1);
|
d = get_memb(addr + 1);
|
||||||
map = map2;
|
map = map2;
|
||||||
}
|
}
|
||||||
@ -724,12 +674,13 @@ unsigned int disassemble(unsigned int addr)
|
|||||||
map -= 3;
|
map -= 3;
|
||||||
do {
|
do {
|
||||||
map += 3;
|
map += 3;
|
||||||
if (pgm_read_byte(map) == d) {
|
s = pgm_read_byte(map);
|
||||||
oi = pgm_read_byte(++map);
|
if (s == d) {
|
||||||
sm = pgm_read_byte(++map);
|
oi = pgm_read_byte(++map);
|
||||||
break;
|
sm = pgm_read_byte(++map);
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
} while (*map < 255);
|
} while (s < 255);
|
||||||
} else {
|
} else {
|
||||||
// Lookup directly in map0
|
// Lookup directly in map0
|
||||||
map = map0 + 2 * d;
|
map = map0 + 2 * d;
|
||||||
@ -739,187 +690,258 @@ unsigned int disassemble(unsigned int addr)
|
|||||||
|
|
||||||
s = sm >> 4;
|
s = sm >> 4;
|
||||||
|
|
||||||
fprintf(stream, "%04X ", addr);
|
// 0123456789012345678901234567890123456789
|
||||||
|
// AAAA : HH HH HH HH : OOOO AAAAAAAAA
|
||||||
|
|
||||||
|
strfill(buffer, ' ', sizeof(buffer));
|
||||||
|
buffer[5] = ':';
|
||||||
|
buffer[19] = ':';
|
||||||
|
|
||||||
|
// Address
|
||||||
|
strhex4(buffer, addr);
|
||||||
|
|
||||||
|
// Hex
|
||||||
|
ptr = buffer + 7;
|
||||||
for (i = 0; i < s; i++) {
|
for (i = 0; i < s; i++) {
|
||||||
fputs(hex8str(get_memb(addr + i)), stream);
|
strhex2(ptr, get_memb(addr + i));
|
||||||
fputc(' ', stream);
|
ptr += 3;
|
||||||
}
|
|
||||||
for (i = s; i < 4; i++) {
|
|
||||||
fputs(" ", stream);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Opcode
|
||||||
|
ptr = buffer + 21;
|
||||||
const char *ip = inst + oi * 4;
|
const char *ip = inst + oi * 4;
|
||||||
for (i = 0; i < 4; i++)
|
for (i = 0; i < 4; i++) {
|
||||||
fputc(pgm_read_byte(ip++), stream);
|
*ptr++ = pgm_read_byte(ip++);
|
||||||
|
}
|
||||||
fputs(" ", stream);
|
ptr++;
|
||||||
|
|
||||||
|
|
||||||
switch(sm & 15) {
|
switch(sm & 15) {
|
||||||
case 1: /* immediate */
|
case 1: /* immediate */
|
||||||
fputs("#$", stream);
|
*ptr++ = '#';
|
||||||
if (s == 2)
|
*ptr++ = '$';
|
||||||
fputs(hex8str(get_memb(addr + 1)), stream);
|
if (s == 2) {
|
||||||
else
|
ptr = strhex2(ptr, get_memb(addr + 1));
|
||||||
fputs(hex16str(get_memw(addr + s - 2)), stream);
|
} else {
|
||||||
|
ptr = strhex4(ptr, get_memw(addr + s - 2));
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
case 2: /* direct */
|
case 2: /* direct */
|
||||||
fputs("$", stream);
|
*ptr++ = '$';
|
||||||
fputs(hex8str(get_memb(addr + s - 1)), stream);
|
ptr = strhex2(ptr, get_memb(addr + s - 1));
|
||||||
break;
|
break;
|
||||||
case 3: /* indexed */
|
case 3: /* indexed */
|
||||||
pb = get_memb(addr + s - 1);
|
pb = get_memb(addr + s - 1);
|
||||||
reg = regi[(pb >> 5) & 0x03];
|
reg = regi[(pb >> 5) & 0x03];
|
||||||
|
|
||||||
if (!(pb & 0x80)) { /* n4,R */
|
if (!(pb & 0x80)) { /* n4,R */
|
||||||
if (pb & 0x10)
|
if (pb & 0x10) {
|
||||||
fprintf(stream, "-$%s,%c", hex8str(((pb & 0x0f) ^ 0x0f) + 1), reg);
|
*ptr++ = '-';
|
||||||
else
|
*ptr++ = '$';
|
||||||
fprintf(stream, "$%s,%c", hex8str(pb & 0x0f), reg);
|
ptr = strhex2(ptr, ((pb & 0x0f) ^ 0x0f) + 1);
|
||||||
}
|
} else {
|
||||||
else {
|
*ptr++ = '$';
|
||||||
if (pb & 0x10)
|
ptr = strhex2(ptr, pb & 0x0f);
|
||||||
fputc('[', stream);
|
}
|
||||||
|
*ptr++ = ',';
|
||||||
|
*ptr++ = reg;
|
||||||
|
} else {
|
||||||
|
if (pb & 0x10) {
|
||||||
|
*ptr++ = '[';
|
||||||
|
}
|
||||||
switch (pb & 0x0f) {
|
switch (pb & 0x0f) {
|
||||||
case 0: /* ,R+ */
|
case 0: /* ,R+ */
|
||||||
fprintf(stream, ",%c+", reg);
|
*ptr++ = ',';
|
||||||
break;
|
*ptr++ = reg;
|
||||||
|
*ptr++ = '+';
|
||||||
|
break;
|
||||||
case 1: /* ,R++ */
|
case 1: /* ,R++ */
|
||||||
fprintf(stream, ",%c++", reg);
|
*ptr++ = ',';
|
||||||
break;
|
*ptr++ = reg;
|
||||||
|
*ptr++ = '+';
|
||||||
|
*ptr++ = '+';
|
||||||
|
break;
|
||||||
case 2: /* ,-R */
|
case 2: /* ,-R */
|
||||||
fprintf(stream, ",-%c", reg);
|
*ptr++ = ',';
|
||||||
break;
|
*ptr++ = '-';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 3: /* ,--R */
|
case 3: /* ,--R */
|
||||||
fprintf(stream, ",--%c", reg);
|
*ptr++ = ',';
|
||||||
break;
|
*ptr++ = '-';
|
||||||
|
*ptr++ = '-';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 4: /* ,R */
|
case 4: /* ,R */
|
||||||
fprintf(stream, ",%c", reg);
|
*ptr++ = ',';
|
||||||
break;
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 5: /* B,R */
|
case 5: /* B,R */
|
||||||
fprintf(stream, "B,%c", reg);
|
*ptr++ = 'B';
|
||||||
break;
|
*ptr++ = ',';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 6: /* A,R */
|
case 6: /* A,R */
|
||||||
fprintf(stream, "A,%c", reg);
|
*ptr++ = 'A';
|
||||||
break;
|
*ptr++ = ',';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 8: /* n7,R */
|
case 8: /* n7,R */
|
||||||
s += 1;
|
s += 1;
|
||||||
fprintf(stream, "$%s,%c", hex8str(get_memb(addr + s - 1)), reg);
|
*ptr++ = '$';
|
||||||
break;
|
ptr = strhex2(ptr, get_memb(addr + s - 1));
|
||||||
|
*ptr++ = ',';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 9: /* n15,R */
|
case 9: /* n15,R */
|
||||||
s += 2;
|
s += 2;
|
||||||
fprintf(stream, "$%s,%c", hex16str(get_memw(addr + s - 2)), reg);
|
*ptr++ = '$';
|
||||||
break;
|
ptr = strhex4(ptr, get_memw(addr + s - 2));
|
||||||
|
*ptr++ = ',';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 11: /* D,R */
|
case 11: /* D,R */
|
||||||
fprintf(stream, "D,%c", reg);
|
*ptr++ = 'D';
|
||||||
break;
|
*ptr++ = ',';
|
||||||
|
*ptr++ = reg;
|
||||||
|
break;
|
||||||
case 12: /* n7,PCR */
|
case 12: /* n7,PCR */
|
||||||
s += 1;
|
s += 1;
|
||||||
fprintf(stream, "$%s,PCR", hex8str(get_memb(addr + s - 1)));
|
*ptr++ = '$';
|
||||||
break;
|
ptr = strhex2(ptr, get_memb(addr + s - 1));
|
||||||
|
*ptr++ = ',';
|
||||||
|
*ptr++ = 'P';
|
||||||
|
*ptr++ = 'C';
|
||||||
|
*ptr++ = 'R';
|
||||||
|
break;
|
||||||
case 13: /* n15,PCR */
|
case 13: /* n15,PCR */
|
||||||
s += 2;
|
s += 2;
|
||||||
fprintf(stream, "$%s,PCR", hex16str(get_memw(addr + s - 2)));
|
*ptr++ = '$';
|
||||||
break;
|
ptr = strhex4(ptr, get_memw(addr + s - 2));
|
||||||
|
*ptr++ = ',';
|
||||||
|
*ptr++ = 'P';
|
||||||
|
*ptr++ = 'C';
|
||||||
|
*ptr++ = 'R';
|
||||||
|
break;
|
||||||
case 15: /* [n] */
|
case 15: /* [n] */
|
||||||
s += 2;
|
s += 2;
|
||||||
fprintf(stream, "$%s", hex16str(get_memw(addr + s - 2)));
|
*ptr++ = '$';
|
||||||
break;
|
ptr = strhex4(ptr, get_memw(addr + s - 2));
|
||||||
|
break;
|
||||||
default:
|
default:
|
||||||
fputs("??", stream);
|
*ptr++ = '?';
|
||||||
break; }
|
*ptr++ = '?';
|
||||||
if (pb & 0x10)
|
break;
|
||||||
fputc(']', stream);
|
}
|
||||||
|
if (pb & 0x10) {
|
||||||
|
*ptr++ = ']';
|
||||||
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 4: /* extended */
|
case 4: /* extended */
|
||||||
fprintf(stream, "$%s", hex16str(get_memw(addr + s - 2)));
|
*ptr++ = '$';
|
||||||
|
ptr = strhex4(ptr, get_memw(addr + s - 2));
|
||||||
break;
|
break;
|
||||||
case 5: /* inherent */
|
case 5: /* inherent */
|
||||||
pb = get_memb(addr + 1);
|
pb = get_memb(addr + 1);
|
||||||
switch (d) {
|
switch (d) {
|
||||||
case 0x1e: case 0x1f: /* exg tfr */
|
case 0x1e: case 0x1f: /* exg tfr */
|
||||||
fprintf(stream, "%s,%s", exgi[(pb >> 4) & 0x0f], exgi[pb & 0x0f]);
|
ptr = strinsert(ptr, exgi[(pb >> 4) & 0x0f]);
|
||||||
|
*ptr++ = ',';
|
||||||
|
ptr = strinsert(ptr, exgi[pb & 0x0f]);
|
||||||
break;
|
break;
|
||||||
case 0x1a: case 0x1c: case 0x3c: /* orcc andcc cwai */
|
case 0x1a: case 0x1c: case 0x3c: /* orcc andcc cwai */
|
||||||
fprintf(stream, "#$%s=%s", hex8str(pb), ccstr(pb));
|
*ptr++ = '#';
|
||||||
|
*ptr++ = '$';
|
||||||
|
ptr = strhex2(ptr, pb);
|
||||||
|
*ptr++ = '=';
|
||||||
|
ptr = strcc(ptr, pb);
|
||||||
break;
|
break;
|
||||||
case 0x34: /* pshs */
|
case 0x34: /* pshs */
|
||||||
{
|
{
|
||||||
int p = 0;
|
int p = 0;
|
||||||
|
for (i = 0; i < 8; i++) {
|
||||||
for (i = 0; i < 8; i++) {
|
if (pb & 0x80) {
|
||||||
if (pb & 0x80) {
|
if (p) {
|
||||||
if (p)
|
*ptr++ = ',';
|
||||||
fputc(',', stream);
|
}
|
||||||
fputs(pshsregi[i], stream);
|
ptr = strinsert(ptr, pshsregi[i]);
|
||||||
p = 1;
|
p = 1;
|
||||||
}
|
}
|
||||||
pb <<= 1;
|
pb <<= 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x35: /* puls */
|
case 0x35: /* puls */
|
||||||
{
|
{
|
||||||
int p = 0;
|
int p = 0;
|
||||||
|
for (i = 7; i >= 0; i--) {
|
||||||
for (i = 7; i >= 0; i--) {
|
if (pb & 0x01) {
|
||||||
if (pb & 0x01) {
|
if (p) {
|
||||||
if (p)
|
*ptr++ = ',';
|
||||||
fputc(',', stream);
|
}
|
||||||
fputs(pshsregi[i], stream);
|
ptr = strinsert(ptr, pshsregi[i]);
|
||||||
p = 1;
|
p = 1;
|
||||||
}
|
}
|
||||||
pb >>= 1;
|
pb >>= 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x36: /* pshu */
|
case 0x36: /* pshu */
|
||||||
{
|
{
|
||||||
int p = 0;
|
int p = 0;
|
||||||
|
for (i = 0; i < 8; i++) {
|
||||||
for (i = 0; i < 8; i++) {
|
if (pb & 0x80) {
|
||||||
if (pb & 0x80) {
|
if (p) {
|
||||||
if (p)
|
*ptr++ = ',';
|
||||||
fputc(',', stream);
|
}
|
||||||
fputs(pshuregi[i], stream);
|
ptr = strinsert(ptr, pshuregi[i]);
|
||||||
p = 1;
|
p = 1;
|
||||||
}
|
}
|
||||||
pb <<= 1;
|
pb <<= 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x37: /* pulu */
|
case 0x37: /* pulu */
|
||||||
{
|
{
|
||||||
int p = 0;
|
int p = 0;
|
||||||
|
for (i = 7; i >= 0; i--) {
|
||||||
for (i = 7; i >= 0; i--) {
|
if (pb & 0x01) {
|
||||||
if (pb & 0x01) {
|
if (p) {
|
||||||
if (p)
|
*ptr++ = ',';
|
||||||
fputc(',', stream);
|
}
|
||||||
fputs(pshuregi[i], stream);
|
ptr = strinsert(ptr, pshuregi[i]);
|
||||||
p = 1;
|
p = 1;
|
||||||
}
|
}
|
||||||
pb >>= 1;
|
pb >>= 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 6: /* relative */
|
case 6: /* relative */
|
||||||
{
|
{
|
||||||
tt_s16 v;
|
int16_t v;
|
||||||
|
if (s == 2) {
|
||||||
if (s == 2)
|
v = (int16_t)(int8_t)get_memb(addr + 1);
|
||||||
v = (tt_s16)(tt_s8)get_memb(addr + 1);
|
} else {
|
||||||
else
|
v = (int16_t)get_memw(addr + s - 2);
|
||||||
v = (tt_s16)get_memw(addr + s - 2);
|
}
|
||||||
fprintf(stream, "$%s", hex16str(addr + (tt_u16)s + v));
|
*ptr++ = '$';
|
||||||
break;
|
ptr = strhex4(ptr, addr + (uint16_t)s + v);
|
||||||
}
|
}
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
fputc('\n', stream);
|
|
||||||
|
|
||||||
|
// Get rid of trailing white space
|
||||||
|
while (*(--ptr) == ' ');
|
||||||
|
ptr++;
|
||||||
|
|
||||||
|
// Add a newline and terminate the string
|
||||||
|
*ptr++ = '\n';
|
||||||
|
*ptr++ = '\0';
|
||||||
|
|
||||||
|
// Log using the normal (data memory) string logger
|
||||||
|
logs(buffer);
|
||||||
|
|
||||||
|
// Return the address of the next instruction
|
||||||
return addr + s;
|
return addr + s;
|
||||||
}
|
}
|
||||||
|
|||||||
@ -10,28 +10,35 @@
|
|||||||
#define OFFSET_REG_D 44
|
#define OFFSET_REG_D 44
|
||||||
#define OFFSET_REG_CC 45
|
#define OFFSET_REG_CC 45
|
||||||
|
|
||||||
char statusString[8] = "EFHINZVC";
|
const char statusString[8] = "EFHINZVC";
|
||||||
|
|
||||||
void doCmdRegs(char *params) {
|
void doCmdRegs(char *params) {
|
||||||
int i;
|
uint16_t i;
|
||||||
unsigned int p = hwRead8(OFFSET_REG_CC);
|
uint8_t p = hwRead8(OFFSET_REG_CC);
|
||||||
log0("6809 Registers:\n A=%02X B=%02X X=%04X Y=%04X\n",
|
const char *sp = statusString;
|
||||||
hwRead8(OFFSET_REG_A),
|
logstr("6809 Registers:\n A=");
|
||||||
hwRead8(OFFSET_REG_B),
|
loghex2(hwRead8(OFFSET_REG_A));
|
||||||
hwRead16(OFFSET_REG_X),
|
logstr(" B=");
|
||||||
hwRead16(OFFSET_REG_Y));
|
loghex2(hwRead8(OFFSET_REG_B));
|
||||||
log0(" CC=%02X D=%02X U=%04X S=%04X PC=%04X\n",
|
logstr(" X=");
|
||||||
p,
|
loghex4(hwRead16(OFFSET_REG_X));
|
||||||
hwRead8(OFFSET_REG_D),
|
logstr(" Y=");
|
||||||
hwRead16(OFFSET_REG_U),
|
loghex4(hwRead16(OFFSET_REG_Y));
|
||||||
hwRead16(OFFSET_REG_S),
|
logstr("\n CC=");
|
||||||
hwRead16(OFFSET_REG_PC));
|
loghex2(p);
|
||||||
char *sp = statusString;
|
logstr(" D=");
|
||||||
log0(" Status: ");
|
loghex2(hwRead8(OFFSET_REG_D));
|
||||||
|
logstr(" U=");
|
||||||
|
loghex4(hwRead16(OFFSET_REG_U));
|
||||||
|
logstr(" S=");
|
||||||
|
loghex4(hwRead16(OFFSET_REG_S));
|
||||||
|
logstr(" PC=");
|
||||||
|
loghex4(hwRead16(OFFSET_REG_PC));
|
||||||
|
logstr("\n Status: ");
|
||||||
for (i = 0; i <= 7; i++) {
|
for (i = 0; i <= 7; i++) {
|
||||||
log0("%c", ((p & 128) ? (*sp) : '-'));
|
logc(((p & 128) ? (*sp) : '-'));
|
||||||
p <<= 1;
|
p <<= 1;
|
||||||
sp++;
|
sp++;
|
||||||
}
|
}
|
||||||
log0("\n");
|
logc('\n');
|
||||||
}
|
}
|
||||||
|
|||||||
@ -195,3 +195,10 @@ char *strint(char *buffer, int i) {
|
|||||||
char *strlong(char *buffer, long i) {
|
char *strlong(char *buffer, long i) {
|
||||||
return ltoa(i, buffer, 10);
|
return ltoa(i, buffer, 10);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
char *strinsert(char *buffer, const char *s) {
|
||||||
|
while (*s) {
|
||||||
|
*buffer++ = *s++;
|
||||||
|
}
|
||||||
|
return buffer;
|
||||||
|
}
|
||||||
|
|||||||
@ -42,6 +42,7 @@ char *strhex2(char *buffer, uint8_t i);
|
|||||||
char *strhex4(char *buffer, uint16_t i);
|
char *strhex4(char *buffer, uint16_t i);
|
||||||
char *strint(char *buffer, int i);
|
char *strint(char *buffer, int i);
|
||||||
char *strlong(char *buffer, long i);
|
char *strlong(char *buffer, long i);
|
||||||
|
char *strinsert(char *buffer, const char *s);
|
||||||
|
|
||||||
#define log0(format,...) fprintf_P(&ser0stream,PSTR(format),##__VA_ARGS__)
|
#define log0(format,...) fprintf_P(&ser0stream,PSTR(format),##__VA_ARGS__)
|
||||||
|
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user