|
#include <conio.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
|
|
#ifdef SIDMAX
|
|
unsigned char * sid = (unsigned char *) 0xd400;
|
|
unsigned char * config = (unsigned char *) 0xd4f0;
|
|
unsigned char * detect = (unsigned char *) 0xd4fc;
|
|
#define PRODUCT "Sidmax"
|
|
unsigned char col1()
|
|
{
|
|
return 0x7;
|
|
}
|
|
unsigned char col2()
|
|
{
|
|
return 0x8;
|
|
}
|
|
#define MODE_CORE 1
|
|
#define MODE_SID 2
|
|
#define MODE_POKEY 3
|
|
#define MODE_PSG 4
|
|
|
|
#define CORE_MONO 1
|
|
#define CORE_DIVIDE 2
|
|
#define CORE_RESTRICT 3
|
|
#define CORE_PHI 4
|
|
#define CORE_MAX 4
|
|
|
|
#define CORE_GTIA 101
|
|
#define CORE_OUTPUT 100
|
|
|
|
#define SID_AUTO 1
|
|
#define SID_TYPE2 2
|
|
#define SID_EXT 3
|
|
#define SID_MAX 3
|
|
|
|
#define SID_TYPE 100
|
|
|
|
#define PRESS_UP 145
|
|
#define PRESS_DOWN 17
|
|
#define PRESS_LEFT 157
|
|
#define PRESS_RIGHT 29
|
|
|
|
#else
|
|
unsigned char * pokey = (unsigned char *) 0xd200;
|
|
unsigned char * config = (unsigned char *) 0xd210;
|
|
unsigned char * detect = (unsigned char *) 0xd20c;
|
|
#define PRODUCT "Pokeymax"
|
|
unsigned char col1()
|
|
{
|
|
return 0x46;
|
|
}
|
|
unsigned char col2()
|
|
{
|
|
return 0x34;
|
|
}
|
|
#define MODE_CORE 1
|
|
#define MODE_POKEY 2
|
|
#define MODE_PSG 3
|
|
#define MODE_SID 4
|
|
|
|
#define CORE_MONO 1
|
|
#define CORE_DIVIDE 2
|
|
#define CORE_GTIA 3
|
|
#define CORE_RESTRICT 4
|
|
#define CORE_OUTPUT 5
|
|
#define CORE_PHI 6
|
|
#define CORE_ADC 7
|
|
#define CORE_SIO_DATA 8
|
|
#define CORE_MAX 8
|
|
|
|
#define SID_TYPE 1
|
|
#define SID_MAX 1
|
|
|
|
#define SID_TYPE2 100
|
|
#define SID_AUTO 101
|
|
#define SID_EXT 102
|
|
|
|
#define PRESS_UP '-'
|
|
#define PRESS_DOWN '='
|
|
#define PRESS_LEFT '+'
|
|
#define PRESS_RIGHT '*'
|
|
|
|
#endif
|
|
|
|
#define POKEY_LINEAR 1
|
|
#define POKEY_CHANNEL_MODE 2
|
|
#define POKEY_IRQ 3
|
|
#define POKEY_MAX 3
|
|
|
|
#define PSG_FREQUENCY 1
|
|
#define PSG_STEREO 2
|
|
#define PSG_ENVELOPE 3
|
|
#define PSG_VOLUME 4
|
|
#define PSG_MAX 4
|
|
unsigned char mode_maxline(unsigned char mode)
|
|
{
|
|
switch (mode)
|
|
{
|
|
case MODE_CORE:
|
|
return CORE_MAX;
|
|
case MODE_POKEY:
|
|
return POKEY_MAX;
|
|
case MODE_PSG:
|
|
return PSG_MAX;
|
|
case MODE_SID:
|
|
return SID_MAX;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
unsigned char has_flash()
|
|
{
|
|
return ((config[1]&0x40) == 0x40);
|
|
}
|
|
unsigned long readFlash(unsigned long addr, unsigned char cfgarea)
|
|
{
|
|
unsigned long res;
|
|
unsigned char al;
|
|
|
|
addr = addr<<2;
|
|
|
|
al = addr&0xff;
|
|
config[13] = al|3;
|
|
config[14] = (addr>>8)&0xff;
|
|
|
|
config[11] = (((addr>>16)&0x7)<<3)|cfgarea<<2|2|1;
|
|
|
|
res = config[15];
|
|
config[13] = al|2;
|
|
res = res<<8;
|
|
res |= config[15];
|
|
config[13] = al|1;
|
|
res = res<<8;
|
|
res |= config[15];
|
|
config[13] = al|0;
|
|
res = res<<8;
|
|
res |= config[15];
|
|
|
|
return res;
|
|
}
|
|
|
|
void writeFlash(unsigned long addr, unsigned char cfgarea, unsigned long data)
|
|
{
|
|
unsigned char al;
|
|
|
|
addr = addr<<2;
|
|
|
|
al = addr&0xff;
|
|
config[13] = al|0;
|
|
config[14] = (addr>>8)&0xff;
|
|
|
|
config[15] = data&0xff;
|
|
config[13] = al|1;
|
|
data = data>>8;
|
|
config[15] = data&0xff;
|
|
config[13] = al|2;
|
|
data = data>>8;
|
|
config[15] = data&0xff;
|
|
config[13] = al|3;
|
|
data = data>>8;
|
|
config[15] = data;
|
|
|
|
config[11] = (((addr>>16)&0x7)<<3)|cfgarea<<2|2|0;
|
|
}
|
|
|
|
//void displayFlash(
|
|
//{
|
|
// cprintf("%lx ",readFlash(config, 0x0, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x1, 0));
|
|
// cprintf("%lx ",eadFlash(config, 0x2, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x3, 0));
|
|
// cprintf("\r\n");
|
|
// cprintf("%lx ",readFlash(config, 0x2000, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x2001, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x2002, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x2003, 0));
|
|
// cprintf("\r\n");
|
|
// cprintf("%lx ",readFlash(config, 0x0, 1));
|
|
// cprintf("%lx ",readFlash(config, 0x1, 1));
|
|
// cprintf("\r\n");
|
|
// cprintf("%lx ",readFlash(config, 0x4000, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x4001, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x4002, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x4003, 0));
|
|
// cprintf("\r\n");
|
|
// cprintf("%lx ",readFlash(config, 0x6000, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x6001, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x6002, 0));
|
|
// cprintf("%lx ",readFlash(config, 0x6003, 0));
|
|
// cprintf("\r\n");
|
|
//}
|
|
|
|
void writeFlashContentsToFile()
|
|
{
|
|
FILE * output;
|
|
unsigned long addr;
|
|
unsigned long * buffer = (unsigned long *)malloc(1024);
|
|
|
|
output = fopen("d3:flash.bin","w");
|
|
for (addr=0;addr!=0xe600;addr+=256)
|
|
{
|
|
unsigned short i;
|
|
for (i=0;i!=256;++i)
|
|
buffer[i] = readFlash(addr+i,0);
|
|
fwrite(&buffer[0],1024,1,output);
|
|
}
|
|
|
|
fclose(output);
|
|
|
|
free(buffer);
|
|
}
|
|
|
|
void writeProtect(unsigned char onoff)
|
|
{
|
|
unsigned long data = readFlash(1, 1);
|
|
unsigned long mask = 0x1f;
|
|
unsigned long sectormask = 0x00700000;
|
|
unsigned long pagemask = 0x000fffff;
|
|
data = data|sectormask|pagemask; //Spurious erase fix!
|
|
mask = mask << 23;
|
|
if (onoff)
|
|
data = data|mask;
|
|
else
|
|
data = data&~mask;
|
|
writeFlash(1,1,data);
|
|
}
|
|
|
|
void flashContentsFromFile()
|
|
{
|
|
FILE * input;
|
|
unsigned int addr;
|
|
unsigned long * buffer = (unsigned long *)malloc(1024);
|
|
|
|
writeProtect(0);
|
|
|
|
input = fopen("d3:flash.bin","r");
|
|
for (addr=0;addr!=0xe600;addr+=256)
|
|
{
|
|
unsigned short i;
|
|
fread(&buffer[0],1024,1,input);
|
|
for (i=0;i!=256;++i)
|
|
writeFlash(addr+i,0,buffer[i]);
|
|
}
|
|
|
|
fclose(input);
|
|
|
|
writeProtect(1);
|
|
|
|
free(buffer);
|
|
}
|
|
|
|
int getPageSize()
|
|
{
|
|
config[4] = 5; //e.g 114M08QC
|
|
// 01234567
|
|
return config[4]=='6' ? 1024 : 512; // 16Kb for up to 10M08, then 32Kb for 10M16
|
|
}
|
|
|
|
void erasePageContainingAddress(unsigned long addr)
|
|
{
|
|
unsigned long data;
|
|
unsigned long sectormask = 0x00700000;
|
|
unsigned long pagemask = 0x000fffff;
|
|
unsigned long status;
|
|
|
|
data = readFlash(1,1);
|
|
data = data|sectormask;
|
|
data = data&~pagemask;
|
|
data = data|addr;
|
|
writeFlash(1,1,data);
|
|
|
|
for(;;)
|
|
{
|
|
status = readFlash(0,1);
|
|
if ((status&0x3)==0) break;
|
|
}
|
|
}
|
|
|
|
void eraseSector(unsigned char sector)
|
|
{
|
|
unsigned long data;
|
|
unsigned long sectormask = 0x00700000;
|
|
unsigned long pagemask = 0x000fffff;
|
|
unsigned long status;
|
|
|
|
data = readFlash(1,1);
|
|
data = data|pagemask;
|
|
data = data&~sectormask;
|
|
data = data|(((unsigned long)sector)<<20);
|
|
writeFlash(1,1,data);
|
|
|
|
for(;;)
|
|
{
|
|
status = readFlash(0,1);
|
|
if ((status&0x3)==0) break;
|
|
}
|
|
}
|
|
|
|
void renderLine(unsigned long * flash1, unsigned long * flash2, unsigned char mode, unsigned char activeLine, unsigned char line, unsigned char col)
|
|
{
|
|
unsigned char val;
|
|
unsigned char i;
|
|
|
|
gotoxy(0,line+3);
|
|
val = (*flash1)&0xff;
|
|
|
|
switch (mode)
|
|
{
|
|
case MODE_CORE: // Core
|
|
switch(line)
|
|
{
|
|
case CORE_MONO:
|
|
revers(activeLine==CORE_MONO);
|
|
cprintf("Mono support : %s",((val&16)==16) ? "Play on both channels" : "Left only");
|
|
break;
|
|
case CORE_DIVIDE:
|
|
revers(activeLine==CORE_DIVIDE);
|
|
cprintf("Post divide : ");
|
|
val = ((*flash1)>>8)&0xff;
|
|
for (i=0;i!=4;++i)
|
|
{
|
|
unsigned char pd = (val&0x3);
|
|
switch (pd)
|
|
{
|
|
case 0:
|
|
pd = 1;
|
|
break;
|
|
case 1:
|
|
pd = 2;
|
|
break;
|
|
case 2:
|
|
pd = 4;
|
|
break;
|
|
case 3:
|
|
pd = 8;
|
|
break;
|
|
}
|
|
revers(activeLine==CORE_DIVIDE && col==i);
|
|
cprintf("%d=%d ",i+1,pd);
|
|
val = val>>2;
|
|
}
|
|
break;
|
|
case CORE_GTIA:
|
|
revers(activeLine==CORE_GTIA);
|
|
cprintf("GTIA mixing : ");
|
|
val = ((*flash1)>>16)&0xff;
|
|
for (i=0;i!=4;++i)
|
|
{
|
|
unsigned char pd = (val&0x1);
|
|
revers(activeLine==CORE_GTIA && col==i);
|
|
cprintf("%d=%d ",i+1,pd);
|
|
val = val>>1;
|
|
}
|
|
break;
|
|
case CORE_RESTRICT:
|
|
revers(activeLine==CORE_RESTRICT);
|
|
val = ((*flash2)>>8)&0x1f;
|
|
cprintf("Restrict : ");
|
|
revers(activeLine==CORE_RESTRICT && col==0);
|
|
if (val&2)
|
|
cprintf("quad ");
|
|
else if (val&1)
|
|
cprintf("dual ");
|
|
else
|
|
cprintf("mono ");
|
|
revers(activeLine==CORE_RESTRICT && col==1);
|
|
if (val&4)
|
|
cprintf(" sid ");
|
|
else
|
|
cprintf("!sid ");
|
|
revers(activeLine==CORE_RESTRICT && col==2);
|
|
if (val&8)
|
|
cprintf(" psg ");
|
|
else
|
|
cprintf("!psg ");
|
|
revers(activeLine==CORE_RESTRICT && col==3);
|
|
if (val&16)
|
|
cprintf(" covox");
|
|
else
|
|
cprintf("!covox");
|
|
break;
|
|
case CORE_OUTPUT:
|
|
revers(activeLine==CORE_OUTPUT);
|
|
val = ((*flash2)>>24)&0x1f;
|
|
cprintf("Output : ");
|
|
for (i=0;i!=5;++i)
|
|
{
|
|
unsigned char pd = (val&0x1);
|
|
revers(activeLine==CORE_OUTPUT && col==i);
|
|
cprintf("%d=%d ",i+1,pd);
|
|
val = val>>1;
|
|
}
|
|
break;
|
|
case CORE_PHI:
|
|
revers(activeLine==CORE_PHI);
|
|
cprintf("PHI2->1MHz : %s",((val&32)==32) ? "PAL (5/9)" : "NTSC (4/7)");
|
|
break;
|
|
#ifndef SIDMAX
|
|
case CORE_ADC:
|
|
revers(activeLine==CORE_ADC);
|
|
val = ((*flash1)>>20)&0x3;
|
|
if (val == 3) val = 4;
|
|
cprintf("ADC volume : %dx",val);
|
|
break;
|
|
case CORE_SIO_DATA:
|
|
revers(activeLine==CORE_SIO_DATA);
|
|
val = ((*flash1)>>22)&0x3;
|
|
if (val == 3) val = 4;
|
|
cprintf("SIO DATA vol : %dx",val);
|
|
break;
|
|
#endif
|
|
}
|
|
break;
|
|
case MODE_POKEY: // pokey
|
|
switch(line)
|
|
{
|
|
case POKEY_LINEAR:
|
|
revers(activeLine==POKEY_LINEAR);
|
|
cprintf("Mixing : %s",((val&1)==1) ? "Non-linear" : "Linear");
|
|
break;
|
|
case POKEY_CHANNEL_MODE:
|
|
revers(activeLine==POKEY_CHANNEL_MODE);
|
|
cprintf("Channel mode : %s",((val&4)==4) ? "On" : "Off");
|
|
break;
|
|
case POKEY_IRQ:
|
|
revers(activeLine==POKEY_IRQ);
|
|
cprintf("IRQ : %s",((val&8)==8) ? "All pokey chips" : "Pokey 1");
|
|
break;
|
|
}
|
|
break;
|
|
case MODE_PSG: // psg
|
|
switch(line)
|
|
{
|
|
case PSG_FREQUENCY:
|
|
val = ((*flash1)>>24)&0xff;
|
|
revers(activeLine==PSG_FREQUENCY);
|
|
cprintf("PSG frequency : ");
|
|
switch (val&3)
|
|
{
|
|
case 0:
|
|
cprintf("2MHz");
|
|
break;
|
|
case 1:
|
|
cprintf("1MHz");
|
|
break;
|
|
case 2:
|
|
cprintf("PHI2");
|
|
break;
|
|
}
|
|
break;
|
|
case PSG_STEREO:
|
|
val = ((*flash1)>>24)&0xff;
|
|
revers(activeLine==PSG_STEREO);
|
|
cprintf("PSG stereo : ");
|
|
switch ((val&12)>>2)
|
|
{
|
|
case 0:
|
|
cprintf("mono (L:ABC R:ABC)");
|
|
break;
|
|
case 1:
|
|
cprintf("polish (L:AB R:BC )");
|
|
break;
|
|
case 2:
|
|
cprintf("czech (L:AC R:BC )");
|
|
break;
|
|
case 3:
|
|
cprintf("l/r (L:111 R:222)");
|
|
break;
|
|
}
|
|
break;
|
|
case PSG_ENVELOPE:
|
|
val = ((*flash1)>>24)&0xff;
|
|
revers(activeLine==PSG_ENVELOPE);
|
|
cprintf("PSG envelope : ");
|
|
if ((val&16)==16)
|
|
cprintf("16 steps");
|
|
else
|
|
cprintf("32 steps");
|
|
break;
|
|
case PSG_VOLUME:
|
|
val = ((*flash1)>>24)&0xff;
|
|
revers(activeLine==PSG_VOLUME);
|
|
cprintf("PSG volume : ");
|
|
if (((val&0x60)>>5)==3)
|
|
cprintf("Linear");
|
|
else
|
|
cprintf("Log %d",(val>>5)&3);
|
|
break;
|
|
}
|
|
break;
|
|
case MODE_SID: // SID
|
|
switch(line)
|
|
{
|
|
case SID_AUTO:
|
|
revers(activeLine==SID_AUTO);
|
|
val = ((*flash2)>>16)&0x10;
|
|
cprintf("SID detect : ");
|
|
revers(activeLine==SID_AUTO);
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("Manual ");
|
|
break;
|
|
case 0x10:
|
|
cprintf("Auto ");
|
|
break;
|
|
}
|
|
|
|
break;
|
|
case SID_TYPE:
|
|
revers(activeLine==SID_TYPE);
|
|
val = (*flash2)&0x3;
|
|
cprintf("SID version : ");
|
|
revers(activeLine==SID_TYPE && col==0);
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("1:8580 ");
|
|
break;
|
|
case 1:
|
|
cprintf("1:6581 ");
|
|
break;
|
|
case 2:
|
|
cprintf("1:8580Digi ");
|
|
break;
|
|
}
|
|
revers(activeLine==SID_TYPE && col==1);
|
|
val = (*flash2)&0x30;
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("2:8580 ");
|
|
break;
|
|
case 0x10:
|
|
cprintf("2:6581 ");
|
|
break;
|
|
case 0x20:
|
|
cprintf("2:8580Digi ");
|
|
break;
|
|
}
|
|
break;
|
|
case SID_TYPE2:
|
|
revers(activeLine==SID_TYPE2);
|
|
val = (*flash2)&0x1;
|
|
cprintf("SID version : ");
|
|
revers(activeLine==SID_TYPE2 && col==0);
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("1:8580 ");
|
|
break;
|
|
case 1:
|
|
cprintf("1:6581 ");
|
|
break;
|
|
}
|
|
revers(activeLine==SID_TYPE2 && col==1);
|
|
val = (*flash2)&0x10;
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("2:8580 ");
|
|
break;
|
|
case 0x10:
|
|
cprintf("2:6581 ");
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case SID_EXT:
|
|
revers(activeLine==SID_EXT);
|
|
val = ((*flash2)>>16)&0x3;
|
|
cprintf("SID ext : ");
|
|
revers(activeLine==SID_EXT && col==0);
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("1:GND ");
|
|
break;
|
|
case 1:
|
|
cprintf("1:Digifix ");
|
|
break;
|
|
case 2:
|
|
cprintf("1:ADC ");
|
|
break;
|
|
}
|
|
revers(activeLine==SID_EXT && col==1);
|
|
val = ((*flash2)>>16)&0xc;
|
|
switch(val)
|
|
{
|
|
case 0:
|
|
cprintf("2:GND ");
|
|
break;
|
|
case 0x4:
|
|
cprintf("2:Digifix ");
|
|
break;
|
|
case 0x8:
|
|
cprintf("2:ADC ");
|
|
break;
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
revers(0);
|
|
*flash2; // silence warning
|
|
}
|
|
|
|
|
|
void render(unsigned long * flash1, unsigned long * flash2, unsigned char mode, unsigned char activeLine, unsigned char line, unsigned char col)
|
|
{
|
|
unsigned char pokeys;
|
|
unsigned char val;
|
|
unsigned char i;
|
|
#ifndef SIDMAX
|
|
unsigned char prev559;
|
|
#endif
|
|
if (line ==255)
|
|
{
|
|
#ifndef SIDMAX
|
|
prev559 = *(unsigned char *)559;
|
|
*(unsigned char *)559 = 0;
|
|
#endif
|
|
clrscr();
|
|
//textcolor(0xa);
|
|
chline(40);
|
|
cprintf(PRODUCT " config v1.5 ");
|
|
cprintf(" Core:");
|
|
for (i=0;i!=8;++i)
|
|
{
|
|
config[4] = i;
|
|
cprintf("%c",config[4]);
|
|
}
|
|
gotoxy(0,3);
|
|
chline(40);
|
|
|
|
gotoxy(0,17);
|
|
chline(40);
|
|
cprintf(" (A)pply config\r\n");
|
|
if (has_flash())
|
|
{
|
|
cprintf(" (S)tore config\r\n");
|
|
cprintf(" (U)pdate core/ (V)erify core\r\n");
|
|
}
|
|
cprintf(" (Q)uit\r\n");
|
|
cprintf("Use arrows and enter to change config\r\n");
|
|
cprintf("Press space to change section\r\n");
|
|
}
|
|
gotoxy(0,2);
|
|
|
|
val = ((*flash2)>>8)&0x1f;
|
|
config[7] = val;
|
|
val = config[1];
|
|
pokeys = val&0x3;
|
|
switch (pokeys)
|
|
{
|
|
case 0:
|
|
pokeys = 1;
|
|
break;
|
|
case 1:
|
|
pokeys = 2;
|
|
break;
|
|
case 2:
|
|
pokeys = 4;
|
|
break;
|
|
case 3:
|
|
pokeys = 4;
|
|
break;
|
|
}
|
|
#ifdef SIDMAX
|
|
cprintf("Sid:%d pokey:%d psg:%d covox:%d sample:%d",(val&4)==4 ? 2 : 0,pokeys,(val&8)==8 ? 2 : 0,(val&16)==16 ? 1 : 0,(val&32)==32 ? 1 : 0);
|
|
#else
|
|
cprintf("Pokey:%d sid:%d psg:%d covox:%d sample:%d",pokeys,(val&4)==4 ? 2 : 0,(val&8)==8 ? 2 : 0,(val&16)==16 ? 1 : 0,(val&32)==32 ? 1 : 0);
|
|
#endif
|
|
|
|
if (line>=254)
|
|
{
|
|
unsigned char maxline = mode_maxline(mode);
|
|
for (line=1;line<=maxline;++line)
|
|
renderLine(flash1,flash2,mode,activeLine, line,col);
|
|
#ifndef SIDMAX
|
|
*(unsigned char *)559 = prev559;
|
|
#endif
|
|
}
|
|
else
|
|
{
|
|
renderLine(flash1,flash2,mode,activeLine, line,col);
|
|
if (wherex()>15)
|
|
cclear(40-wherex());
|
|
}
|
|
}
|
|
|
|
void changeValue(unsigned long * flash1, unsigned long * flash2, unsigned char mode, unsigned char line, unsigned char col)
|
|
{
|
|
unsigned char shift;
|
|
unsigned char mask=1;
|
|
unsigned char max=1;
|
|
|
|
unsigned char val;
|
|
unsigned long tmp;
|
|
|
|
unsigned long * flashaddr = flash1;
|
|
|
|
switch(mode)
|
|
{
|
|
case MODE_CORE:
|
|
switch(line)
|
|
{
|
|
case CORE_MONO:
|
|
shift = 4;
|
|
break;
|
|
case CORE_DIVIDE:
|
|
shift = 8 + (col<<1);
|
|
mask = 3;
|
|
max = 3;
|
|
break;
|
|
case CORE_GTIA:
|
|
shift = 16 + col;
|
|
break;
|
|
case CORE_RESTRICT:
|
|
flashaddr = flash2;
|
|
if (col==0)
|
|
{
|
|
mask = 3;
|
|
shift = 8;
|
|
max = 2;
|
|
}
|
|
else
|
|
{
|
|
mask = 1;
|
|
shift = 9 + col;
|
|
max = 1;
|
|
}
|
|
break;
|
|
case CORE_OUTPUT:
|
|
flashaddr = flash2;
|
|
shift = 24 + col;
|
|
break;
|
|
case CORE_PHI:
|
|
shift = 5;
|
|
break;
|
|
case CORE_ADC:
|
|
shift = 20;
|
|
mask = 3;
|
|
max = 3;
|
|
break;
|
|
case CORE_SIO_DATA:
|
|
shift = 22;
|
|
mask = 3;
|
|
max = 3;
|
|
break;
|
|
}
|
|
break;
|
|
case MODE_POKEY:
|
|
switch(line)
|
|
{
|
|
case POKEY_LINEAR:
|
|
shift = 0;
|
|
break;
|
|
case POKEY_CHANNEL_MODE:
|
|
shift = 2;
|
|
break;
|
|
case POKEY_IRQ:
|
|
shift = 3;
|
|
break;
|
|
}
|
|
break;
|
|
case MODE_PSG:
|
|
switch(line)
|
|
{
|
|
case PSG_FREQUENCY:
|
|
mask = 3;
|
|
shift = 24;
|
|
max = 2;
|
|
break;
|
|
case PSG_STEREO:
|
|
mask = 3;
|
|
shift = 26;
|
|
max = 3;
|
|
break;
|
|
case PSG_ENVELOPE:
|
|
shift = 28;
|
|
break;
|
|
case PSG_VOLUME:
|
|
mask = 3;
|
|
shift = 29;
|
|
max = 3;
|
|
break;
|
|
}
|
|
break;
|
|
case MODE_SID:
|
|
switch(line)
|
|
{
|
|
case SID_AUTO:
|
|
flashaddr = flash2;
|
|
mask = 1;
|
|
shift = 20;
|
|
max = 1;
|
|
break;
|
|
case SID_TYPE:
|
|
flashaddr = flash2;
|
|
mask = 3;
|
|
shift = 0 + (col<<2);
|
|
max = 2;
|
|
break;
|
|
case SID_TYPE2:
|
|
flashaddr = flash2;
|
|
mask = 1;
|
|
shift = 0 + (col<<2);
|
|
max = 1;
|
|
break;
|
|
case SID_EXT:
|
|
flashaddr = flash2;
|
|
mask = 3;
|
|
shift = 16 + (col<<1);
|
|
max = 2;
|
|
break;
|
|
}
|
|
break;
|
|
}
|
|
|
|
tmp = mask;
|
|
tmp = tmp<<shift;
|
|
val = ((*flashaddr)&tmp)>>shift;
|
|
*flashaddr = (*flashaddr)&~tmp;
|
|
val = val+1;
|
|
if (val>max) val=0;
|
|
tmp = val;
|
|
tmp = tmp<<shift;
|
|
*flashaddr |= tmp;
|
|
}
|
|
|
|
void applyConfig(unsigned long flash1, unsigned long flash2)
|
|
{
|
|
clrscr();
|
|
bgcolor(col1());
|
|
//textcolor(0xa);
|
|
chline(40);
|
|
cprintf("Applying config\r\n");
|
|
chline(40);
|
|
|
|
cprintf("Press Y to confirm\r\n");
|
|
while(!kbhit());
|
|
if (cgetc()=='y')
|
|
{
|
|
config[0] = flash1&0xff;
|
|
config[2] = (flash1>>8)&0xff;
|
|
config[3] = (flash1>>16)&0xff;
|
|
config[5] = (flash1>>24)&0xff;
|
|
|
|
config[6] = flash2&0xff;
|
|
config[7] = (flash2>>8)&0xff;
|
|
config[8] = (flash2>>16)&0xff;
|
|
config[9] = (flash2>>24)&0xff;
|
|
// SATURATE_NEXT <= flash_do(0);
|
|
// -- 1 reserved...
|
|
// CHANNEL_MODE_NEXT <= flash_do(2);
|
|
// IRQ_EN_NEXT <= flash_do(3);
|
|
// DETECT_RIGHT_NEXT <= flash_do(4);
|
|
// -- 5-7 reserved
|
|
// POST_DIVIDE_NEXT <= flash_do(15 downto 8);
|
|
// GTIA_ENABLE_NEXT <= flash_do(19 downto 16);
|
|
// ADC_VOLUME_NEXT <= flash_do_slow(21 downto 20);
|
|
// SIO_DATA_VOLUME_NEXT <= flash_do_slow(23 downto 22);
|
|
// PSG_FREQ_NEXT <= flash_do(25 downto 24);
|
|
// PSG_STEREOMODE_NEXT <= flash_do(27 downto 26);
|
|
// PSG_ENVELOPE16_NEXT <= flash_do(28);
|
|
// -- 31 downto 29 reserved
|
|
}
|
|
|
|
bgcolor(0x00);
|
|
}
|
|
|
|
void saveConfig(unsigned long flash1, unsigned long flash2)
|
|
{
|
|
clrscr();
|
|
bgcolor(col1());
|
|
//textcolor(0xa);
|
|
chline(40);
|
|
cprintf("Saving config\r\n");
|
|
cprintf("NB: this does not apply now!\r\n");
|
|
chline(40);
|
|
|
|
cprintf("Press Y to confirm\r\n");
|
|
while(!kbhit());
|
|
if (cgetc()=='y')
|
|
{
|
|
unsigned int pagesize = getPageSize();
|
|
unsigned long * buffer = (unsigned long *)malloc(pagesize*4);
|
|
unsigned short i = 0;
|
|
unsigned int failCount = 0;
|
|
|
|
cprintf("Backing up page\r\n");
|
|
for (i=2;i!=pagesize;++i)
|
|
{
|
|
buffer[i] = readFlash(i,0);
|
|
}
|
|
writeProtect(0);
|
|
while (1)
|
|
{
|
|
unsigned char failed = 0;
|
|
|
|
cprintf("Erasing page\r\n");
|
|
erasePageContainingAddress(0);
|
|
cprintf("Writing\r\n");
|
|
buffer[0] = flash1;
|
|
buffer[1] = flash2;
|
|
for (i=0;i!=pagesize;++i)
|
|
{
|
|
writeFlash(i,0,buffer[i]);
|
|
}
|
|
|
|
cprintf("Verifying\r\n");
|
|
for (i=0;i!=pagesize;++i)
|
|
{
|
|
unsigned long val = readFlash(i,0);
|
|
if (val!=buffer[i])
|
|
{
|
|
cprintf("Verify failed at %04x\r\n",i);
|
|
cprintf("read:%08x\r\n",val);
|
|
cprintf("buffer:%08x\r\n",buffer[i]);
|
|
failed = 1;
|
|
break;
|
|
}
|
|
}
|
|
if (failed)
|
|
{
|
|
cprintf("Verify FAILED\r\n");
|
|
cprintf("Press key to retry or q to give up\r\n");
|
|
while(!kbhit());
|
|
if (cgetc()=='q')
|
|
break;
|
|
}
|
|
else
|
|
{
|
|
cprintf("Verify pass\r\n");
|
|
cprintf("Press key to continue\r\n");
|
|
while(!kbhit());
|
|
cgetc();
|
|
break;
|
|
}
|
|
}
|
|
writeProtect(1);
|
|
|
|
free(buffer);
|
|
}
|
|
|
|
bgcolor(0x00);
|
|
}
|
|
|
|
void updateCore()
|
|
{
|
|
unsigned long flash1 = readFlash(0,0);
|
|
unsigned long flash2 = readFlash(1,0); //unused for now
|
|
#ifdef SIDMAX
|
|
char filename[] = "core.bin";
|
|
#else
|
|
char filename[] = "d4:core.bin";
|
|
#endif
|
|
|
|
clrscr();
|
|
bgcolor(col2());
|
|
//textcolor(0xa);
|
|
chline(40);
|
|
cprintf("Updating core\r\n");
|
|
chline(40);
|
|
|
|
#ifdef SIDMAX
|
|
cprintf("Please insert core.bin into drive\r\n");
|
|
#else
|
|
cprintf("Please insert core.bin into D4\r\n");
|
|
#endif
|
|
cprintf("Press Y to confirm core update\r\n");
|
|
while(!kbhit());
|
|
if (cgetc()=='y')
|
|
{
|
|
FILE * input = fopen(filename,"rb");
|
|
if (!input)
|
|
{
|
|
cprintf("Failed to open %s!\r\n",filename);
|
|
sleep(3);
|
|
}
|
|
else
|
|
{
|
|
unsigned char version[8];
|
|
unsigned char valid;
|
|
unsigned char i,j;
|
|
|
|
cprintf("\r\n");
|
|
chline(40);
|
|
cprintf("DO NOT TURN OFF THE COMPUTER\r\n");
|
|
chline(40);
|
|
cprintf("\r\n");
|
|
|
|
cprintf("File opened\r\n");
|
|
fread(&version[0],8,1,input);
|
|
// Verify validity!
|
|
valid = 1;
|
|
for (i=3;i!=8;++i)
|
|
{
|
|
config[4] = i;
|
|
if (config[4]!=version[i])
|
|
{
|
|
valid = 0;
|
|
|
|
cprintf("Invalid core\r\n");
|
|
cprintf("Current:");
|
|
for (j=0;j!=8;++j)
|
|
{
|
|
config[4] = j;
|
|
cprintf("%c",config[4]);
|
|
}
|
|
cprintf("\r\nFile :");
|
|
for (j=0;j!=8;++j)
|
|
cprintf("%c",version[j]);
|
|
|
|
config[4] = 5;
|
|
if (config[4] == version[5])
|
|
{
|
|
cprintf("\r\nPress any key to quit or f to force\r\n");
|
|
if (cgetc()=='f')
|
|
{
|
|
cprintf("FORCED!\r\n");
|
|
cprintf("You may need to change wiring!\r\n");
|
|
valid = 1;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
cprintf("\r\nCore is for a different FPGA!\r\n");
|
|
cprintf("Press any key to quit\r\n");
|
|
cgetc();
|
|
}
|
|
|
|
break;
|
|
}
|
|
}
|
|
if (valid)
|
|
{
|
|
//fseek(input,0,SEEK_SET);
|
|
fclose(input);
|
|
input = fopen(filename,"r");
|
|
|
|
cprintf("Erasing");
|
|
writeProtect(0);
|
|
eraseSector(1);
|
|
cputc('.');
|
|
writeProtect(0);
|
|
eraseSector(2);
|
|
cputc('.');
|
|
writeProtect(0);
|
|
eraseSector(3);
|
|
cputc('.');
|
|
writeProtect(0);
|
|
eraseSector(4);
|
|
cprintf(" Done\r\n");
|
|
|
|
config[4] = 5; //e.g 114M08QC
|
|
// 01234567
|
|
j = config[4];
|
|
config[4] = 4;
|
|
cprintf("Flashing M%c%c... please wait",config[4],j);
|
|
writeProtect(0);
|
|
{
|
|
unsigned long addr;
|
|
unsigned long maxaddr;
|
|
unsigned long * buffer = (unsigned long *)malloc(1024);
|
|
unsigned char t=0;
|
|
|
|
config[4] = 5;
|
|
maxaddr = config[4]=='4' ? 0xd600 : config[4]=='8' ? 0xe600 : 0x19800; // d600 for m04, e600 for m08. Default to 08 so DEVELPR works
|
|
|
|
for (addr=0;addr!=maxaddr;addr+=256)
|
|
{
|
|
unsigned long i;
|
|
gotoxy(0,20);
|
|
cprintf("%c %d/%d ",(t ? '/' : '\\'),(unsigned short)(1+(addr>>8)),(unsigned short)(maxaddr>>8));
|
|
t = !t;
|
|
|
|
i = fread(&buffer[0],1024,1,input);
|
|
if (i!=1)
|
|
{
|
|
cprintf("\r\nError reading disk!\r\n");
|
|
cprintf("Press key then START AGAIN!\r\n");
|
|
fclose(input);
|
|
|
|
writeProtect(1);
|
|
while(!kbhit());
|
|
return;
|
|
}
|
|
if (addr==0)
|
|
{
|
|
// keep our config...
|
|
buffer[0] = flash1;
|
|
buffer[1] = flash2;
|
|
}
|
|
for (i=0;i!=256;++i)
|
|
{
|
|
if (buffer[i]!=0xffffffff)
|
|
{
|
|
bordercolor(i);
|
|
writeFlash(addr+i,0,buffer[i]);
|
|
}
|
|
}
|
|
}
|
|
|
|
writeProtect(1);
|
|
|
|
free(buffer);
|
|
}
|
|
}
|
|
}
|
|
fclose(input);
|
|
}
|
|
bgcolor(0x00);
|
|
bordercolor(0x00);
|
|
|
|
//writeFlashContentsToFile();
|
|
}
|
|
|
|
void verifyCore()
|
|
{
|
|
unsigned long flash1 = readFlash(0,0);
|
|
unsigned long flash2 = readFlash(1,0); //unused for now
|
|
#ifdef SIDMAX
|
|
char filename[] = "core.bin";
|
|
#else
|
|
char filename[] = "d4:core.bin";
|
|
#endif
|
|
|
|
clrscr();
|
|
bgcolor(col2());
|
|
//textcolor(0xa);
|
|
chline(40);
|
|
cprintf("Verifying core\r\n");
|
|
chline(40);
|
|
|
|
#ifdef SIDMAX
|
|
cprintf("Please insert core.bin into drive\r\n");
|
|
#else
|
|
cprintf("Please insert core.bin into D4\r\n");
|
|
#endif
|
|
cprintf("Press Y to confirm core verify\r\n");
|
|
while(!kbhit());
|
|
if (cgetc()=='y')
|
|
{
|
|
FILE * input = fopen(filename,"rb");
|
|
int j;
|
|
unsigned long addr;
|
|
unsigned long maxaddr;
|
|
unsigned long * buffer = (unsigned long *)malloc(1024);
|
|
unsigned char t=0;
|
|
if (!input)
|
|
{
|
|
cprintf("Failed to open file!\r\n");
|
|
sleep(3);
|
|
}
|
|
//fseek(input,0,SEEK_SET);
|
|
fclose(input);
|
|
input = fopen(filename,"r");
|
|
|
|
config[4] = 5; //e.g 114M08QC
|
|
// 01234567
|
|
j = config[4];
|
|
config[4] = 4;
|
|
cprintf("Verifying M%c%c... please wait",config[4],j);
|
|
|
|
config[4] = 5;
|
|
maxaddr = config[4]=='4' ? 0xd600 : config[4]=='8' ? 0xe600 : 0x19800; // d600 for m04, e600 for m08. Default to 08 so DEVELPR works
|
|
|
|
for (addr=0;addr!=maxaddr;addr+=256)
|
|
{
|
|
unsigned long i;
|
|
gotoxy(0,20);
|
|
cprintf("%c %d/%d ",(t ? '/' : '\\'),(unsigned short)(1+(addr>>8)),(unsigned short)(maxaddr>>8));
|
|
t = !t;
|
|
|
|
i = fread(&buffer[0],1024,1,input);
|
|
if (i!=1)
|
|
{
|
|
cprintf("\r\nError reading disk!\r\n");
|
|
cprintf("Press key then START AGAIN!\r\n");
|
|
fclose(input);
|
|
|
|
while(!kbhit());
|
|
bgcolor(0x00);
|
|
bordercolor(0x00);
|
|
return;
|
|
}
|
|
if (addr==0)
|
|
{
|
|
// keep our config...
|
|
buffer[0] = flash1;
|
|
buffer[1] = flash2;
|
|
}
|
|
for (i=0;i!=256;++i)
|
|
{
|
|
unsigned long val;
|
|
bordercolor(i);
|
|
val = readFlash(addr+i,0);
|
|
if (val!=buffer[i])
|
|
{
|
|
cprintf("\r\nError at address %08lx\r\n",addr+i);
|
|
cprintf("disk:%08lx flash:%08lx\r\n",buffer[i],val);
|
|
cprintf("Press key to continue\r\n");
|
|
fclose(input);
|
|
|
|
while(!kbhit());
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
free(buffer);
|
|
fclose(input);
|
|
}
|
|
bgcolor(0x00);
|
|
bordercolor(0x00);
|
|
|
|
//writeFlashContentsToFile();
|
|
}
|
|
|
|
int main (void)
|
|
{
|
|
unsigned int i;
|
|
unsigned char prevline,line,col,quit;
|
|
unsigned long flash1;
|
|
unsigned long flash2;
|
|
unsigned char origbg;
|
|
unsigned char origbord;
|
|
unsigned char mode = 1;
|
|
if (*detect != 1)
|
|
{
|
|
cprintf(PRODUCT " not found!");
|
|
sleep(5);
|
|
return -1;
|
|
}
|
|
origbg = bgcolor(0);
|
|
origbord = bordercolor(0);
|
|
|
|
*detect = 0x3f; // select config area
|
|
|
|
// We have just 8 bytes of data for config
|
|
flash1 = 0; //readFlash(0,0);
|
|
flash2 = 0; //readFlash(1,0); //unused for now
|
|
|
|
flash1 =
|
|
(((unsigned long)config[5])<<24) |
|
|
(((unsigned long)config[3])<<16) |
|
|
(((unsigned long)config[2])<<8) |
|
|
(((unsigned long)config[0]));
|
|
flash2 =
|
|
(((unsigned long) config[9])<<24) |
|
|
(((unsigned long) config[7])<<8) |
|
|
((unsigned long) config[6]);
|
|
|
|
prevline = 255;
|
|
line = 1;
|
|
col = 0;
|
|
quit = 0;
|
|
|
|
while (!quit)
|
|
{
|
|
unsigned max_line = mode_maxline(mode);
|
|
render(&flash1,&flash2,mode,line,prevline,col);
|
|
render(&flash1,&flash2,mode,line,line,col);
|
|
|
|
prevline=line;
|
|
|
|
while (!kbhit());
|
|
switch (cgetc())
|
|
{
|
|
case ' ':
|
|
mode = mode+1;
|
|
if (mode==5) mode = 1;
|
|
line = 1;
|
|
col = 0;
|
|
prevline=255;
|
|
break;
|
|
case PRESS_UP:
|
|
if (line>1)
|
|
line = line-1;
|
|
col = 0;
|
|
break;
|
|
case PRESS_DOWN:
|
|
if (line<max_line)
|
|
line = line+1;
|
|
col = 0;
|
|
break;
|
|
case PRESS_LEFT:
|
|
if (col>0)
|
|
col =col-1;
|
|
break;
|
|
case PRESS_RIGHT:
|
|
col =col+1;
|
|
if (mode==4 && line==SID_TYPE)
|
|
{
|
|
if (col>1)
|
|
col =1;
|
|
}
|
|
else if (mode==1 && line==CORE_OUTPUT)
|
|
{
|
|
if (col>4)
|
|
col =4;
|
|
}
|
|
else
|
|
{
|
|
if (col>3)
|
|
col =3;
|
|
}
|
|
break;
|
|
case CH_ENTER:
|
|
changeValue(&flash1,&flash2,mode,line,col);
|
|
break;
|
|
case 'a':
|
|
// Apply config
|
|
applyConfig(flash1,flash2);
|
|
prevline = 255;
|
|
break;
|
|
case 's':
|
|
// Save config
|
|
if (has_flash()) saveConfig(flash1,flash2);
|
|
prevline = 255;
|
|
break;
|
|
case 'u':
|
|
// Update core
|
|
if (has_flash()) updateCore();
|
|
prevline = 255;
|
|
break;
|
|
case 'v':
|
|
// Verify core
|
|
if (has_flash()) verifyCore();
|
|
prevline = 255;
|
|
break;
|
|
case 'q':
|
|
clrscr();
|
|
quit = 1;
|
|
break;
|
|
case 'x':
|
|
clrscr();
|
|
cprintf("Hex dump of flash from 0x400\r\n");
|
|
for (i=0;i!=64;++i)
|
|
{
|
|
unsigned long val = readFlash(i+0x400, 0);
|
|
cprintf("%08lx",val);
|
|
}
|
|
while (!kbhit());
|
|
prevline = 255;
|
|
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* displayFlash(config);
|
|
//writeFlashContentsToFile(config);
|
|
//erasePageContainingAddress(config,0x0);
|
|
eraseSector(config,1);
|
|
eraseSector(config,2);
|
|
eraseSector(config,3);
|
|
eraseSector(config,4);
|
|
displayFlash(config);
|
|
flashContentsFromFile(config);
|
|
displayFlash(config);*/
|
|
|
|
*detect = 0x0; // deselect config area
|
|
bgcolor(origbg);
|
|
bordercolor(origbord);
|
|
return EXIT_SUCCESS;
|
|
}
|
|
|
|
|