/* $Id: s3c2410_arm.c,v 1.7 2008/12/11 12:18:17 ecd Exp $
 */

#include <unistd.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <errno.h>

#include "qemu-git/target-arm/cpu.h"

#include "x49gp.h"
#include "s3c2410.h"

#include "qemu-git/cpu-all.h"

static int s3c2410_arm_load( x49gp_module_t* module, GKeyFile* key )
{
    struct CPUARMState* env = module->user_data;
    char name[ 32 ];
    int error = 0;
    int i;

#ifdef DEBUG_X49GP_MODULES
    printf( "%s: %s:%u\n", module->name, __FUNCTION__, __LINE__ );
#endif

    cpu_reset( env );
    tlb_flush( env, 1 );

    for ( i = 0; i < ( sizeof( env->regs ) / sizeof( env->regs[ 0 ] ) ); i++ ) {
        sprintf( name, "reg-%02u", i );
        if ( x49gp_module_get_u32( module, key, name, 0, &env->regs[ i ] ) )
            error = -EAGAIN;
    }
    if ( x49gp_module_get_u32( module, key, "cpsr", 0, &env->uncached_cpsr ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "spsr", 0, &env->spsr ) )
        error = -EAGAIN;
    for ( i = 0; i < ( sizeof( env->banked_spsr ) / sizeof( env->banked_spsr[ 0 ] ) ); i++ ) {
        sprintf( name, "banked-spsr-%02u", i );
        if ( x49gp_module_get_u32( module, key, name, 0, &env->banked_spsr[ i ] ) )
            error = -EAGAIN;
    }
    for ( i = 0; i < ( sizeof( env->banked_r13 ) / sizeof( env->banked_r13[ 0 ] ) ); i++ ) {
        sprintf( name, "banked-r13-%02u", i );
        if ( x49gp_module_get_u32( module, key, name, 0, &env->banked_r13[ i ] ) )
            error = -EAGAIN;
    }
    for ( i = 0; i < ( sizeof( env->banked_r14 ) / sizeof( env->banked_r14[ 0 ] ) ); i++ ) {
        sprintf( name, "banked-r14-%02u", i );
        if ( x49gp_module_get_u32( module, key, name, 0, &env->banked_r14[ i ] ) )
            error = -EAGAIN;
    }
    for ( i = 0; i < ( sizeof( env->usr_regs ) / sizeof( env->usr_regs[ 0 ] ) ); i++ ) {
        sprintf( name, "reg-usr-%02u", i );
        if ( x49gp_module_get_u32( module, key, name, 0, &env->usr_regs[ i ] ) )
            error = -EAGAIN;
    }
    for ( i = 0; i < ( sizeof( env->fiq_regs ) / sizeof( env->fiq_regs[ 0 ] ) ); i++ ) {
        sprintf( name, "reg-fiq-%02u", i );
        if ( x49gp_module_get_u32( module, key, name, 0, &env->fiq_regs[ i ] ) )
            error = -EAGAIN;
    }

    if ( x49gp_module_get_u32( module, key, "CF", 0, &env->CF ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "VF", 0, &env->VF ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "NF", 0, &env->NF ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "ZF", 0, &env->ZF ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "QF", 0, &env->QF ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "thumb", 0, &env->thumb ) )
        error = -EAGAIN;

    if ( x49gp_module_get_u32( module, key, "cp15-c0-cpuid", 0, &env->cp15.c0_cpuid ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c1-sys", 0, &env->cp15.c1_sys ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c1-coproc", 0, &env->cp15.c1_coproc ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-base0", 0, &env->cp15.c2_base0 ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-base1", 0, &env->cp15.c2_base1 ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-control", 0, &env->cp15.c2_control ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-mask", 0, &env->cp15.c2_mask ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-base-mask", 0, &env->cp15.c2_base_mask ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-data", 0, &env->cp15.c2_data ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c2-insn", 0, &env->cp15.c2_insn ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c3", 0, &env->cp15.c3 ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c5-insn", 0, &env->cp15.c5_insn ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c5-data", 0, &env->cp15.c5_data ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c6-insn", 0, &env->cp15.c6_insn ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c6-data", 0, &env->cp15.c6_data ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c9-insn", 0, &env->cp15.c9_insn ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c9-data", 0, &env->cp15.c9_data ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c13-fcse", 0, &env->cp15.c13_fcse ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "cp15-c13-context", 0, &env->cp15.c13_context ) )
        error = -EAGAIN;

    if ( x49gp_module_get_u32( module, key, "features", 0, &env->features ) )
        error = -EAGAIN;

    if ( x49gp_module_get_int( module, key, "exception-index", 0, &env->exception_index ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "interrupt-request", 0, &env->interrupt_request ) )
        error = -EAGAIN;
    if ( x49gp_module_get_u32( module, key, "halted", 0, &env->halted ) )
        error = -EAGAIN;

    env->exception_index = -1;

    if ( 0 == error ) {
        if ( env->halted )
            module->x49gp->arm_idle = 1;
    } else {
        memset( &env->cp15, 0, sizeof( env->cp15 ) );
    }

    //	s3c2410_arm_dump_state(state);

    return error;
}

static int s3c2410_arm_save( x49gp_module_t* module, GKeyFile* key )
{
    struct CPUARMState* env = module->user_data;
    char name[ 32 ];
    int i;

#ifdef DEBUG_X49GP_MODULES
    printf( "%s: %s:%u\n", module->name, __FUNCTION__, __LINE__ );
#endif

    for ( i = 0; i < ( sizeof( env->regs ) / sizeof( env->regs[ 0 ] ) ); i++ ) {
        sprintf( name, "reg-%02u", i );
        x49gp_module_set_u32( module, key, name, env->regs[ i ] );
    }
    x49gp_module_set_u32( module, key, "cpsr", env->uncached_cpsr );
    x49gp_module_set_u32( module, key, "spsr", env->spsr );
    for ( i = 0; i < ( sizeof( env->banked_spsr ) / sizeof( env->banked_spsr[ 0 ] ) ); i++ ) {
        sprintf( name, "banked-spsr-%02u", i );
        x49gp_module_set_u32( module, key, name, env->banked_spsr[ i ] );
    }
    for ( i = 0; i < ( sizeof( env->banked_r13 ) / sizeof( env->banked_r13[ 0 ] ) ); i++ ) {
        sprintf( name, "banked-r13-%02u", i );
        x49gp_module_set_u32( module, key, name, env->banked_r13[ i ] );
    }
    for ( i = 0; i < ( sizeof( env->banked_r14 ) / sizeof( env->banked_r14[ 0 ] ) ); i++ ) {
        sprintf( name, "banked-r14-%02u", i );
        x49gp_module_set_u32( module, key, name, env->banked_r14[ i ] );
    }
    for ( i = 0; i < ( sizeof( env->usr_regs ) / sizeof( env->usr_regs[ 0 ] ) ); i++ ) {
        sprintf( name, "reg-usr-%02u", i );
        x49gp_module_set_u32( module, key, name, env->usr_regs[ i ] );
    }
    for ( i = 0; i < ( sizeof( env->fiq_regs ) / sizeof( env->fiq_regs[ 0 ] ) ); i++ ) {
        sprintf( name, "reg-fiq-%02u", i );
        x49gp_module_set_u32( module, key, name, env->fiq_regs[ i ] );
    }

    x49gp_module_set_u32( module, key, "CF", env->CF );
    x49gp_module_set_u32( module, key, "VF", env->VF );
    x49gp_module_set_u32( module, key, "NF", env->NF );
    x49gp_module_set_u32( module, key, "ZF", env->ZF );
    x49gp_module_set_u32( module, key, "QF", env->QF );
    x49gp_module_set_int( module, key, "thumb", env->thumb );

    x49gp_module_set_u32( module, key, "cp15-c0-cpuid", env->cp15.c0_cpuid );
    x49gp_module_set_u32( module, key, "cp15-c1-sys", env->cp15.c1_sys );
    x49gp_module_set_u32( module, key, "cp15-c1-coproc", env->cp15.c1_coproc );
    x49gp_module_set_u32( module, key, "cp15-c2-base0", env->cp15.c2_base0 );
    x49gp_module_set_u32( module, key, "cp15-c2-base1", env->cp15.c2_base1 );
    x49gp_module_set_u32( module, key, "cp15-c2-control", env->cp15.c2_control );
    x49gp_module_set_u32( module, key, "cp15-c2-mask", env->cp15.c2_mask );
    x49gp_module_set_u32( module, key, "cp15-c2-base-mask", env->cp15.c2_base_mask );
    x49gp_module_set_u32( module, key, "cp15-c2-data", env->cp15.c2_data );
    x49gp_module_set_u32( module, key, "cp15-c2-insn", env->cp15.c2_insn );
    x49gp_module_set_u32( module, key, "cp15-c3", env->cp15.c3 );
    x49gp_module_set_u32( module, key, "cp15-c5-insn", env->cp15.c5_insn );
    x49gp_module_set_u32( module, key, "cp15-c5-data", env->cp15.c5_data );
    x49gp_module_set_u32( module, key, "cp15-c6-insn", env->cp15.c6_insn );
    x49gp_module_set_u32( module, key, "cp15-c6-data", env->cp15.c6_data );
    x49gp_module_set_u32( module, key, "cp15-c9-insn", env->cp15.c9_insn );
    x49gp_module_set_u32( module, key, "cp15-c9-data", env->cp15.c9_data );
    x49gp_module_set_u32( module, key, "cp15-c13-fcse", env->cp15.c13_fcse );
    x49gp_module_set_u32( module, key, "cp15-c13-context", env->cp15.c13_context );

    x49gp_module_set_u32( module, key, "features", env->features );

    x49gp_module_set_int( module, key, "exception-index", env->exception_index );
    x49gp_module_set_int( module, key, "interrupt-request", env->interrupt_request );
    x49gp_module_set_int( module, key, "halted", env->halted );

    return 0;
}

static int s3c2410_arm_reset( x49gp_module_t* module, x49gp_reset_t reset )
{
    struct CPUARMState* env = module->user_data;

#ifdef DEBUG_X49GP_MODULES
    printf( "%s: %s:%u\n", module->name, __FUNCTION__, __LINE__ );
#endif

    cpu_reset( env );
    tlb_flush( env, 1 );

    return 0;
}

static int s3c2410_arm_init( x49gp_module_t* module )
{
    x49gp_t* x49gp = module->x49gp;

#ifdef DEBUG_X49GP_MODULES
    printf( "%s: %s:%u\n", module->name, __FUNCTION__, __LINE__ );
#endif

    module->user_data = x49gp->env;
    return 0;
}

static int s3c2410_arm_exit( x49gp_module_t* module )
{
#ifdef DEBUG_X49GP_MODULES
    printf( "%s: %s:%u\n", module->name, __FUNCTION__, __LINE__ );
#endif

    return 0;
}

int x49gp_s3c2410_arm_init( x49gp_t* x49gp )
{
    x49gp_module_t* module;

    if ( x49gp_module_init( x49gp, "s3c2410-arm", s3c2410_arm_init, s3c2410_arm_exit, s3c2410_arm_reset, s3c2410_arm_load, s3c2410_arm_save,
                            NULL, &module ) ) {
        return -1;
    }

    return x49gp_module_register( module );
}