#include "sux.h"
#include "disasm.h"
#include <string.h>
void disasm(struct sux *cpu, uint64_t *operands, uint8_t lines, uint8_t opcode, uint8_t prefix, uint8_t thread) {
uint64_t value = operands[0];
uint64_t address = operands[1];
uint64_t tmpaddr = operands[2];
char *postfix;
char *of;
char op[4];
char *sign = "";
uint8_t tmp = 0;
union reg mask;
mask.u64 = 0;
memcpy(op, opname[opcode], 3);
op[3] = 0;
switch ((1 << ((prefix >> 4) & 3))) {
case 1: postfix = ""; break;
case 2: postfix = ".W"; break;
case 4: postfix = ".D"; break;
case 8: postfix = ".Q"; break;
}
if (prefix >> 6) {
tmp = 0;
}
switch (prefix >> 6) {
default: of = ""; break;
case 1 : of = "SP"; break;
case 2 : of = "PC"; break;
}
uint8_t addrsize = 0xFF;
char *idx;
switch (optype[opcode]) {
case IND : idx = ")"; break;
case INDX: idx = ", x)"; break;
case INDY: idx = "), y"; break;
case ZMX : idx = ", x"; break;
case ZMY : idx = ", y"; break;
default : idx = ""; break;
}
if ((prefix >> 6) == 1 || (prefix >> 6) == 2) {
switch (optype[opcode]) {
case ZM :
case ZMX :
case ZMY :
case IND :
case INDX:
case INDY: addrsize = get_addrsize(prefix, ZM); break;
case ABS : addrsize = get_addrsize(prefix, ABS); break;
}
for (uint8_t i = 0; i < addrsize+1; i++) {
mask.u8[i] = (i == addrsize && addrsize != 0xFF) ? 0x7F : 0xFF;
}
switch (addrsize) {
case 0 : sign = ((int8_t )value < 0) ? "-" : "+"; break;
case 1 : sign = ((int16_t)value < 0) ? "-" : "+"; break;
case 2 :
case 3 : sign = ((int32_t)value < 0) ? "-" : "+"; break;
case 4 :
case 5 :
case 6 :
case 7 : sign = ((int64_t)value < 0) ? "-" : "+"; break;
}
}
switch (optype[opcode]) {
case BREG:
case IMPL:
wprintw(scr, "%s%s" , opname[opcode], postfix);
break;
case IMM:
switch ((1 << ((prefix >> 4) & 3))) {
case 1: wprintw(scr, "%s #$%02X" , op, value); break;
case 2: wprintw(scr, "%s%s #$%04X" , op, postfix, value); break;
case 4: wprintw(scr, "%s%s #$%08X" , op, postfix, value); break;
case 8: wprintw(scr, "%s%s #$%016"PRIX64 , op, postfix, value); break;
}
break;
case ZM:
case ZMX:
case ZMY:
if ((prefix >> 6) == 1 || (prefix >> 6) == 2) {
tmpaddr &= mask.u64;
}
switch (optype[opcode]) {
case ZMX: tmpaddr = address - cpu->x; break;
case ZMY: tmpaddr = address - cpu->y; break;
}
switch ((prefix & 0x0C) >> 2) {
case 3: wprintw(scr, "%s%s %s%s$%08" PRIX64"%s" , op, postfix, of, sign, tmpaddr, idx); break;
case 2: wprintw(scr, "%s%s %s%s$%014"PRIX64"%s" , op, postfix, of, sign, tmpaddr, idx); break;
case 1: wprintw(scr, "%s%s %s%s$%06" PRIX64"%s" , op, postfix, of, sign, tmpaddr, idx); break;
case 0: wprintw(scr, "%s%s %s%s$%02" PRIX64"%s" , op, postfix, of, sign, tmpaddr, idx); break;
}
break;
case IND:
case INDX:
case INDY:
if ((prefix >> 6) == 1 || (prefix >> 6) == 2) {
tmpaddr &= mask.u64;
}
switch ((prefix & 0x0C) >> 2) {
case 3: wprintw(scr, "%s%s (%s%s$%08" PRIX64"%s", op, postfix, of, sign, tmpaddr, idx); break;
case 2: wprintw(scr, "%s%s (%s%s$%014"PRIX64"%s", op, postfix, of, sign, tmpaddr, idx); break;
case 1: wprintw(scr, "%s%s (%s%s$%06" PRIX64"%s", op, postfix, of, sign, tmpaddr, idx); break;
case 0: wprintw(scr, "%s%s (%s%s$%02" PRIX64"%s", op, postfix, of, sign, tmpaddr, idx); break;
}
break;
case ABS:
tmpaddr = address;
if ((prefix >> 6) == 1 || (prefix >> 6) == 2) {
tmpaddr &= mask.u64;
}
switch ((prefix & 0x0C) >> 2) {
case 3: wprintw(scr, "%s%s %s%s$%016"PRIX64 , op, postfix, of, sign, tmpaddr); break;
case 2: wprintw(scr, "%s%s %s%s$%014"PRIX64 , op, postfix, of, sign, tmpaddr); break;
case 1: wprintw(scr, "%s%s %s%s$%010"PRIX64 , op, postfix, of, sign, tmpaddr); break;
case 0: wprintw(scr, "%s%s %s%s$%04" PRIX64 , op, postfix, of, sign, tmpaddr); break;
}
break;
case REL:
switch((1 << ((prefix >> 4) & 3))) {
case 1:
sign = ((int8_t)value < 0) ? "-" : "+";
wprintw(scr, "%s %s$%02X" , op, sign, value & 0x7F);
break;
case 2:
sign = ((int16_t)value < 0) ? "-" : "+";
wprintw(scr, "%s%s %s$%04X" , op, postfix, sign, value & ~(1 << 15));
break;
case 4:
sign = ((int32_t)value < 0) ? "-" : "+";
wprintw(scr, "%s%s %s$%08X" , op, postfix, sign, value & ~(1 << 31));
break;
case 8:
sign = ((int64_t)value < 0) ? "-" : "+";
wprintw(scr, "%s%s %s$%016"PRIX64 , op, postfix, sign, value & ~((uint64_t)1 << 63));
break;
}
break;
}
if (address == TX_ADDR || address == RX_ADDR) {
wmove(scr, 27, 0);
wprintw(scr, "TX_ADDR: $%02X, RX_ADDR: $%02X", addr[TX_ADDR], addr[RX_ADDR]);
}
wmove(scr, 29, 0);
wprintw(scr, "address: $%04"PRIX64, address);
if (subdbg) {
uint8_t ln = 33;
uint16_t line_idx = 0;
uint32_t tmpad = 0x31000;
int row, col;
uint8_t iscursor = 0;
union reg ptr;
uint32_t adr;
if (address == CTRL_ADDR || addr[STEP_ADDR]) {
adr = 0x30000;
wprintw(scr, ", scr_row: %02u, scr_col: %02u, scr_str: %02u, scr_end: %02u", addr[0], addr[1], addr[0x22], addr[0x23]);
wmove(scr, 32, 0);
wprintw(scr, "bitabl: ");
for (uint8_t i = 0; i < 16; i++) {
wprintw(scr, "%02X", addr[adr+i]);
}
mvwprintw(scr, ln++, 0, "buffer: ");
wmove(scr, ln++, 0);
uint8_t maxrow = 10;
int line_offset = (addr[0]-(maxrow-1) >= 0) ? addr[0]-(maxrow-1) : 0;
for (uint8_t i = 0; i < maxrow; i++) {
line_idx = (i+addr[0x22]+line_offset << 6) + (i+addr[0x22]+line_offset << 4);
for (uint8_t j = 0; j < 0x50; j++) {
wprintw(scr, "%02X", addr[tmpad+j+line_idx]);
if ((addr[0] == i+line_offset) && addr[1] == j) {
iscursor=1;
getyx(scr,row, col);
wmove(scr, ln++, 0);
wclrtoeol(scr);
wmove(scr, row+1, col-2);
wprintw(scr, "/\\");
wmove(scr, row, col);
}
}
wprintw(scr, ", i: %02X", i);
if (!iscursor) {
wmove(scr, ln, 0);
wclrtoeol(scr);
}
iscursor = 0;
wmove(scr, ln++, 0);
}
}
wmove(scr, 30, 0);
wclrtoeol(scr);
adr = 0x25;
ptr.u8[0] = addr[adr+0]; ptr.u8[1] = addr[adr+1];
ptr.u8[2] = addr[adr+2]; ptr.u8[3] = addr[adr+3];
ptr.u8[4] = addr[adr+4]; ptr.u8[5] = addr[adr+5];
ptr.u8[6] = addr[adr+6]; ptr.u8[7] = addr[adr+7];
wprintw(scr, "ptr1: $%04"PRIX64, ptr.u64);
adr = 0x2D;
ptr.u8[0] = addr[adr+0]; ptr.u8[1] = addr[adr+1];
ptr.u8[2] = addr[adr+2]; ptr.u8[3] = addr[adr+3];
ptr.u8[4] = addr[adr+4]; ptr.u8[5] = addr[adr+5];
ptr.u8[6] = addr[adr+6]; ptr.u8[7] = addr[adr+7];
wprintw(scr, ", ptr2: $%04"PRIX64, ptr.u64);
adr = 0x35;
ptr.u8[0] = addr[adr+0]; ptr.u8[1] = addr[adr+1];
ptr.u8[2] = addr[adr+2]; ptr.u8[3] = addr[adr+3];
ptr.u8[4] = addr[adr+4]; ptr.u8[5] = addr[adr+5];
ptr.u8[6] = addr[adr+6]; ptr.u8[7] = addr[adr+7];
wprintw(scr, ", ptr3: $%04"PRIX64, ptr.u64);
adr = 0x3349A;
ptr.u8[0] = addr[adr+0]; ptr.u8[1] = addr[adr+1];
ptr.u8[2] = addr[adr+2]; ptr.u8[3] = addr[adr+3];
ptr.u8[4] = addr[adr+4]; ptr.u8[5] = addr[adr+5];
ptr.u8[6] = addr[adr+6]; ptr.u8[7] = addr[adr+7];
wprintw(scr, ", idx0: $%04"PRIX64, ptr.u64);
adr = 0x334BA;
ptr.u8[0] = addr[adr+0]; ptr.u8[1] = addr[adr+1];
ptr.u8[2] = addr[adr+2]; ptr.u8[3] = addr[adr+3];
ptr.u8[4] = addr[adr+4]; ptr.u8[5] = addr[adr+5];
ptr.u8[6] = addr[adr+6]; ptr.u8[7] = addr[adr+7];
wprintw(scr, ", valbuf: $%016"PRIX64, ptr.u64);
}
}