mirror of
https://github.com/gwenhael-le-moine/x49gp.git
synced 2024-12-26 21:58:41 +01:00
c61f11cff2
Misc changes, mostly fixes: - fix ./newconfig systems other than OSX (broke inc8b823f
) - fix palette usage in 2-bit color mode (was broken ever since grayscale was implemented in18e1003
and its improperly attributed copyf7913eb
) - fix continuing from breakpoints in the debugger (never worked, was exposed when the debugger was enabled in9c1f2ed
) - restore the printf statements commented out in9c1f2ed
and hide them with #ifdefs instead - close the server socket after accepting a debugger connection to allow another simultaneous debug session to be started using the same TCP port - use the symbolic constant DEFAULT_GDBSTUB_PORT (already defined in gdb_stub.h as 1234) when starting the gdb server in main.c in place of the raw number 1234 - change Makefile to read the name of the firmware file from the file update.scp instead of hardcoding it; this allows users to switch to another firmware by simply pasting it along with its accompanying update.scp into the x49gp directory - Enhance port G (keyboard) handling to remember the value of output bits across periods with these bits configured as input This fixes interaction with HPGCC3 keyboard routines, and it also fixes keys with eint==7 (assuming the stock firmware is in use) needing a double-tap to work unless pressed very shortly after another keypress (the latter broke inb5f93ed
) - Get rid of the deprecated function warning by switching from gdk_pixbuf_new_from_inline to gdk_pixbuf_new_from_data (based on code by chwdt) - Delete remaining now-redundant CVS files - Don't release all buttons anymore if there are still physical keys and/or the left mouse button are holding some down On the other hand, forcibly release all buttons when losing focus to avoid getting stuck in a state with buttons down when they are not held down by anything; this would happen due to missed events while not in focus - Add a context menu to the screen, containing only "Reset" and "Quit" items for now - Ensure that the files backing flash, sram, and s3c2410-sram exist and have the correct size when opening them Note that if the flash file does not exist, this will not fill it with the code that's supposed to be in there, obviously causing the calculator to crash. That's an improvement for later. - Allow the config system to fill not only numbers, but also strings (including filenames) with default values basename is excluded, but it's planned to be dropped entirely. - Add an "install" target to the Makefile - Implement a more generic command-line parser for substantially improved flexibility - Also adds a proper help option, though the manual referenced in the corresponding output (a manpage, hopefully) does not exist yet. - Drop the "basename" config property in favor of interpreting relative paths in the config as relative to the config file's location - Retire the "image" config property in favor of simply loading the image from next to the binary or from the install directory - Split the UI name property into name (affecting only the window title) and type (affecting the UI image and in the future also the default bootcode) properties - Change the default calculator type to the 50g everywhere, which probably matches today's user expectations better than the 49g+. - Create a flash file from the calculator model's appropriate boot file if it does not exist, relying on the bootcode to detect the absence of a firmware The bootcode will complain about the missing firmware and enter update mode, so the user needs to supply their favorite firmware version and point the bootcode's updater to it. The easiest way is probably pointing the emulated SD card at a directory containing the firmware and its accompanying update.scp file, and then starting the SD-based update. - Add SD mount / unmount options to the right-click / menu-key popup menu - Remove most of the old script-based config-generating system since the binary now has these capabilities as well - Add an applications menu item for installing - Keep some debug output on stderr and a huge vvfat.log file from showing up when not debugging x49gp itself - Allow (re-)connecting a debugger to a running session This is done through the right-click / menu-key popup menu. To avoid confusion due to the accidental clicks leading to an unresponsive interface (caused by waiting for the debugger to connect), this option is hidden unless option -d or its new companion -D (same as -d, but does not start the debug interface right away) is present. - Improved support for hardware keyboards - Update README.md, add manpage, rename other README files to TODO to reflect their contents
711 lines
15 KiB
C
711 lines
15 KiB
C
/* $Id: s3c2410_io_port.c,v 1.14 2008/12/11 12:18:17 ecd Exp $
|
|
*/
|
|
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
|
|
#include <x49gp.h>
|
|
#include <s3c2410.h>
|
|
#include <s3c2410_intc.h>
|
|
#include <byteorder.h>
|
|
|
|
|
|
typedef struct {
|
|
uint32_t gpacon;
|
|
uint32_t gpadat;
|
|
|
|
uint32_t gpbcon;
|
|
uint32_t gpbdat;
|
|
uint32_t gpbup;
|
|
|
|
uint32_t gpccon;
|
|
uint32_t gpcdat;
|
|
uint32_t gpcup;
|
|
|
|
uint32_t gpdcon;
|
|
uint32_t gpddat;
|
|
uint32_t gpdup;
|
|
|
|
uint32_t gpecon;
|
|
uint32_t gpedat;
|
|
uint32_t gpeup;
|
|
|
|
uint32_t gpfcon;
|
|
uint32_t gpfdat;
|
|
uint32_t gpfup;
|
|
|
|
uint32_t gpgcon;
|
|
uint32_t gpgdat;
|
|
uint32_t gpgup;
|
|
|
|
uint32_t gphcon;
|
|
uint32_t gphdat;
|
|
uint32_t gphup;
|
|
|
|
uint32_t misccr;
|
|
uint32_t dclkcon;
|
|
|
|
uint32_t extint0;
|
|
uint32_t extint1;
|
|
uint32_t extint2;
|
|
uint32_t eintflt0;
|
|
uint32_t eintflt1;
|
|
uint32_t eintflt2;
|
|
uint32_t eintflt3;
|
|
uint32_t eintmask;
|
|
uint32_t eintpend;
|
|
|
|
uint32_t gstatus0;
|
|
uint32_t gstatus1;
|
|
uint32_t gstatus2;
|
|
uint32_t gstatus3;
|
|
uint32_t gstatus4;
|
|
|
|
unsigned int nr_regs;
|
|
s3c2410_offset_t *regs;
|
|
|
|
x49gp_t *x49gp;
|
|
} s3c2410_io_port_t;
|
|
|
|
static int
|
|
s3c2410_io_port_data_init(s3c2410_io_port_t *io)
|
|
{
|
|
s3c2410_offset_t regs[] = {
|
|
S3C2410_OFFSET(IO_PORT, GPACON, 0x007fffff, io->gpacon),
|
|
S3C2410_OFFSET(IO_PORT, GPADAT, 0x00000000, io->gpadat),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPBCON, 0x00000000, io->gpbcon),
|
|
S3C2410_OFFSET(IO_PORT, GPBDAT, 0x00000000, io->gpbdat),
|
|
S3C2410_OFFSET(IO_PORT, GPBUP, 0x00000000, io->gpbup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPCCON, 0x00000000, io->gpccon),
|
|
S3C2410_OFFSET(IO_PORT, GPCDAT, 0x00000000, io->gpcdat),
|
|
S3C2410_OFFSET(IO_PORT, GPCUP, 0x00000000, io->gpcup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPDCON, 0x00000000, io->gpdcon),
|
|
S3C2410_OFFSET(IO_PORT, GPDDAT, 0x0000038c, io->gpddat),
|
|
S3C2410_OFFSET(IO_PORT, GPDUP, 0x0000f000, io->gpdup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPECON, 0x00000000, io->gpecon),
|
|
S3C2410_OFFSET(IO_PORT, GPEDAT, 0x0000c7c0, io->gpedat),
|
|
S3C2410_OFFSET(IO_PORT, GPEUP, 0x00000000, io->gpeup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPFCON, 0x00000000, io->gpfcon),
|
|
S3C2410_OFFSET(IO_PORT, GPFDAT, 0x00000008, io->gpfdat),
|
|
S3C2410_OFFSET(IO_PORT, GPFUP, 0x00000000, io->gpfup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPGCON, 0x00000000, io->gpgcon),
|
|
S3C2410_OFFSET(IO_PORT, GPGDAT, 0x0000fffe, io->gpgdat),
|
|
S3C2410_OFFSET(IO_PORT, GPGUP, 0x0000f800, io->gpgup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GPHCON, 0x00000000, io->gphcon),
|
|
S3C2410_OFFSET(IO_PORT, GPHDAT, 0x00000000, io->gphdat),
|
|
S3C2410_OFFSET(IO_PORT, GPHUP, 0x00000000, io->gphup),
|
|
|
|
S3C2410_OFFSET(IO_PORT, MISCCR, 0x00010330, io->misccr),
|
|
S3C2410_OFFSET(IO_PORT, DCLKCON, 0x00000000, io->dclkcon),
|
|
|
|
S3C2410_OFFSET(IO_PORT, EXTINT0, 0x00000000, io->extint0),
|
|
S3C2410_OFFSET(IO_PORT, EXTINT1, 0x00000000, io->extint1),
|
|
S3C2410_OFFSET(IO_PORT, EXTINT2, 0x00000000, io->extint2),
|
|
S3C2410_OFFSET(IO_PORT, EINTFLT0, 0x00000000, io->eintflt0),
|
|
S3C2410_OFFSET(IO_PORT, EINTFLT1, 0x00000000, io->eintflt1),
|
|
S3C2410_OFFSET(IO_PORT, EINTFLT2, 0x00000000, io->eintflt2),
|
|
S3C2410_OFFSET(IO_PORT, EINTFLT3, 0x00000000, io->eintflt3),
|
|
S3C2410_OFFSET(IO_PORT, EINTMASK, 0x00fffff0, io->eintmask),
|
|
S3C2410_OFFSET(IO_PORT, EINTPEND, 0x00000000, io->eintpend),
|
|
|
|
S3C2410_OFFSET(IO_PORT, GSTATUS0, 0x00000001, io->gstatus0),
|
|
S3C2410_OFFSET(IO_PORT, GSTATUS1, 0x32410002, io->gstatus1),
|
|
S3C2410_OFFSET(IO_PORT, GSTATUS2, 0x00000001, io->gstatus2),
|
|
S3C2410_OFFSET(IO_PORT, GSTATUS3, 0x00000000, io->gstatus3),
|
|
S3C2410_OFFSET(IO_PORT, GSTATUS4, 0x00000000, io->gstatus4)
|
|
};
|
|
|
|
memset(io, 0, sizeof(s3c2410_io_port_t));
|
|
|
|
io->regs = malloc(sizeof(regs));
|
|
if (NULL == io->regs) {
|
|
fprintf(stderr, "%s:%u: Out of memory\n",
|
|
__FUNCTION__, __LINE__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
memcpy(io->regs, regs, sizeof(regs));
|
|
io->nr_regs = sizeof(regs) / sizeof(regs[0]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static uint32_t
|
|
s3c2410_scan_keys(x49gp_t *x49gp, uint32_t gpgcon, uint32_t gpgdat)
|
|
{
|
|
uint32_t result;
|
|
int col, row;
|
|
|
|
result = 0xfffe | (gpgdat & 1);
|
|
|
|
for (col = 0; col < 8; col++) {
|
|
switch ((gpgcon >> (2 * (col + 8))) & 3) {
|
|
case 0: /* Input */
|
|
case 2: /* Interrupt */
|
|
case 3: /* Reserved */
|
|
break;
|
|
case 1: /* Output */
|
|
result &= ~(1 << (col + 8));
|
|
result |= gpgdat & (1 << (col + 8));
|
|
|
|
if (0 == (gpgdat & (1 << (col + 8)))) {
|
|
result &= ~(x49gp->keybycol[col]);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (row = 1; row < 8; row++) {
|
|
switch ((gpgcon >> (2 * row)) & 3) {
|
|
case 0: /* Input */
|
|
case 2: /* Interrupt */
|
|
case 3: /* Reserved */
|
|
break;
|
|
case 1: /* Output */
|
|
result &= ~(1 << row);
|
|
result |= gpgdat & (1 << row);
|
|
|
|
if (0 == (gpgdat & (1 << row))) {
|
|
result &= ~(x49gp->keybyrow[row] << 8);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
static uint32_t
|
|
s3c2410_io_port_read(void *opaque, target_phys_addr_t offset)
|
|
{
|
|
s3c2410_io_port_t *io = opaque;
|
|
s3c2410_offset_t *reg;
|
|
|
|
#ifdef QEMU_OLD
|
|
offset -= S3C2410_IO_PORT_BASE;
|
|
#endif
|
|
if (! S3C2410_OFFSET_OK(io, offset)) {
|
|
fprintf(stderr, "%s:%u: offset %08lx not OK\n", __FUNCTION__, __LINE__, (unsigned long) offset);
|
|
abort();
|
|
return ~(0);
|
|
}
|
|
|
|
reg = S3C2410_OFFSET_ENTRY(io, offset);
|
|
|
|
switch (offset) {
|
|
case S3C2410_IO_PORT_MISCCR:
|
|
// if (io->x49gp->arm->NresetSig != LOW) {
|
|
*(reg->datap) |= 0x00010000;
|
|
// }
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GPCDAT:
|
|
if (0 == ((io->gpccon >> 30) & 3)) {
|
|
*(reg->datap) |= 0x8000;
|
|
}
|
|
if (0 == ((io->gpccon >> 28) & 3)) {
|
|
*(reg->datap) |= 0x4000;
|
|
}
|
|
if (0 == ((io->gpccon >> 26) & 3)) {
|
|
*(reg->datap) |= 0x2000;
|
|
}
|
|
if (0 == ((io->gpccon >> 24) & 3)) {
|
|
*(reg->datap) |= 0x1000;
|
|
}
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GPDDAT:
|
|
if (0 == ((io->gpdcon >> 6) & 3)) {
|
|
*(reg->datap) |= 0x0008;
|
|
}
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GPEDAT:
|
|
if (0 == ((io->gpecon >> 30) & 3)) {
|
|
*(reg->datap) |= 0x8000;
|
|
}
|
|
if (0 == ((io->gpecon >> 28) & 3)) {
|
|
*(reg->datap) |= 0x4000;
|
|
}
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GPFDAT:
|
|
#if 1
|
|
if (1 != ((io->gpfcon >> 6) & 3)) {
|
|
*(reg->datap) |= 0x0008;
|
|
}
|
|
#endif
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GPGDAT:
|
|
return s3c2410_scan_keys(io->x49gp, io->gpgcon, io->gpgdat);
|
|
|
|
case S3C2410_IO_PORT_GPHDAT:
|
|
if (0 == ((io->gphcon >> 14) & 3)) {
|
|
*(reg->datap) |= 0x80;
|
|
}
|
|
if (0 == ((io->gphcon >> 12) & 3)) {
|
|
*(reg->datap) &= ~(0x40);
|
|
}
|
|
break;
|
|
}
|
|
|
|
#ifdef DEBUG_S3C2410_IO_PORT
|
|
printf("read %s [%08x] %s [%08lx] data %08x\n",
|
|
"s3c2410-io-port", S3C2410_IO_PORT_BASE,
|
|
reg->name, (unsigned long) offset, *(reg->datap));
|
|
#endif
|
|
|
|
return *(reg->datap);
|
|
}
|
|
|
|
static void
|
|
s3c2410_io_port_write(void *opaque, target_phys_addr_t offset, uint32_t data)
|
|
{
|
|
s3c2410_io_port_t *io = opaque;
|
|
s3c2410_offset_t *reg;
|
|
uint32_t change;
|
|
static uint32_t lcd_data = 0;
|
|
|
|
#ifdef QEMU_OLD
|
|
offset -= S3C2410_IO_PORT_BASE;
|
|
#endif
|
|
if (! S3C2410_OFFSET_OK(io, offset)) {
|
|
return;
|
|
}
|
|
|
|
reg = S3C2410_OFFSET_ENTRY(io, offset);
|
|
|
|
#ifdef DEBUG_S3C2410_IO_PORT
|
|
printf("write %s [%08x] %s [%08lx] data %08x\n",
|
|
"s3c2410-io-port", S3C2410_IO_PORT_BASE,
|
|
reg->name, (unsigned long) offset, data);
|
|
#endif
|
|
|
|
switch (offset) {
|
|
case S3C2410_IO_PORT_GPDDAT:
|
|
change = *(reg->datap) ^ data;
|
|
*(reg->datap) = data;
|
|
|
|
if (!(data & 0x200) && (change & 0x200)) {
|
|
lcd_data = 0;
|
|
}
|
|
|
|
if (!(data & 0x200) && (data & 0x2000) && (change & 0x2000)) {
|
|
#ifdef DEBUG_S3C2410_IO_PORT
|
|
printf("IO_PORT GPDDAT: clk0 rise: data %u\n",
|
|
(data >> 12) & 1);
|
|
#endif
|
|
lcd_data <<= 1;
|
|
lcd_data |= (data >> 12) & 1;
|
|
}
|
|
|
|
if ((data & 0x200) && (change & 0x200)) {
|
|
#ifdef DEBUG_S3C2410_IO_PORT
|
|
printf("IO_PORT GPDDAT: cs0 rise: data %04x\n",
|
|
lcd_data);
|
|
#endif
|
|
}
|
|
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_MISCCR:
|
|
*(reg->datap) = data;
|
|
if (!(*(reg->datap) & 0x00010000)) {
|
|
*(reg->datap) = 0x10330;
|
|
// if (io->x49gp->arm->NresetSig != LOW) {
|
|
// io->x49gp->arm->NresetSig = LOW;
|
|
// io->x49gp->arm->Exception++;
|
|
// }
|
|
}
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GSTATUS0:
|
|
case S3C2410_IO_PORT_GSTATUS1:
|
|
/* read only */
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_GSTATUS2:
|
|
*(reg->datap) &= ~(data & 7);
|
|
break;
|
|
|
|
case S3C2410_IO_PORT_EINTPEND:
|
|
*(reg->datap) &= ~(data);
|
|
|
|
if (0 == (*(reg->datap) & 0x000000f0))
|
|
s3c2410_intc_deassert(io->x49gp, EINT4_7);
|
|
if (0 == (*(reg->datap) & 0x00ffff00))
|
|
s3c2410_intc_deassert(io->x49gp, EINT8_23);
|
|
break;
|
|
|
|
default:
|
|
*(reg->datap) = data;
|
|
break;
|
|
}
|
|
}
|
|
|
|
void
|
|
s3c2410_io_port_g_update(x49gp_t *x49gp, int column, int row, unsigned char columnbit, unsigned char rowbit, uint32_t new_state)
|
|
{
|
|
s3c2410_io_port_t *io = x49gp->s3c2410_io_port;
|
|
uint32_t oldvalue, newvalue, change;
|
|
int n;
|
|
|
|
oldvalue = s3c2410_scan_keys(x49gp, io->gpgcon, io->gpgdat);
|
|
|
|
if (new_state) {
|
|
x49gp->keybycol[column] |= rowbit;
|
|
x49gp->keybyrow[row] |= columnbit;
|
|
|
|
} else {
|
|
x49gp->keybycol[column] &= ~rowbit;
|
|
x49gp->keybyrow[row] &= ~columnbit;
|
|
}
|
|
|
|
newvalue = s3c2410_scan_keys(x49gp, io->gpgcon, io->gpgdat);
|
|
change=newvalue^oldvalue;
|
|
|
|
|
|
for(n=0;n<15;++n) {
|
|
|
|
switch ((io->gpgcon >> (2 * n)) & 3) {
|
|
|
|
case 2: /* Interrupt */
|
|
{
|
|
switch (n+8<=15 ?
|
|
(io->extint1 >> (4 * n)) & 7 : // EINT 8-15
|
|
(io->extint2 >> (4 * (n-8))) & 7 // EINT 16-23
|
|
) {
|
|
case 0: /* Low Level */
|
|
if (!(newvalue & (1 << n)))
|
|
{
|
|
io->eintpend |= 1 << (n + 8);
|
|
if (io->eintpend & ~(io->eintmask))
|
|
s3c2410_intc_assert(x49gp, EINT8_23, 1);
|
|
}
|
|
break;
|
|
case 1: /* High Level */
|
|
if (newvalue & (1 << n)) {
|
|
io->eintpend |= 1 << (n + 8);
|
|
if (io->eintpend & ~(io->eintmask))
|
|
s3c2410_intc_assert(x49gp, EINT8_23, 1);
|
|
}
|
|
break;
|
|
case 2: /* Falling Edge */
|
|
case 3:
|
|
if ((change & (1 << n)) && !(newvalue & (1 << n))) {
|
|
io->eintpend |= 1 << (n + 8);
|
|
if (io->eintpend & ~(io->eintmask))
|
|
s3c2410_intc_assert(x49gp, EINT8_23, 1);
|
|
}
|
|
break;
|
|
case 4: /* Rising Edge */
|
|
case 5:
|
|
if ((change & (1 << n)) && (newvalue & (1 << n))) {
|
|
io->eintpend |= 1 << (n + 8);
|
|
if (io->eintpend & ~(io->eintmask))
|
|
s3c2410_intc_assert(x49gp, EINT8_23, 1);
|
|
}
|
|
break;
|
|
case 6: /* Any Edge */
|
|
case 7:
|
|
if (change & (1 << n)) {
|
|
io->eintpend |= 1 << (n + 8);
|
|
if (io->eintpend & ~(io->eintmask))
|
|
s3c2410_intc_assert(x49gp, EINT8_23, 1);
|
|
}
|
|
break;
|
|
|
|
}
|
|
}
|
|
break;
|
|
case 0: /* Input */
|
|
case 1: /* Output */
|
|
case 3: /* Reserved */
|
|
break;
|
|
}
|
|
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
s3c2410_io_port_f_set_bit(x49gp_t *x49gp, int n, uint32_t value)
|
|
{
|
|
s3c2410_io_port_t *io = x49gp->s3c2410_io_port;
|
|
uint32_t change;
|
|
int pending, level;
|
|
|
|
if (n > 7)
|
|
return;
|
|
|
|
// g_mutex_lock(x49gp->memlock);
|
|
|
|
change = 0;
|
|
switch ((io->gpfcon >> (2 * n)) & 3) {
|
|
case 0: /* Input */
|
|
io->gpfdat &= ~(1 << n);
|
|
io->gpfdat |= (value << n);
|
|
goto out;
|
|
|
|
case 2: /* Interrupt */
|
|
change = io->gpfdat ^ (value << n);
|
|
io->gpfdat &= ~(1 << n);
|
|
io->gpfdat |= (value << n);
|
|
break;
|
|
|
|
case 1: /* Output */
|
|
case 3: /* Reserved */
|
|
goto out;
|
|
}
|
|
|
|
pending = -1;
|
|
level = 0;
|
|
switch ((io->extint0 >> (4 * n)) & 7) {
|
|
case 0: /* Low Level */
|
|
if (!(io->gpfdat & (1 << n)))
|
|
pending = n;
|
|
level = 1;
|
|
break;
|
|
|
|
case 1: /* High Level */
|
|
if (io->gpfdat & (1 << n))
|
|
pending = n;
|
|
level = 1;
|
|
break;
|
|
|
|
case 2: /* Falling Edge */
|
|
case 3:
|
|
if ((change & (1 << n)) && !(io->gpfdat & (1 << n)))
|
|
pending = n;
|
|
break;
|
|
|
|
case 4: /* Rising Edge */
|
|
case 5:
|
|
if ((change & (1 << n)) && (io->gpfdat & (1 << n)))
|
|
pending = n;
|
|
break;
|
|
|
|
case 6: /* Any Edge */
|
|
case 7:
|
|
if (change & (1 << n))
|
|
pending = n;
|
|
break;
|
|
}
|
|
|
|
if (-1 == pending)
|
|
goto out;
|
|
|
|
switch (n) {
|
|
case 0:
|
|
s3c2410_intc_assert(x49gp, EINT0, level);
|
|
break;
|
|
case 1:
|
|
s3c2410_intc_assert(x49gp, EINT1, level);
|
|
break;
|
|
case 2:
|
|
s3c2410_intc_assert(x49gp, EINT2, level);
|
|
break;
|
|
case 3:
|
|
s3c2410_intc_assert(x49gp, EINT3, level);
|
|
break;
|
|
case 4:
|
|
case 5:
|
|
case 6:
|
|
case 7:
|
|
io->eintpend |= (1 << n);
|
|
if (io->eintpend & ~(io->eintmask))
|
|
s3c2410_intc_assert(x49gp, EINT4_7, 1);
|
|
break;
|
|
}
|
|
|
|
out:
|
|
// g_mutex_unlock(x49gp->memlock);
|
|
|
|
return;
|
|
}
|
|
|
|
static int
|
|
s3c2410_io_port_load(x49gp_module_t *module, GKeyFile *key)
|
|
{
|
|
s3c2410_io_port_t *io = module->user_data;
|
|
s3c2410_offset_t *reg;
|
|
int error = 0;
|
|
int i;
|
|
|
|
#ifdef DEBUG_X49GP_MODULES
|
|
printf("%s: %s:%u\n", module->name, __FUNCTION__, __LINE__);
|
|
#endif
|
|
|
|
for (i = 0; i < io->nr_regs; i++) {
|
|
reg = &io->regs[i];
|
|
|
|
if (NULL == reg->name)
|
|
continue;
|
|
|
|
if (x49gp_module_get_u32(module, key, reg->name,
|
|
reg->reset, reg->datap))
|
|
error = -EAGAIN;
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
static int
|
|
s3c2410_io_port_save(x49gp_module_t *module, GKeyFile *key)
|
|
{
|
|
s3c2410_io_port_t *io = module->user_data;
|
|
s3c2410_offset_t *reg;
|
|
int i;
|
|
|
|
#ifdef DEBUG_X49GP_MODULES
|
|
printf("%s: %s:%u\n", module->name, __FUNCTION__, __LINE__);
|
|
#endif
|
|
|
|
for (i = 0; i < io->nr_regs; i++) {
|
|
reg = &io->regs[i];
|
|
|
|
if (NULL == reg->name)
|
|
continue;
|
|
|
|
x49gp_module_set_u32(module, key, reg->name, *(reg->datap));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
s3c2410_io_port_reset(x49gp_module_t *module, x49gp_reset_t reset)
|
|
{
|
|
s3c2410_io_port_t *io = module->user_data;
|
|
s3c2410_offset_t *reg;
|
|
int i;
|
|
|
|
#ifdef DEBUG_X49GP_MODULES
|
|
printf("%s: %s:%u\n", module->name, __FUNCTION__, __LINE__);
|
|
#endif
|
|
|
|
if (reset == X49GP_RESET_POWER_OFF) {
|
|
io->gstatus2 = 2;
|
|
return 0;
|
|
}
|
|
|
|
for (i = 0; i < io->nr_regs; i++) {
|
|
reg = &io->regs[i];
|
|
|
|
if (NULL == reg->name)
|
|
continue;
|
|
|
|
*(reg->datap) = reg->reset;
|
|
}
|
|
|
|
if (reset == X49GP_RESET_WATCHDOG) {
|
|
io->gstatus2 = 4;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static CPUReadMemoryFunc *s3c2410_io_port_readfn[] =
|
|
{
|
|
s3c2410_io_port_read,
|
|
s3c2410_io_port_read,
|
|
s3c2410_io_port_read
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *s3c2410_io_port_writefn[] =
|
|
{
|
|
s3c2410_io_port_write,
|
|
s3c2410_io_port_write,
|
|
s3c2410_io_port_write
|
|
};
|
|
|
|
static int
|
|
s3c2410_io_port_init(x49gp_module_t *module)
|
|
{
|
|
s3c2410_io_port_t *io;
|
|
int iotype;
|
|
|
|
#ifdef DEBUG_X49GP_MODULES
|
|
printf("%s: %s:%u\n", module->name, __FUNCTION__, __LINE__);
|
|
#endif
|
|
|
|
io = malloc(sizeof(s3c2410_io_port_t));
|
|
if (NULL == io) {
|
|
fprintf(stderr, "%s:%u: Out of memory\n",
|
|
__FUNCTION__, __LINE__);
|
|
return -ENOMEM;
|
|
}
|
|
if (s3c2410_io_port_data_init(io)) {
|
|
free(io);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
module->user_data = io;
|
|
module->x49gp->s3c2410_io_port = io;
|
|
io->x49gp = module->x49gp;
|
|
|
|
#ifdef QEMU_OLD
|
|
iotype = cpu_register_io_memory(0, s3c2410_io_port_readfn,
|
|
s3c2410_io_port_writefn, io);
|
|
#else
|
|
iotype = cpu_register_io_memory(s3c2410_io_port_readfn,
|
|
s3c2410_io_port_writefn, io);
|
|
#endif
|
|
#ifdef DEBUG_S3C2410_IO_PORT
|
|
printf("%s: iotype %08x\n", __FUNCTION__, iotype);
|
|
#endif
|
|
cpu_register_physical_memory(S3C2410_IO_PORT_BASE, S3C2410_MAP_SIZE, iotype);
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
s3c2410_io_port_exit(x49gp_module_t *module)
|
|
{
|
|
s3c2410_io_port_t *io;
|
|
|
|
#ifdef DEBUG_X49GP_MODULES
|
|
printf("%s: %s:%u\n", module->name, __FUNCTION__, __LINE__);
|
|
#endif
|
|
|
|
if (module->user_data) {
|
|
io = module->user_data;
|
|
if (io->regs)
|
|
free(io->regs);
|
|
free(io);
|
|
}
|
|
|
|
x49gp_module_unregister(module);
|
|
free(module);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
x49gp_s3c2410_io_port_init(x49gp_t *x49gp)
|
|
{
|
|
x49gp_module_t *module;
|
|
|
|
if (x49gp_module_init(x49gp, "s3c2410-io-port",
|
|
s3c2410_io_port_init,
|
|
s3c2410_io_port_exit,
|
|
s3c2410_io_port_reset,
|
|
s3c2410_io_port_load,
|
|
s3c2410_io_port_save,
|
|
NULL, &module)) {
|
|
return -1;
|
|
}
|
|
|
|
return x49gp_module_register(module);
|
|
}
|