/*--------------------------------------------------------*/
/*  WQ21ST SOFTWARE	STUDIO.			                  	  */
/*--------------------------------------------------------*/
/*  Switch Test for TMS320LF2407 EVM			          */
/*--------------------------------------------------------*/
/*  file name:	 sw_4p.c				                  */
/*  Started on:  08/11/2001    by: WQ			          */
/*  Last update: 08/28/2001    by: WQ				      */
/*--------------------------------------------------------*/


#include "sw_4p.h"
#include "prot2407.h"


unsigned int get_sw(void);


volatile unsigned int ti_swled_data;
volatile unsigned int ti_sw_data;


#define MIN_SW		    1
#define MAX_SW		    5
#define MAX_SW_SHIFT   0x0010
#define SWITCH_MASK    0x000F


void ti_swled_on( unsigned int led_num )
{
  unsigned int pattern;

  pattern = 0x0001;

  while (--led_num)
  {
    pattern <<= 1;        /* move bit over */
  }
  ti_swled_data |= pattern;

  OUTMAC( _TI_LED, ti_swled_data);     /* turn on the led */
}


void ti_swled_off( unsigned int led_num )
{
  unsigned int pattern;

  pattern = 0x0001;

  while (--led_num)
  {
    pattern <<= 1;        /* move bit over */
  }
  ti_swled_data &= (~pattern);

  OUTMAC( _TI_LED, ti_swled_data);     /* turn off the led */

}


unsigned int ti_read_sw(void)
{
  unsigned int sw_image;

  sw_image = 0x0000;
  ti_sw_data = 0xffff;

  while (sw_image != ti_sw_data)
  {

    wait_ms( 2 );

    sw_image = get_sw();

    wait_ms( 2 );

    ti_sw_data = get_sw(); 
        
 
  }

  return(ti_sw_data);
}



unsigned int wait_on_sw(unsigned int pattern)
{
  unsigned int switches;

  switches = (~pattern);


  while( switches != pattern )	  /* does sw == requested ? */
  {
       switches = ti_read_sw();
  }
}


unsigned int ti_sw_test(void)
{
  unsigned int sw_err, ctr, temp;
   
  sw_err = 0;                         /* show no error */



  for (ctr=MIN_SW; ctr < MAX_SW; ctr++) 	  /* turn all leds on */
  {
    ti_swled_on(ctr);
  }

  wait_on_sw(0x0000);                 /* make sure all switches are off */

  for (ctr=MIN_SW;ctr < MAX_SW;ctr++)		/* turn all leds off */
  {
    ti_swled_off(ctr);
  }

  ctr = 0x0001;
  temp = 1;                          /* set led # */

  while (ctr != MAX_SW_SHIFT)
  {
    wait_on_sw(ctr);		       /* wait for sw2-1-4 on only */
    ti_swled_on(temp);                 /* turn on new led */

    wait_on_sw((unsigned int)0);
    ti_swled_off(temp);                /* turn off previous led */

    ctr <<= 1;                         /* shift sw pattern */
    temp++;                            /* next led */
  }

  wait_on_sw((unsigned int)0);         /* all switches off */
  ti_swled_off((unsigned int)4);       /* turn off last led */

  return(sw_err);
}


unsigned int get_sw(void)
{
    unsigned int sw_image;


    INMAC( _TI_SW, ti_sw_data);
    sw_image = ti_sw_data;

    sw_image &= SWITCH_MASK;

    return(sw_image);
}