/*=================================================================
//
//        slebstak.c
//
//        SPARClite HAL exception and register manipulation test
//
//==========================================================================
//####COPYRIGHTBEGIN####
//                                                                          
// -------------------------------------------                              
// The contents of this file are subject to the Red Hat eCos Public License 
// Version 1.0 (the "License"); you may not use this file except in         
// compliance with the License.  You may obtain a copy of the License at    
// http://sourceware.cygnus.com/ecos                                        
//                                                                          
// Software distributed under the License is distributed on an       
// basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.  See the 
// License for the specific language governing rights and limitations under 
// the License.                                                             
//                                                                          
// The Original Code is eCos - Embedded Configurable Operating System,      
// released September 30, 1998.                                             
//                                                                          
// The Initial Developer of the Original Code is Red Hat.                   
// Portions created by Red Hat are                                          
// Copyright (C) 1998, 1999, 2000 Red Hat, Inc.                             
// All Rights Reserved.                                                     
// -------------------------------------------                              
//                                                                          
//####COPYRIGHTEND####
//==========================================================================
//#####DESCRIPTIONBEGIN####
//
// Author(s):     dsm
// Contributors:    dsm, nickg
// Date:          1998-06-18
//####DESCRIPTIONEND####
*/

#include <pkgconf/system.h>

#include <pkgconf/hal.h>

#include <cyg/infra/cyg_type.h>

#include <cyg/infra/cyg_ass.h>

#include <cyg/infra/testcase.h>

#include <cyg/hal/hal_arch.h>
#include <cyg/hal/hal_intr.h>
#include <cyg/hal/hal_diag.h>
#include <cyg/hal/hal_clock.h>

#include <pkgconf/infra.h>

#include <cyg/infra/diag.h>

// -------------------------------------------------------------------------

cyg_uint32 fact( cyg_uint32 arg )
{
    cyg_uint32 ret = (arg < 2) ? 1 : (arg * fact( arg - 1 ));
    return ret;
}


// -------------------------------------------------------------------------

int i, j=0, bit;
int level[8];
#define led (*(volatile char *)(0x02000003))
int lval = 0;

int sequence[] = { 0, 0, 1, 1, 2, 3, 4, 5, 6, 6, 7, 7, 7, 7, 6, 6, 5, 4, 3, 2, 1, 1, 0, 0,
 };

int nseq=(sizeof(sequence)/sizeof(sequence[0])-1);

void set_leds( void ) // and decay them too
{
  int i, j;
  for (j=0; j<50; j++)
    {
      for (i=0; i<256; i++)
        {
          lval = 0;
          for (bit=0; bit<8; bit++)
            if (i >= level[bit])
              lval |= 1<<bit;
          led = lval;
        }
#define N 1
    for (i=0; i<8; i++)
      if (level[i] != 256)
        {
          if (level[i] > 0)
            level[i] -= N;
          else
            level[i] = 0;
        }
    }
}

void start( void )
{
    int op = 0;
    int bright = 255;
    cyg_uint32 f0;

#if 0
    while ( 1 ) {
#else
    int z;
    for ( z = 0; z < 100; z++ ) {
#endif
        f0 = 1;
        for (op=0; op<nseq; op++) {
            HAL_DIAG_WRITE_CHAR( 'A' + op );
            level[sequence[op]] = bright;
            set_leds();
            if ( op ) {
                int f1 = fact( op );
                f0 *= op;
                if ( f0 != f1 ) {
                    while ( 1 ) {
                        led = op;
                        CYG_TEST_FAIL_EXIT( "Factorial wrong" );
                    }
                }
            }
        }
        HAL_DIAG_WRITE_CHAR( '\n' );
        HAL_DIAG_WRITE_CHAR( '\r' );

        CYG_TEST_PASS( "Stack thrashed OK" );
    }
}

// -------------------------------------------------------------------------

externC void
#ifdef CYGPKG_KERNEL
cyg_user_start( void )
#else
cyg_start( void )
#endif
{
    CYG_TEST_INIT();
    CYG_TEST_INFO( "cyg_user_start()" );
    HAL_ENABLE_INTERRUPTS();
    start();
    CYG_TEST_EXIT( "LED bibbling and stack thrashing test" );
}

// -------------------------------------------------------------------------

/* EOF slebstak.c */