MCUME/MCUME_teensy41/teensy64/c64.cpp

425 wiersze
14 KiB
C++

extern "C" {
#include "emuapi.h"
#include "platform_config.h"
}
#include "Teensy64.h"
#include <string.h>
#ifdef HAS_SND
#include "reSID.h"
AudioPlaySID playSID;
#endif
using namespace std;
/* IRAM_ATTR */
static void oneRasterLine(void) {
static unsigned short lc = 1;
while (true) {
cpu.lineStartTime = ARM_DWT_CYCCNT;
cpu.lineCycles = cpu.lineCyclesAbs = 0;
if (!cpu.exactTiming) {
vic_do();
} else {
vic_do_simple();
}
if (--lc == 0) {
lc = LINEFREQ / 10; // 10Hz
cia1_checkRTCAlarm();
cia2_checkRTCAlarm();
}
//Switch "ExactTiming" Mode off after a while:
if (!cpu.exactTiming) break;
if (ARM_DWT_CYCCNT - cpu.exactTimingStartTime >= EXACTTIMINGDURATION * (F_CPU / 1000)) {
cpu_disableExactTiming();
break;
}
};
}
/*
const uint32_t ascii2scanvic20[] = {
//0 1 2 3 4 5 6 7 8 9 A B C D E F
0,0,0,0,0,0,0,0,0,0,0xfd7f,0,0,0xfd7f,0,0, // return
// 31:RUNSTOP
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xf7fe,
//sp ! " # $ % & ' ( ) * + , - . /
0xeffe ,0x1fefe,0x17ffe,0x1fe02,0x17ffd,0x1fefb,0x17ffb,0x1fef7,0x17ff7,0x1feef,0xfdbf ,0xfedf ,0xf7df ,0x7fDf ,0xefdf ,0xf7bf,
//0 1 2 3 4 5 6 7 8 9 : ; < = > ?
0x7fef ,0xfefe ,0x7ffe ,0xfefd ,0x7ffd ,0xfefb ,0x7ffb ,0xfef7 ,0x7ff7 ,0xfeef ,0xdfdf ,0xfbbf ,0x1f7df,0xdfbf ,0x1efdf,0x1f7bf,
//@ A B C D E F G H I J K L M N O
0xbfdf ,0xfbfd ,0xeff7 ,0xeffb ,0xfbfb ,0xbffd ,0xdffb ,0xfbf7 ,0xdff7 ,0xfdef ,0xfbef ,0xdfef ,0xfbdf ,0xefef ,0xf7ef ,0xbfef,
//P Q R S T U V W X Y Z [ \ ] ^ _
0xfddf ,0xbffe ,0xfdfb ,0xdffd ,0xbffb ,0xbff7 ,0xf7f7 ,0xfdfd ,0xf7fb ,0xfdf7 ,0xeffd ,0x1dfdf,0xffff ,0x1fbbf,0 ,0,
//' a c c d e f g h i j k l m n o
0 ,0xfbfd ,0xeff7 ,0xeffb ,0xfbfb ,0xbffd ,0xdffb ,0xfbf7 ,0xdff7 ,0xfdef ,0xfbef ,0xdfef ,0xfbdf ,0xefef ,0xf7ef ,0xbfef,
//p q r s t u v w x y z { | } ~ DEL
0xfddf ,0xbffe ,0xfdfb ,0xdffd ,0xbffb ,0xbff7 ,0xf7f7 ,0xfdfd ,0xf7fb ,0xfdf7 ,0xeffd ,0, 0 , 0, 0xfe7f ,0x1fb7f,
// 129:f1 f2 f3 f4 f5 f6 f7 f8
0,0xef7f,0x1ef7f,0xdf7f,0x1df7f,0xbf7f,0x1bf7f,0x7f7f,0x17f7f,0,0,0,0,0,0,0, // 128-143
// 150:right left down up
0,0,0,0,0,0, 0xfb7f,0x1fb7f,0xf77f,0x1f77f,0,0,0,0,0,0 // 144-159
};
*/
const uint32_t ascii2scan[] = {
//0 1 2 3 4 5 6 7 8 9 A B C D E F
0,0,0,0,0,0,0,0,0,0,0x28,0,0,0x28,0,0, // 0x0A: return
0x00,0x0,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00, //31:RUNSTOP
//sp ! " # $ % & ' ( ) * + , - . /
0x2c,0x201e,0x201f,0x2020,0x2021,0x2022,0x2023,0x2024,0x2025,0x2026,0x55,0x57,0x36,0x56,0x37,0x54,
//0 1 2 3 4 5 6 7 8 9 : ; < = > ?
0x27,0x1e,0x1f,0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x33,0x34,0x2036,0x32,0x2037,0x2054,
//@ A B C D E F G H I J K L M N O
47,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f,0x10,0x11,0x12,
//P Q R S T U V W X Y Z [ \ ] ^ _
0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x1a,0x1b,0x1c,0x1d,0x2026,0x31,0x2027,0x00,0x00,
//' a b c d e f g h i j k l m n o
0,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f,0x10,0x11,0x12,
//p w r s t u v w x y z { | } ~ DEL
0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x1a,0x1b,0x1c,0x1d,0, 0, 0,0x49,0x204f,
// 129:f1 f2 f3 f4 f5 f6 f7 f8
0, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f, 0x40, 0x41,0,0,0,0,0,0,0, // 128-143
// 150:right left down up
0,0,0,0,0,0, 0x4f, 0x204f, 0x51, 0x2051,0,0,0,0,0,0 // 144-159
};
// we also use USB matrix for the moment
static const uint8_t keymatrixmap[2][256] = {
//Rows:
// 0 1 2 3 4 5 6 7 8 9 A B C D E F
{ 0x00, 0x00, 0x00, 0x00, 0x02, 0x08, 0x04, 0x04, 0x02, 0x04, 0x08, 0x08, 0x10, 0x10, 0x10, 0x20, //0x00
0x10, 0x10, 0x10, 0x20, 0x80, 0x04, 0x02, 0x04, 0x08, 0x08, 0x02, 0x04, 0x08, 0x02, 0x80, 0x80, //0x10
0x02, 0x02, 0x04, 0x04, 0x08, 0x08, 0x10, 0x10, 0x01, 0x80, 0x01, 0x00, 0x80, 0x00, 0x00, 0x20, //0x20
0x00, 0x00, 0x40, 0x20, 0x40, 0x00, 0x20, 0x20, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00, 0x01, 0x00, //0x30
0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x40, 0x40, 0x00, 0x00, 0x80, 0x01, //0x40
0x00, 0x01, 0x00, 0x00, 0x40, 0x40, 0x20, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x50
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x60
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x70
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x80
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x90
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xA0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xB0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xC0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xD0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xE0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x80, 0x40, 0x02
}, //0xF0
//Columns:
// 0 1 2 3 4 5 6 7 8 9 A B C D E F
{ 0x00, 0x00, 0x00, 0x00, 0x04, 0x10, 0x10, 0x04, 0x40, 0x20, 0x04, 0x20, 0x02, 0x04, 0x20, 0x04, //0x00
0x10, 0x80, 0x40, 0x02, 0x40, 0x02, 0x20, 0x40, 0x40, 0x80, 0x02, 0x80, 0x02, 0x10, 0x01, 0x08, //0x10
0x01, 0x08, 0x01, 0x08, 0x01, 0x08, 0x01, 0x08, 0x02, 0x80, 0x01, 0x00, 0x10, 0x00, 0x00, 0x40, //0x20
0x00, 0x00, 0x20, 0x20, 0x04, 0x00, 0x80, 0x10, 0x00, 0x00, 0x10, 0x00, 0x20, 0x00, 0x40, 0x00, //0x30
0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x08, 0x40, 0x00, 0x00, 0x02, 0x04, //0x40
0x00, 0x80, 0x00, 0x00, 0x80, 0x02, 0x08, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x50
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x60
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x70
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x80
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0x90
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xA0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xB0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xC0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xD0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //0xE0
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x04, 0x10, 0x80
}
}; //0xF0
struct {
union {
uint32_t kv;
struct {
uint8_t ke, //Extratasten SHIFT, STRG, ALT...
kdummy,
k, //Erste gedrückte Taste
k2; //Zweite gedrückte Taste
};
};
uint32_t lastkv;
uint8_t shiftLock;
} kbdData = {0, 0, 0};
static void setKey(uint8_t c, boolean pressed) {
uint32_t k = ascii2scan[c];
/*
uint32_t kvic20 = ascii2scanvic20[c];
bool shiftPressed;
if (k & 0x10000) shiftPressed = true;
else shiftPressed = false;
if (pressed) {
kbdData.kv = k & 0xffff;
}
*/
if (pressed) {
kbdData.kv = (k << 16);
kbdData.ke = kbdData.k2;
kbdData.k2 = 0;
//Serial.println(~kvic20, HEX);
//Serial.println((keymatrixmap[1][kbdData.k]<<8)+keymatrixmap[0][kbdData.k], HEX);
}
else
{
kbdData.kv = 0;
}
}
static void pushStringToTextEntry(char * text) {
char c;
while ((c = *text++)) {
setKey(c, true);
delay(20);
setKey(c, false);
delay(20);
}
}
uint8_t cia1PORTA(void) {
uint8_t v;
v = ~cpu.cia1.R[0x02] | (cpu.cia1.R[0x00] & cpu.cia1.R[0x02]);
int keys = emu_GetPad();
if (!cpu.swapJoysticks) {
if (keys & MASK_JOY2_BTN) v &= 0xEF;
if (keys & MASK_JOY2_UP) v &= 0xFE;
if (keys & MASK_JOY2_DOWN) v &= 0xFD;
if (keys & MASK_JOY2_RIGHT) v &= 0xFB;
if (keys & MASK_JOY2_LEFT) v &= 0xF7;
} else {
if (keys & MASK_JOY1_BTN) v &= 0xEF;
if (keys & MASK_JOY1_UP) v &= 0xFE;
if (keys & MASK_JOY1_DOWN) v &= 0xFD;
if (keys & MASK_JOY1_RIGHT) v &= 0xFB;
if (keys & MASK_JOY1_LEFT) v &= 0xF7;
}
if (!kbdData.kv) return v; //Keine Taste gedrückt
uint8_t filter = ~cpu.cia1.R[0x01] & cpu.cia1.R[0x03];
/*
uint8_t column = ~((kbdData.kv >> 8) & 0xFF); // output
uint8_t row = ~(kbdData.kv & 0xFF); //input
if (kbdData.kv) {
if (column & filter) v &= ~row ;
}
*/
if (kbdData.k) {
if ( keymatrixmap[1][kbdData.k] & filter) v &= ~keymatrixmap[0][kbdData.k];
}
if (kbdData.ke) {
if (kbdData.ke & 0x02) { //Shift-links
if ( keymatrixmap[1][0xff] & filter) v &= ~keymatrixmap[0][0xff];
}
if (kbdData.ke & 0x20) { //Shift-rechts
if ( keymatrixmap[1][0xfe] & filter) v &= ~keymatrixmap[0][0xfe];
}
if (kbdData.ke & 0x11) { //Control
if ( keymatrixmap[1][0xfd] & filter) v &= ~keymatrixmap[0][0xfd];
}
if (kbdData.ke & 0x88) { //Windows (=> Commodore)
if ( keymatrixmap[1][0xfc] & filter) v &= ~keymatrixmap[0][0xfc];
}
}
return v;
}
uint8_t cia1PORTB(void) {
uint8_t v;
v = ~cpu.cia1.R[0x03] | (cpu.cia1.R[0x00] & cpu.cia1.R[0x02]) ;
int keys = emu_GetPad();
if (!cpu.swapJoysticks) {
if (keys & MASK_JOY1_BTN) v &= 0xEF;
if (keys & MASK_JOY1_UP) v &= 0xFE;
if (keys & MASK_JOY1_DOWN) v &= 0xFD;
if (keys & MASK_JOY1_RIGHT) v &= 0xFB;
if (keys & MASK_JOY1_LEFT) v &= 0xF7;
} else {
if (keys & MASK_JOY2_BTN) v &= 0xEF;
if (keys & MASK_JOY2_UP) v &= 0xFE;
if (keys & MASK_JOY2_DOWN) v &= 0xFD;
if (keys & MASK_JOY2_RIGHT) v &= 0xFB;
if (keys & MASK_JOY2_LEFT) v &= 0xF7;
}
if (!kbdData.kv) return v; //Keine Taste gedrückt
uint8_t filter = ~cpu.cia1.R[0x00] & cpu.cia1.R[0x02];
/*
uint8_t column = ~((kbdData.kv >> 8) & 0xFF); // output
uint8_t row = ~(kbdData.kv & 0xFF); //input
if (kbdData.kv) {
if (row & filter) v &= ~column ;
}
*/
if (kbdData.k) {
if ( keymatrixmap[0][kbdData.k] & filter) v &= ~keymatrixmap[1][kbdData.k];
}
if (kbdData.ke) {
if (kbdData.ke & 0x02) { //Shift-links
if ( keymatrixmap[0][0xff] & filter) v &= ~keymatrixmap[1][0xff];
}
if (kbdData.ke & 0x20) { //Shift-rechts
if ( keymatrixmap[0][0xfe] & filter) v &= ~keymatrixmap[1][0xfe];
}
if (kbdData.ke & 0x11) { //Control
if ( keymatrixmap[0][0xfd] & filter) v &= ~keymatrixmap[1][0xfd];
}
if (kbdData.ke & 0x88) { //Windows (=> Commodore)
if ( keymatrixmap[0][0xfc] & filter) v &= ~keymatrixmap[1][0xfc];
}
}
return v;
}
void c64_Init(void)
{
disableEventResponder();
resetPLA();
resetCia1();
resetCia2();
resetVic();
cpu_reset();
#ifdef HAS_SND
emu_sndInit();
#endif
}
void c64_Step(void)
{
oneRasterLine();
}
void c64_Start(char * filename)
{
}
static uint8_t nbkeys=0;
static uint8_t kcnt=0;
static boolean toggle=true;
static char * textseq;
static char * textload = "LOAD\"\"\r\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\tRUN\r";
static char textkey[1];
static bool res=false;
static bool firsttime=true;
static int iusbhk;// USB keyboard key
void c64_Input(int bClick) {
if (nbkeys == 0) {
#ifndef TEECOMPUTER
if (bClick & MASK_KEY_USER2) {
/*
if (!oskbActive) {
oskbActive = true;
}
else {
oskbActive = false;
tft.get_frame_buffer_size(&fbwidth,NULL);
tft.drawRect(0,OSKB_YPOS,fbwidth,16,RGBVAL16(0, 0, 0));
}
*/
}
else
#endif
if (bClick & MASK_KEY_USER1) {
if (firsttime) {
firsttime = false;
textseq = textload;
nbkeys = strlen(textseq);
kcnt=0;
}
else {
cpu.swapJoysticks = !cpu.swapJoysticks;
}
}
else
{
int hk = emu_ReadI2CKeyboard();
if (iusbhk) hk = iusbhk;
if ( (hk != 0) && (res == false) ) {
setKey(hk,true);
res = true;
}
else if (hk == 0){
setKey(hk,false);
res = false;
}
}
}
else {
char k = textseq[kcnt];
if (k != '\t') setKey(k, toggle);
if (!toggle) {
kcnt++;
nbkeys--;
toggle = true;
}
else {
toggle = false;
}
}
}
void emu_KeyboardOnDown(int keymodifer, int key) {
int keyCode = -1;
if ((key >=0xc0) && (key <=0xdf)) {
keyCode = ((key-0xc0) & 0x1f) + 0x7f;
}
else {
keyCode = key & 0x7f;
}
//Serial.println(keyCode);
if (keyCode != -1) {
iusbhk = keyCode;
}
}
void emu_KeyboardOnUp(int keymodifer, int key) {
iusbhk = 0;
}
#ifdef HAS_SND
void SND_Process( void * stream, int len )
{
playSID.update(stream, len);
}
#endif