#include <gb/gb.h>
#include <stdio.h>

#define SEND \
        SC_REG = 0x81;\
        while(SC_REG & 0x80)
#define RECEIVE \
        SC_REG = 0x80;\
        while(SC_REG & 0x80)

char writeFileName[] = "binaryw.dat";
char readFileName[] = "binaryr.dat";

//1バイト転送完了
void byteReceived()
{
    SC_REG &= 0x7f; //通信停止
}

void sendData(UBYTE* p, UWORD size)
{
    UWORD i, m;

    printf("\nWrite to %s\n", writeFileName);
    printf("size : %d\n", size);
    m = size / 19;

    //書き込みコマンド送信
    SB_REG = 1;
    SEND;
    //ファイルサイス送信
    SB_REG = (UBYTE)((size & 0xff00) >> 8);
    SEND;
    SB_REG = (UBYTE)(size & 0xff);
    SEND;
    //ファイル名送信
    for(i=0; i<sizeof(writeFileName); i++)
    {
        SB_REG = writeFileName[i];
        SEND;
    }
    //データ送信
    for(i=0; i<size; i++)
    {
        SB_REG = *p;
        SEND;
        ++p;
        if((i % m) == 0)
            putchar('*');
    }

    printf("Finish!\n");
}

void receiveData(UBYTE* p)
{
    UBYTE i;
    UWORD size, j, m;

    printf("\nRead from %s\n", readFileName);

    //読み込みコマンド送信
    SB_REG = 2;
    SEND;
    //ファイル名送信
    for(i=0; i<sizeof(readFileName); i++)
    {
        SB_REG = readFileName[i];
        SEND;
    }

    //ファイルサイズ受信
    RECEIVE;
    size = SB_REG;
    size <<= 8;
    RECEIVE;
    size += SB_REG;

    printf("size : %d\n", size);
    m = size / 19;

    //データ受信
    for(j=0; j<size; j++)
    {
        RECEIVE;
        *p = SB_REG;
        ++p;
        if((j % m) == 0)
            putchar('*');
    }

    printf("Finish!\n");
}

void main()
{
    UBYTE joy;
    UBYTE *mem;
    int i;
    
    //RAMにデータ書き込み
    mem = (UBYTE*)0xA000;
    for(i=0; i<0x2000; i++)
        mem[i] = (UBYTE)i;

    set_interrupts(SIO_IFLAG);
    add_SIO(byteReceived);

    puts("push A...Write Data");
    puts("  or");
    puts("push B...Read Data");

    while(TRUE)
    {
        joy = joypad();

        if(joy & J_A) //書き込み
        {
            sendData(mem, 0x2000);
            waitpadup();
        }

        if(joy & J_B) //読み込み
        {
            receiveData(mem);
            waitpadup();
        }
    }
}