/**

 * $Id: testdisp.c,v 1.1 2007-01-03 09:05:13 nkeynes Exp $

 *

 * Display (2D) tests. Mainly tests video timing / sync (obviously

 * it can't actually test display output since there's no way of

 * reading the results)

 *

 * These tests use TMU2 to determine absolute time

 * 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 <stdlib.h>

#include <stdio.h>

#include "lib.h"

#include "asic.h"

#define PVR_BASE 0xA05F8000

#define BORDERCOL   (PVR_BASE+0x040)

#define DISPCFG1 (PVR_BASE+0x044)

#define DISPADDR1 (PVR_BASE+0x050)

#define DISPADDR2 (PVR_BASE+0x054)

#define DISPSIZE (PVR_BASE+0x05C)

#define HPOSEVENT (PVR_BASE+0x0C8)

#define VPOSEVENT (PVR_BASE+0x0CC)

#define DISPCFG2 (PVR_BASE+0x0D0)

#define HBORDER (PVR_BASE+0x0D4)

#define VSYNC (PVR_BASE+0x0D8)

#define VBORDER (PVR_BASE+0x0DC)

#define HSYNC (PVR_BASE+0x0E0)

#define DISPCFG3 (PVR_BASE+0x0E8)

#define HPOS     (PVR_BASE+0x0EC)

#define VPOS     (PVR_BASE+0x0F0)

#define SYNCSTAT (PVR_BASE+0x10C)

#define MAX_FRAME_WAIT 0x10000000

#define WAIT_LINE( a ) if( wait_line(a) != 0 ) { fprintf(stderr, "Timeout at %s:%d:%s() waiting for line %d\n", __FILE__, __LINE__, __func__, a ); return -1; }

#define WAIT_LASTLINE( a ) if( wait_lastline(a) != 0 ) { fprintf(stderr, "Last line check failed at %s:%d:%s() waiting for line %d\n", __FILE__, __LINE__, __func__, a ); return -1; }

void dump_display_regs( FILE *out )

{

    fprintf( out, "%08X DISPCFG1:  %08X\n", DISPCFG1, long_read(DISPCFG1) );

    fprintf( out, "%08X DISPCFG2:  %08X\n", DISPCFG2, long_read(DISPCFG2) );

    fprintf( out, "%08X DISPCFG3:  %08X\n", DISPCFG3, long_read(DISPCFG3) );

    fprintf( out, "%08X DISPSIZE:  %08X\n", DISPSIZE, long_read(DISPSIZE) );

    fprintf( out, "%08X HBORDER:   %08X\n", HBORDER, long_read(HBORDER) );

    fprintf( out, "%08X VBORDER:   %08X\n", VBORDER, long_read(VBORDER) );

    fprintf( out, "%08X HSYNC:     %08X\n", HSYNC, long_read(HSYNC) );

    fprintf( out, "%08X VSYNC:     %08X\n", VSYNC, long_read(VSYNC) );

    fprintf( out, "%08X DISPADDR1: %08X\n", DISPADDR1, long_read(DISPADDR1) );

    fprintf( out, "%08X DISPADDR2: %08X\n", DISPADDR2, long_read(DISPADDR2) );

    fprintf( out, "%08X HPOSEVENT: %08X\n", HPOSEVENT, long_read(HPOSEVENT) );

    fprintf( out, "%08X VPOSEVENT: %08X\n", VPOSEVENT, long_read(VPOSEVENT) );

    fprintf( out, "%08X HPOS:      %08X\n", HPOS, long_read(HPOS) );

    fprintf( out, "%08X VPOS:      %08X\n", VPOS, long_read(VPOS) );

    fprintf( out, "%08X SYNCSTAT:  %08X\n", SYNCSTAT, long_read(SYNCSTAT) );

}

uint32_t pal_settings[] = {

    DISPCFG1, 0x00000001,

    DISPCFG2, 0x00000150,

    DISPCFG3, 0x00160000,

    DISPSIZE, 0x1413BD3F,

    HBORDER, 0x008D034B,

    VBORDER, 0x00120102,

    VSYNC, 0x0270035F,

    HSYNC, 0x07D6A53F,

    HPOS, 0x000000A4,

    VPOS, 0x00120012,

    0, 0 };

void apply_display_settings( uint32_t *regs ) {

    int i;

    for( i=0; regs[i] != 0; i+=2 ) {

	long_write( regs[i], regs[i+1] );

    }

}

/**

 * Wait until the given line is being displayed (ie is set in the syncstat

 * register).

 * @return 0 if the line is reached before timeout, otherwise -1.

 */

int wait_line( int line )

{

    int i;

    for( i=0; i< MAX_FRAME_WAIT; i++ ) {

	uint32_t sync = long_read(SYNCSTAT) & 0x03FF;

	if( sync == line ) {

	    return 0;

	}

    }

    return -1;

}

/**

 * Wait until just after the last line of the frame is being displayed (according

 * to the syncstat register). After this function the current line will be 0.

 * @return 0 if the last line is the given line, otherwise -1.

 */

int wait_lastline( int line )

{

    int lastline = -1, i;

    for( i=0; i< MAX_FRAME_WAIT; i++ ) {

	uint32_t sync = long_read(SYNCSTAT) & 0x03FF;

	if( sync == 0 && lastline != -1 ) {

	    CHECK_IEQUALS( line, lastline );

	    return 0;

	}

	lastline = sync;

    }

    fprintf( stderr, "Timeout waiting for line %d\n", line );

    return -1;

}

int test_ntsc_timing() {

    return 0;

}

int test_pal_timing() 

{

    uint32_t line_time, field_time;

    /* Set PAL display mode */

    apply_display_settings( pal_settings );

    asic_clear();

    /* Check basic frame timings: 31.919 us per line, 19.945 ms per field  */

    /* Wait for a line 0 (either frame) */

    WAIT_LINE(0);

    timer_start();

    WAIT_LINE(1);

    line_time = timer_gettime_us();

    WAIT_LASTLINE(624);

    field_time = timer_gettime_us();

    fprintf( stdout, "Line time: %dus, frame time: %dus\n", line_time, field_time );

    // CHECK_IEQUALS( 31, line_time );

    CHECK_IEQUALS( 19949, field_time );

    dump_display_regs( stdout );

    return 0;

}

/********************************* Main **************************************/

typedef int (*test_func_t)();

test_func_t test_fns[] = { test_ntsc_timing, test_pal_timing,

			   NULL };

int main() 

{

    return run_tests( test_fns );

}