14 #include <sys/types.h>
16 #include <sys/ioctl.h>
21 #include "config_file/config_file.h"
22 #include "input/input.h"
24 //#define BCM2708_PERI_BASE 0x20000000 //pi0-1
25 //#define BCM2708_PERI_BASE 0xFE000000 //pi4
26 #define BCM2708_PERI_BASE 0x3F000000 // pi3
27 #define BCM2708_PERI_SIZE 0x01000000
28 #define GPIO_BASE (BCM2708_PERI_BASE + 0x200000) /* GPIO controller */
29 #define GPCLK_BASE (BCM2708_PERI_BASE + 0x101000)
30 #define GPIO_ADDR 0x200000 /* GPIO controller */
31 #define GPCLK_ADDR 0x101000
32 #define CLK_PASSWD 0x5a000000
33 #define CLK_GP0_CTL 0x070
34 #define CLK_GP0_DIV 0x074
40 #define STATUSREGADDR \
41 GPIO_CLR = 1 << SA0; \
42 GPIO_CLR = 1 << SA1; \
45 GPIO_CLR = 1 << SA0; \
46 GPIO_CLR = 1 << SA1; \
49 GPIO_SET = 1 << SA0; \
50 GPIO_CLR = 1 << SA1; \
53 GPIO_CLR = 1 << SA0; \
54 GPIO_SET = 1 << SA1; \
57 GPIO_SET = 1 << SA0; \
58 GPIO_SET = 1 << SA1; \
61 #define PAGE_SIZE (4 * 1024)
62 #define BLOCK_SIZE (4 * 1024)
64 #define GPIOSET(no, ishigh) \
69 reset |= (1 << (no)); \
72 #define FASTBASE 0x07FFFFFF
73 #define FASTSIZE 0xFFFFFFF
74 #define GAYLEBASE 0xD80000 // D7FFFF
75 #define GAYLESIZE 0x6FFFF
77 #define JOY0DAT 0xDFF00A
78 #define JOY1DAT 0xDFF00C
79 #define CIAAPRA 0xBFE001
80 #define POTGOR 0xDFF016
82 int kb_hook_enabled = 0;
83 int mouse_hook_enabled = 0;
84 int cpu_emulation_running = 1;
86 char mouse_dx = 0, mouse_dy = 0;
87 char mouse_buttons = 0;
89 #define KICKBASE 0xF80000
90 #define KICKSIZE 0x7FFFF
92 int mem_fd, mouse_fd = -1, keyboard_fd = -1;
94 int gayle_emulation_enabled = 1;
98 // Configurable emulator options
99 unsigned int cpu_type = M68K_CPU_TYPE_68000;
100 unsigned int loop_cycles = 300;
101 struct emulator_config *cfg = NULL;
102 char keyboard_file[256] = "/dev/input/event1";
105 volatile unsigned int *gpio;
106 volatile unsigned int *gpclk;
107 volatile unsigned int gpfsel0;
108 volatile unsigned int gpfsel1;
109 volatile unsigned int gpfsel2;
110 volatile unsigned int gpfsel0_o;
111 volatile unsigned int gpfsel1_o;
112 volatile unsigned int gpfsel2_o;
114 // GPIO setup macros. Always use INP_GPIO(x) before using OUT_GPIO(x) or
116 #define INP_GPIO(g) *(gpio + ((g) / 10)) &= ~(7 << (((g) % 10) * 3))
117 #define OUT_GPIO(g) *(gpio + ((g) / 10)) |= (1 << (((g) % 10) * 3))
118 #define SET_GPIO_ALT(g, a) \
119 *(gpio + (((g) / 10))) |= \
120 (((a) <= 3 ? (a) + 4 : (a) == 4 ? 3 : 2) << (((g) % 10) * 3))
123 *(gpio + 7) // sets bits which are 1 ignores bits which are 0
125 *(gpio + 10) // clears bits which are 1 ignores bits which are 0
127 #define GET_GPIO(g) (*(gpio + 13) & (1 << g)) // 0 if LOW, (1<<g) if HIGH
129 #define GPIO_PULL *(gpio + 37) // Pull up/pull down
130 #define GPIO_PULLCLK0 *(gpio + 38) // Pull up/pull down clock
134 uint32_t read8(uint32_t address);
135 void write8(uint32_t address, uint32_t data);
137 uint32_t read16(uint32_t address);
138 void write16(uint32_t address, uint32_t data);
140 void write32(uint32_t address, uint32_t data);
141 uint32_t read32(uint32_t address);
143 uint16_t read_reg(void);
144 void write_reg(unsigned int value);
146 volatile uint16_t srdata;
147 volatile uint32_t srdata2;
148 volatile uint32_t srdata2_old;
150 //unsigned char g_kick[524288];
151 //unsigned char g_ram[FASTSIZE + 1]; /* RAM */
152 unsigned char toggle;
153 static volatile unsigned char ovl;
154 static volatile unsigned char maprom;
156 void sigint_handler(int sig_num) {
158 //cpu_emulation_running = 0;
161 printf("Received sigint %d, exiting.\n", sig_num);
170 void *iplThread(void *args) {
171 printf("IPL thread running/n");
175 if (GET_GPIO(1) == 0) {
177 m68k_end_timeslice();
178 //printf("thread!/n");
187 int main(int argc, char *argv[]) {
189 const struct sched_param priority = {99};
191 // Some command line switch stuffles
192 for (g = 1; g < argc; g++) {
193 if (strcmp(argv[g], "--disable-gayle") == 0) {
194 gayle_emulation_enabled = 0;
196 else if (strcmp(argv[g], "--cpu_type") == 0 || strcmp(argv[g], "--cpu") == 0) {
198 printf("%s switch found, but no CPU type specified.\n", argv[g]);
201 cpu_type = get_m68k_cpu_type(argv[g]);
204 else if (strcmp(argv[g], "--config-file") == 0 || strcmp(argv[g], "--config") == 0) {
206 printf("%s switch found, but no config filename specified.\n", argv[g]);
209 cfg = load_config_file(argv[g]);
215 printf("No config file specified. Trying to load default.cfg...\n");
216 cfg = load_config_file("default.cfg");
218 printf("Couldn't load default.cfg, empty emulator config will be used.\n");
219 cfg = (struct emulator_config *)calloc(1, sizeof(struct emulator_config));
221 printf("Failed to allocate memory for emulator config!\n");
224 memset(cfg, 0x00, sizeof(struct emulator_config));
229 if (cfg->cpu_type) cpu_type = cfg->cpu_type;
230 if (cfg->loop_cycles) loop_cycles = cfg->loop_cycles;
233 if (cfg->mouse_enabled) {
234 mouse_fd = open(cfg->mouse_file, O_RDONLY | O_NONBLOCK);
235 if (mouse_fd == -1) {
236 printf("Failed to open %s, can't enable mouse hook.\n", cfg->mouse_file);
237 cfg->mouse_enabled = 0;
241 keyboard_fd = open(keyboard_file, O_RDONLY | O_NONBLOCK);
242 if (keyboard_fd == -1) {
243 printf("Failed to open keyboard event source.\n");
246 sched_setscheduler(0, SCHED_FIFO, &priority);
247 mlockall(MCL_CURRENT); // lock in memory to keep us from paging out
251 signal(SIGINT, sigint_handler);
254 //goto skip_everything;
256 // Enable 200MHz CLK output on GPIO4, adjust divider and pll source depending
258 printf("Enable 200MHz GPCLK0 on GPIO4\n");
260 *(gpclk + (CLK_GP0_CTL / 4)) = CLK_PASSWD | (1 << 5);
262 while ((*(gpclk + (CLK_GP0_CTL / 4))) & (1 << 7))
265 *(gpclk + (CLK_GP0_DIV / 4)) =
266 CLK_PASSWD | (6 << 12); // divider , 6=200MHz on pi3
268 *(gpclk + (CLK_GP0_CTL / 4)) =
269 CLK_PASSWD | 5 | (1 << 4); // pll? 6=plld, 5=pllc
271 while (((*(gpclk + (CLK_GP0_CTL / 4))) & (1 << 7)) == 0)
275 SET_GPIO_ALT(4, 0); // gpclk0
285 // set gpio0 (aux0) and gpio1 (aux1) to input
289 // Set GPIO pins 6,7 and 8-23 to output
290 for (g = 6; g <= 23; g++) {
294 printf("Precalculate GPIO8-23 as Output\n");
295 gpfsel0_o = *(gpio); // store gpio ddr
296 printf("gpfsel0: %#x\n", gpfsel0_o);
297 gpfsel1_o = *(gpio + 1); // store gpio ddr
298 printf("gpfsel1: %#x\n", gpfsel1_o);
299 gpfsel2_o = *(gpio + 2); // store gpio ddr
300 printf("gpfsel2: %#x\n", gpfsel2_o);
302 // Set GPIO pins 8-23 to input
303 for (g = 8; g <= 23; g++) {
306 printf("Precalculate GPIO8-23 as Input\n");
307 gpfsel0 = *(gpio); // store gpio ddr
308 printf("gpfsel0: %#x\n", gpfsel0);
309 gpfsel1 = *(gpio + 1); // store gpio ddr
310 printf("gpfsel1: %#x\n", gpfsel1);
311 gpfsel2 = *(gpio + 2); // store gpio ddr
312 printf("gpfsel2: %#x\n", gpfsel2);
321 // reset cpld statemachine first
329 // reset amiga and statemachine
333 m68k_write_memory_8(0xbfe201, 0x0001); // AMIGA OVL
334 m68k_write_memory_8(0xbfe001, 0x0001); // AMIGA OVL high (ROM@0x0)
339 printf("Setting CPU type to %d.\n", cpu_type);
340 m68k_set_cpu_type(cpu_type);
344 m68k_set_reg(M68K_REG_PC, 0xF80002);
346 m68k_set_reg(M68K_REG_PC, 0x0);
352 err = pthread_create(&id, NULL, &iplThread, NULL);
354 printf("\ncan't create IPL thread :[%s]", strerror(err));
356 printf("\n IPL Thread created successfully\n");
362 if (mouse_hook_enabled) {
363 if (get_mouse_status(&mouse_dx, &mouse_dy, &mouse_buttons)) {
364 //printf("Maus: %d (%.2X), %d (%.2X), B:%.2X\n", mouse_dx, mouse_dx, mouse_dy, mouse_dy, mouse_buttons);
368 if (cpu_emulation_running)
369 m68k_execute(loop_cycles);
371 // FIXME: Rework this to use keyboard events instead.
372 while (get_key_char(&c)) {
373 if (c == cfg->keyboard_toggle_key && !kb_hook_enabled) {
375 printf("Keyboard hook enabled.\n");
377 else if (c == 0x1B && kb_hook_enabled) {
379 printf("Keyboard hook disabled.\n");
381 if (!kb_hook_enabled) {
382 if (c == cfg->mouse_toggle_key) {
383 mouse_hook_enabled ^= 1;
384 printf("Mouse hook %s.\n", mouse_hook_enabled ? "enabled" : "disabled");
385 mouse_dx = mouse_dy = mouse_buttons = 0;
388 cpu_emulation_running ^= 1;
389 printf("CPU emulation is now %s\n", cpu_emulation_running ? "running" : "stopped");
394 printf("CPU emulation reset.\n");
397 printf("Quitting and exiting emulator.\n");
398 goto stop_cpu_emulation;
405 m68k_set_irq((srdata >> 13) & 0xff);
413 if (GET_GPIO(1) == 0) {
415 m68k_set_irq((srdata >> 13) & 0xff);
417 if (CheckIrq() == 1) {
418 write16(0xdff09c, 0x8008);
437 void cpu_pulse_reset(void) {
439 // printf("Status Reg%x\n",read_reg());
442 // printf("Status Reg%x\n",read_reg());
445 int cpu_irq_ack(int level) {
446 printf("cpu irq ack\n");
450 static unsigned int target = 0;
452 unsigned int m68k_read_memory_8(unsigned int address) {
454 int ret = handle_mapped_read(cfg, address, &target, OP_TYPE_BYTE, ovl);
460 // if (address < 0xffffff) {
461 return read8((uint32_t)address);
467 unsigned int m68k_read_memory_16(unsigned int address) {
469 int ret = handle_mapped_read(cfg, address, &target, OP_TYPE_WORD, ovl);
474 if (mouse_hook_enabled) {
475 if (address == JOY0DAT) {
476 // Forward mouse valueses to Amyga.
477 unsigned short result = (mouse_dy << 8) | (mouse_dx);
478 mouse_dx = mouse_dy = 0;
479 return (unsigned int)result;
481 if (address == CIAAPRA) {
482 unsigned short result = (unsigned int)read16((uint32_t)address);
483 if (mouse_buttons & 0x01) {
485 return (unsigned int)(result | 0x40);
488 return (unsigned int)result;
490 if (address == POTGOR) {
491 unsigned short result = (unsigned int)read16((uint32_t)address);
492 if (mouse_buttons & 0x02) {
494 return (unsigned int)(result | 0x2);
497 return (unsigned int)result;
501 // if (address < 0xffffff) {
503 return (unsigned int)read16((uint32_t)address);
509 unsigned int m68k_read_memory_32(unsigned int address) {
511 int ret = handle_mapped_read(cfg, address, &target, OP_TYPE_LONGWORD, ovl);
516 // if (address < 0xffffff) {
518 uint16_t a = read16(address);
519 uint16_t b = read16(address + 2);
520 return (a << 16) | b;
526 void m68k_write_memory_8(unsigned int address, unsigned int value) {
528 int ret = handle_mapped_write(cfg, address, value, OP_TYPE_BYTE, ovl);
533 if (address == 0xbfe001) {
534 ovl = (value & (1 << 0));
535 printf("OVL:%x\n", ovl);
538 // if (address < 0xffffff) {
540 write8((uint32_t)address, value);
547 void m68k_write_memory_16(unsigned int address, unsigned int value) {
549 int ret = handle_mapped_write(cfg, address, value, OP_TYPE_WORD, ovl);
554 // if (address < 0xffffff) {
556 write16((uint32_t)address, value);
562 void m68k_write_memory_32(unsigned int address, unsigned int value) {
564 int ret = handle_mapped_write(cfg, address, value, OP_TYPE_LONGWORD, ovl);
569 // if (address < 0xffffff) {
571 write16(address, value >> 16);
572 write16(address + 2, value);
579 void write16(uint32_t address, uint32_t data) {
580 uint32_t addr_h_s = (address & 0x0000ffff) << 8;
581 uint32_t addr_h_r = (~address & 0x0000ffff) << 8;
582 uint32_t addr_l_s = (address >> 16) << 8;
583 uint32_t addr_l_r = (~address >> 16) << 8;
584 uint32_t data_s = (data & 0x0000ffff) << 8;
585 uint32_t data_r = (~data & 0x0000ffff) << 8;
587 // asm volatile ("dmb" ::: "memory");
590 *(gpio + 1) = gpfsel1_o;
591 *(gpio + 2) = gpfsel2_o;
593 *(gpio + 7) = addr_h_s;
594 *(gpio + 10) = addr_h_r;
598 *(gpio + 7) = addr_l_s;
599 *(gpio + 10) = addr_l_r;
604 *(gpio + 7) = data_s;
605 *(gpio + 10) = data_r;
610 *(gpio + 1) = gpfsel1;
611 *(gpio + 2) = gpfsel2;
612 while ((GET_GPIO(0)))
614 // asm volatile ("dmb" ::: "memory");
617 void write8(uint32_t address, uint32_t data) {
618 if ((address & 1) == 0)
619 data = data + (data << 8); // EVEN, A0=0,UDS
621 data = data & 0xff; // ODD , A0=1,LDS
622 uint32_t addr_h_s = (address & 0x0000ffff) << 8;
623 uint32_t addr_h_r = (~address & 0x0000ffff) << 8;
624 uint32_t addr_l_s = (address >> 16) << 8;
625 uint32_t addr_l_r = (~address >> 16) << 8;
626 uint32_t data_s = (data & 0x0000ffff) << 8;
627 uint32_t data_r = (~data & 0x0000ffff) << 8;
629 // asm volatile ("dmb" ::: "memory");
632 *(gpio + 1) = gpfsel1_o;
633 *(gpio + 2) = gpfsel2_o;
635 *(gpio + 7) = addr_h_s;
636 *(gpio + 10) = addr_h_r;
640 *(gpio + 7) = addr_l_s;
641 *(gpio + 10) = addr_l_r;
646 *(gpio + 7) = data_s;
647 *(gpio + 10) = data_r;
652 *(gpio + 1) = gpfsel1;
653 *(gpio + 2) = gpfsel2;
654 while ((GET_GPIO(0)))
656 // asm volatile ("dmb" ::: "memory");
659 uint32_t read16(uint32_t address) {
661 uint32_t addr_h_s = (address & 0x0000ffff) << 8;
662 uint32_t addr_h_r = (~address & 0x0000ffff) << 8;
663 uint32_t addr_l_s = (address >> 16) << 8;
664 uint32_t addr_l_r = (~address >> 16) << 8;
666 // asm volatile ("dmb" ::: "memory");
669 *(gpio + 1) = gpfsel1_o;
670 *(gpio + 2) = gpfsel2_o;
672 *(gpio + 7) = addr_h_s;
673 *(gpio + 10) = addr_h_r;
677 *(gpio + 7) = addr_l_s;
678 *(gpio + 10) = addr_l_r;
684 *(gpio + 1) = gpfsel1;
685 *(gpio + 2) = gpfsel2;
687 while (!(GET_GPIO(0)))
692 // asm volatile ("dmb" ::: "memory");
693 return (val >> 8) & 0xffff;
696 uint32_t read8(uint32_t address) {
698 uint32_t addr_h_s = (address & 0x0000ffff) << 8;
699 uint32_t addr_h_r = (~address & 0x0000ffff) << 8;
700 uint32_t addr_l_s = (address >> 16) << 8;
701 uint32_t addr_l_r = (~address >> 16) << 8;
703 // asm volatile ("dmb" ::: "memory");
706 *(gpio + 1) = gpfsel1_o;
707 *(gpio + 2) = gpfsel2_o;
709 *(gpio + 7) = addr_h_s;
710 *(gpio + 10) = addr_h_r;
714 *(gpio + 7) = addr_l_s;
715 *(gpio + 10) = addr_l_r;
721 *(gpio + 1) = gpfsel1;
722 *(gpio + 2) = gpfsel2;
725 while (!(GET_GPIO(0)))
730 // asm volatile ("dmb" ::: "memory");
732 val = (val >> 8) & 0xffff;
733 if ((address & 1) == 0)
734 return (val >> 8) & 0xff; // EVEN, A0=0,UDS
736 return val & 0xff; // ODD , A0=1,LDS
739 /******************************************************/
741 void write_reg(unsigned int value) {
744 *(gpio + 1) = gpfsel1_o;
745 *(gpio + 2) = gpfsel2_o;
746 *(gpio + 7) = (value & 0xffff) << 8;
747 *(gpio + 10) = (~value & 0xffff) << 8;
749 GPIO_CLR = 1 << 7; // delay
754 *(gpio + 1) = gpfsel1;
755 *(gpio + 2) = gpfsel2;
758 uint16_t read_reg(void) {
763 *(gpio + 1) = gpfsel1;
764 *(gpio + 2) = gpfsel2;
766 GPIO_CLR = 1 << 6; // delay
771 return (uint16_t)(val >> 8);
775 // Set up a memory regions to access GPIO
779 if ((mem_fd = open("/dev/mem", O_RDWR | O_SYNC)) < 0) {
780 printf("can't open /dev/mem \n");
786 NULL, // Any adddress in our space will do
787 BCM2708_PERI_SIZE, // Map length
788 PROT_READ | PROT_WRITE, // Enable reading & writting to mapped memory
789 MAP_SHARED, // Shared with other processes
790 mem_fd, // File to map
791 BCM2708_PERI_BASE // Offset to GPIO peripheral
794 close(mem_fd); // No need to keep mem_fd open after mmap
796 if (gpio_map == MAP_FAILED) {
797 printf("gpio mmap error %d\n", (int)gpio_map); // errno also set!
801 gpio = ((volatile unsigned *)gpio_map) + GPIO_ADDR / 4;
802 gpclk = ((volatile unsigned *)gpio_map) + GPCLK_ADDR / 4;