x50ng/src/s3c2410_rtc.c

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

#include <unistd.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <fcntl.h>
#include <sys/time.h>
#include <time.h>
#include <errno.h>

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

typedef struct {
    uint32_t rtccon;
    uint32_t ticnt;
    uint32_t rtcalm;
    uint32_t almsec;
    uint32_t almmin;
    uint32_t almhour;
    uint32_t almdate;
    uint32_t almmon;
    uint32_t almyear;
    uint32_t rtcrst;
    uint32_t bcdsec;
    uint32_t bcdmin;
    uint32_t bcdhour;
    uint32_t bcddate;
    uint32_t bcdday;
    uint32_t bcdmon;
    uint32_t bcdyear;

    unsigned int nr_regs;
    s3c2410_offset_t* regs;

    x49gp_t* x49gp;
    x49gp_timer_t* tick_timer;
    x49gp_timer_t* alarm_timer;
    int64_t interval; /* us */
    int64_t expires;  /* us */
} s3c2410_rtc_t;

static int s3c2410_rtc_data_init( s3c2410_rtc_t* rtc )
{
    s3c2410_offset_t regs[] = { S3C2410_OFFSET( RTC, RTCCON, 0x00, rtc->rtccon ),   S3C2410_OFFSET( RTC, TICNT, 0x00, rtc->ticnt ),
                                S3C2410_OFFSET( RTC, RTCALM, 0x00, rtc->rtcalm ),   S3C2410_OFFSET( RTC, ALMSEC, 0x00, rtc->almsec ),
                                S3C2410_OFFSET( RTC, ALMMIN, 0x00, rtc->almmin ),   S3C2410_OFFSET( RTC, ALMHOUR, 0x00, rtc->almhour ),
                                S3C2410_OFFSET( RTC, ALMDATE, 0x01, rtc->almdate ), S3C2410_OFFSET( RTC, ALMMON, 0x01, rtc->almmon ),
                                S3C2410_OFFSET( RTC, ALMYEAR, 0x00, rtc->almyear ), S3C2410_OFFSET( RTC, RTCRST, 0x00, rtc->rtcrst ),
                                S3C2410_OFFSET( RTC, BCDSEC, 0, rtc->bcdsec ),      S3C2410_OFFSET( RTC, BCDMIN, 0, rtc->bcdmin ),
                                S3C2410_OFFSET( RTC, BCDHOUR, 0, rtc->bcdhour ),    S3C2410_OFFSET( RTC, BCDDATE, 0, rtc->bcddate ),
                                S3C2410_OFFSET( RTC, BCDDAY, 0, rtc->bcdday ),      S3C2410_OFFSET( RTC, BCDMON, 0, rtc->bcdmon ),
                                S3C2410_OFFSET( RTC, BCDYEAR, 0, rtc->bcdyear ) };

    memset( rtc, 0, sizeof( s3c2410_rtc_t ) );

    rtc->regs = malloc( sizeof( regs ) );
    if ( NULL == rtc->regs ) {
        fprintf( stderr, "%s:%u: Out of memory\n", __FUNCTION__, __LINE__ );
        return -ENOMEM;
    }

    memcpy( rtc->regs, regs, sizeof( regs ) );
    rtc->nr_regs = sizeof( regs ) / sizeof( regs[ 0 ] );

    return 0;
}

static __inline__ uint32_t bin2bcd( uint32_t bin ) { return ( ( bin / 10 ) << 4 ) | ( bin % 10 ); }

static __inline__ uint32_t bcd2bin( uint32_t bcd ) { return ( ( bcd >> 4 ) * 10 ) + ( bcd & 0x0f ); }

static void s3c2410_rtc_timeout( void* user_data )
{
    s3c2410_rtc_t* rtc = user_data;
    x49gp_t* x49gp = rtc->x49gp;
    int64_t now, us;

    if ( !( rtc->ticnt & 0x80 ) ) {
        return;
    }

#ifdef DEBUG_S3C2410_RTC
    printf( "RTC: assert TICK interrupt\n" );
#endif

    s3c2410_intc_assert( x49gp, INT_TICK, 0 );

    now = x49gp_get_clock();
    while ( rtc->expires <= now ) {
        rtc->expires += rtc->interval;
    }

    us = rtc->expires - now;
    if ( us < 1000 )
        us = 1000;

#ifdef DEBUG_S3C2410_RTC
    printf( "RTC: restart TICK timer (%llu us)\n", ( unsigned long long )us );
#endif

    x49gp_mod_timer( rtc->tick_timer, rtc->expires );
}

static int s3c2410_rtc_set_ticnt( s3c2410_rtc_t* rtc )
{
    int64_t now, us;

    if ( x49gp_timer_pending( rtc->tick_timer ) ) {
        x49gp_del_timer( rtc->tick_timer );
#ifdef DEBUG_S3C2410_RTC
        printf( "RTC: stop TICK timer\n" );
#endif
    }

    if ( !( rtc->ticnt & 0x80 ) ) {
        return 0;
    }

    us = ( ( ( rtc->ticnt & 0x7f ) + 1 ) * 1000000 ) / 128;

    rtc->interval = us;
    if ( rtc->interval < 1000 )
        rtc->interval = 1000;

    now = x49gp_get_clock();
    rtc->expires = now + rtc->interval;

    us = rtc->expires - now;
    if ( us < 1000 )
        us = 1000;

#ifdef DEBUG_S3C2410_RTC
    printf( "RTC: start TICK timer (%lld us)\n", ( unsigned long long )us );
#endif

    x49gp_mod_timer( rtc->tick_timer, rtc->expires );
    return 0;
}

static void s3c2410_rtc_alarm( void* user_data )
{
    s3c2410_rtc_t* rtc = user_data;
    x49gp_t* x49gp = rtc->x49gp;
    struct tm* tm;
    struct timeval tv;
    int64_t now, us;
    int match = 1;

    if ( !( rtc->rtcalm & 0x40 ) ) {
        return;
    }

    gettimeofday( &tv, NULL );
    tm = localtime( &tv.tv_sec );

    now = x49gp_get_clock();
    us = 1000000LL - tv.tv_usec;

    if ( match && ( rtc->rtcalm & 0x01 ) ) {
        if ( tm->tm_sec != bcd2bin( rtc->almsec ) )
            match = 0;
    }
    if ( match && ( rtc->rtcalm & 0x02 ) ) {
        if ( tm->tm_min != bcd2bin( rtc->almmin ) )
            match = 0;
    }
    if ( match && ( rtc->rtcalm & 0x04 ) ) {
        if ( tm->tm_hour != bcd2bin( rtc->almhour ) )
            match = 0;
    }
    if ( match && ( rtc->rtcalm & 0x08 ) ) {
        if ( tm->tm_mday != bcd2bin( rtc->almdate ) )
            match = 0;
    }
    if ( match && ( rtc->rtcalm & 0x10 ) ) {
        if ( ( tm->tm_mon + 1 ) != bcd2bin( rtc->almmon ) )
            match = 0;
    }
    if ( match && ( rtc->rtcalm & 0x20 ) ) {
        if ( ( tm->tm_year % 100 ) != bcd2bin( rtc->almyear ) )
            match = 0;
    }

    if ( match ) {
#ifdef DEBUG_S3C2410_RTC
        printf( "RTC: assert ALARM interrupt\n" );
#endif
        s3c2410_intc_assert( x49gp, INT_RTC, 0 );
    }

#ifdef DEBUG_S3C2410_RTC
    printf( "RTC: reload ALARM timer (%lld us)\n", ( unsigned long long )us );
#endif

    x49gp_mod_timer( rtc->alarm_timer, now + us );
}

static int s3c2410_rtc_set_rtcalm( s3c2410_rtc_t* rtc )
{
    struct timeval tv;
    int64_t now, us;

    if ( !( rtc->rtcalm & 0x40 ) ) {
        x49gp_del_timer( rtc->alarm_timer );
        return 0;
    }

    gettimeofday( &tv, NULL );

    now = x49gp_get_clock();
    us = 1000000LL - tv.tv_usec;

#ifdef DEBUG_S3C2410_RTC
    printf( "RTC: start ALARM timer (%lld us)\n", ( unsigned long long )us );
#endif

    x49gp_mod_timer( rtc->alarm_timer, now + us );
    return 0;
}

static uint32_t s3c2410_rtc_read( void* opaque, target_phys_addr_t offset )
{
    s3c2410_rtc_t* rtc = opaque;
    s3c2410_offset_t* reg;

    if ( !S3C2410_OFFSET_OK( rtc, offset ) ) {
        return ~( 0 );
    }

    reg = S3C2410_OFFSET_ENTRY( rtc, offset );

    if ( S3C2410_RTC_BCDSEC <= offset && offset <= S3C2410_RTC_BCDYEAR ) {
        struct tm* tm;
        struct timeval tv;

        gettimeofday( &tv, NULL );
        tm = localtime( &tv.tv_sec );

        switch ( offset ) {
            case S3C2410_RTC_BCDSEC:
                *( reg->datap ) = bin2bcd( tm->tm_sec );
                break;
            case S3C2410_RTC_BCDMIN:
                *( reg->datap ) = bin2bcd( tm->tm_min );
                break;
            case S3C2410_RTC_BCDHOUR:
                *( reg->datap ) = bin2bcd( tm->tm_hour );
                break;
            case S3C2410_RTC_BCDDATE:
                *( reg->datap ) = bin2bcd( tm->tm_mday );
                break;
            case S3C2410_RTC_BCDDAY:
                *( reg->datap ) = bin2bcd( tm->tm_wday + 1 );
                break;
            case S3C2410_RTC_BCDMON:
                *( reg->datap ) = bin2bcd( tm->tm_mon + 1 );
                break;
            case S3C2410_RTC_BCDYEAR:
                *( reg->datap ) = bin2bcd( tm->tm_year % 100 );
                break;
        }
    }

#ifdef DEBUG_S3C2410_RTC
    printf( "read  %s [%08x] %s [%08lx] data %08x\n", "s3c2410-rtc", S3C2410_RTC_BASE, reg->name, ( unsigned long )offset,
            *( reg->datap ) );
#endif

    return *( reg->datap );
}

static void s3c2410_rtc_write( void* opaque, target_phys_addr_t offset, uint32_t data )
{
    s3c2410_rtc_t* rtc = opaque;
    s3c2410_offset_t* reg;

    if ( !S3C2410_OFFSET_OK( rtc, offset ) ) {
        return;
    }

    reg = S3C2410_OFFSET_ENTRY( rtc, offset );

#ifdef DEBUG_S3C2410_RTC
    printf( "write %s [%08x] %s [%08lx] data %08x\n", "s3c2410-rtc", S3C2410_RTC_BASE, reg->name, ( unsigned long )offset, data );
#endif

    switch ( offset ) {
        case S3C2410_RTC_TICNT:
            *( reg->datap ) = data;
            s3c2410_rtc_set_ticnt( rtc );
            break;
        case S3C2410_RTC_RTCALM:
            *( reg->datap ) = data;
            s3c2410_rtc_set_rtcalm( rtc );
            break;
        default:
            *( reg->datap ) = data;
            break;
    }
}

static int s3c2410_rtc_load( x49gp_module_t* module, GKeyFile* key )
{
    s3c2410_rtc_t* rtc = 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 < rtc->nr_regs; i++ ) {
        reg = &rtc->regs[ i ];

        if ( NULL == reg->name )
            continue;

        if ( x49gp_module_get_u32( module, key, reg->name, reg->reset, reg->datap ) )
            error = -EAGAIN;
    }

    s3c2410_rtc_set_ticnt( rtc );
    s3c2410_rtc_set_rtcalm( rtc );

    return error;
}

static int s3c2410_rtc_save( x49gp_module_t* module, GKeyFile* key )
{
    s3c2410_rtc_t* rtc = 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 < rtc->nr_regs; i++ ) {
        reg = &rtc->regs[ i ];

        if ( NULL == reg->name )
            continue;

        x49gp_module_set_u32( module, key, reg->name, *( reg->datap ) );
    }

    return 0;
}

static int s3c2410_rtc_reset( x49gp_module_t* module, x49gp_reset_t reset )
{
    s3c2410_rtc_t* rtc = 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 < ( S3C2410_RTC_RTCALM >> 2 ); i++ ) {
        reg = &rtc->regs[ i ];

        if ( NULL == reg->name )
            continue;

        *( reg->datap ) = reg->reset;
    }

    s3c2410_rtc_set_ticnt( rtc );

    return 0;
}

static CPUReadMemoryFunc* s3c2410_rtc_readfn[] = { s3c2410_rtc_read, s3c2410_rtc_read, s3c2410_rtc_read };

static CPUWriteMemoryFunc* s3c2410_rtc_writefn[] = { s3c2410_rtc_write, s3c2410_rtc_write, s3c2410_rtc_write };

static int s3c2410_rtc_init( x49gp_module_t* module )
{
    s3c2410_rtc_t* rtc;
    int iotype;

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

    rtc = malloc( sizeof( s3c2410_rtc_t ) );
    if ( NULL == rtc ) {
        fprintf( stderr, "%s: %s:%u: Out of memory\n", module->x49gp->progname, __FUNCTION__, __LINE__ );
        return -ENOMEM;
    }
    if ( s3c2410_rtc_data_init( rtc ) ) {
        free( rtc );
        return -ENOMEM;
    }

    module->user_data = rtc;
    rtc->x49gp = module->x49gp;

    rtc->tick_timer = x49gp_new_timer( X49GP_TIMER_REALTIME, s3c2410_rtc_timeout, rtc );
    rtc->alarm_timer = x49gp_new_timer( X49GP_TIMER_REALTIME, s3c2410_rtc_alarm, rtc );

    iotype = cpu_register_io_memory( s3c2410_rtc_readfn, s3c2410_rtc_writefn, rtc );
#ifdef DEBUG_S3C2410_RTC
    printf( "%s: iotype %08x\n", __FUNCTION__, iotype );
#endif
    cpu_register_physical_memory( S3C2410_RTC_BASE, S3C2410_MAP_SIZE, iotype );

    return 0;
}

static int s3c2410_rtc_exit( x49gp_module_t* module )
{
    s3c2410_rtc_t* rtc;

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

    if ( module->user_data ) {
        rtc = module->user_data;
        if ( rtc->regs )
            free( rtc->regs );
        free( rtc );
    }

    x49gp_module_unregister( module );
    free( module );

    return 0;
}

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

    if ( x49gp_module_init( x49gp, "s3c2410-rtc", s3c2410_rtc_init, s3c2410_rtc_exit, s3c2410_rtc_reset, s3c2410_rtc_load, s3c2410_rtc_save,
                            NULL, &module ) ) {
        return -1;
    }

    return x49gp_module_register( module );
}