/**

 * $Id$

 * 

 * AICA test loader

 *

 * Copyright (c) 2006 Nathan Keynes.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 */

#include <stdio.h>

#include <stdlib.h>

#include <assert.h>

#include "lib.h"

#include "dma.h"

#define AICA_RAM_BASE 0xA0800000

#define AICA_SYSCALL (AICA_RAM_BASE+0x30)

#define AICA_SYSCALL_ARG1 (AICA_SYSCALL+4)

#define AICA_SYSCALL_ARG2 (AICA_SYSCALL+8)

#define AICA_SYSCALL_ARG3 (AICA_SYSCALL+12)

#define AICA_SYSCALL_RETURN (AICA_SYSCALL+4)

#define SYS_READ 0

#define SYS_WRITE 1

#define SYS_OPEN 2

#define SYS_CLOSE 3

#define SYS_CREAT 4

#define SYS_LINK 5

#define SYS_UNLINK 6

#define SYS_CHDIR 7

#define SYS_CHMOD 8

#define SYS_LSEEK 9

#define SYS_FSTAT 10

#define SYS_TIME 11

#define SYS_STAT 12

#define SYS_UTIME 13

#define SYS_ASSIGNWRKMEM 14

#define SYS_EXIT 15

#define SYS_OPENDIR 16

#define SYS_CLOSEDIR 17

#define SYS_READDIR 18

#define SYS_GETHOSTINFO 19

uint32_t do_syscall( uint32_t syscall, uint32_t arg1, uint32_t arg2, uint32_t arg3 )

{

    uint32_t fd, len;

    char *data;

    char *tmp;

    int rv;

    printf( "Got syscall: %d\n", syscall );

    switch( syscall ) {

    case SYS_READ:

        fd = arg1;

        data = (char *)(AICA_RAM_BASE + (arg2 & 0x001FFFFF));

        len = arg3;

        tmp = malloc(len);

        rv = read( fd, data, len );

        if( rv >= 0 ) 

            memcpy_to_aica( data, tmp, rv );

        free(tmp);

        return rv;

    case SYS_WRITE:

        fd = arg1;

        data = (char *)(AICA_RAM_BASE + (arg2 & 0x001FFFFF));

        len = arg3;

        tmp = malloc(len);

        memcpy(tmp, data, len);

        rv = write( fd, tmp, len );

        free(tmp);

        return rv;

    }

    return 0;

}

int main( int argc, char *argv[] ) 

{

    char buf[65536] __attribute__((aligned(32)));

    uint32_t aica_addr = AICA_RAM_BASE;

    int len;

    int totallen = 0;

    aica_disable();

    /* Load ARM program from stdin and copy to ARM memory */

    while( (len = read(0, buf, sizeof(buf))) > 0 ) {

        if(memcpy_to_aica( aica_addr, buf, len ) != 0 ) {

            printf( "Failed to load program!\n" );

            return 1;

        }

        aica_addr += len;

        totallen += len;

    }

    printf( "Program loaded (%d bytes)\n", totallen);

    /* Main loop waiting for IO commands */

    aica_enable();

    do {

        g2_fifo_wait();

        irq_disable();

        int syscall = long_read(AICA_SYSCALL);

        irq_enable();

        if( syscall != -1 ) {

            if( syscall == -2 ) {

                fprintf( stderr, "ARM aborted with general exception\n" );

                return -2;

            } else if( syscall == SYS_EXIT ) {

                printf( "Exiting at ARM request\n" );

                aica_disable();

                return long_read(AICA_SYSCALL_ARG1);

            } else {

                uint32_t result = do_syscall( syscall, long_read(AICA_SYSCALL_ARG1), 

                        long_read(AICA_SYSCALL_ARG2), long_read(AICA_SYSCALL_ARG3) );

                g2_fifo_wait();

                irq_disable();

                long_write( AICA_SYSCALL_RETURN, result );

                long_write( AICA_SYSCALL, -1 );

                irq_enable();

            }

        }

    } while( 1 );

}