/*  load_flash_ram_seq.c
    Load sequential data into flash ram

    Written by:  Rod Klein
    Date:        July 23, 1998

    Rev. History:

*/

/*  Include Files  */

#include <stdio.h>
#include "VISION.h"
#include "tracker.h"
#include "functions.h"
 
/*  Start program  */

void load_flash_ram_seq() 
{
  int i, j;
  int count;
  unsigned int data;
  unsigned int bytes;
  unsigned int status;
  unsigned int fl_cmd;
  unsigned int fl_addr;
  unsigned int fl_data;
  unsigned int bank_len;
  unsigned int seq_addr[] = {0x555, 0x2AA, 0x555};
  unsigned int seq_data[] = {0xAA, 0x55, 0xA0};

  i = 0;
  j = 0;
  data = 0;
  bytes = 0;
  count = 0;
  status = 0;
  fl_cmd = 0;
  fl_addr = 0;
  fl_data = 0;
  bank_len = 0;

  flash_bank_len( &bank_len);

  for( i=0; i<bank_len; i++ )
  {
    for( j=0; j<3; j++ )
    {
      fl_addr = FLASH_RAM | (seq_addr[j] << 2);
      fl_cmd = (seq_data[j] << 24) | seq_data[j];
 
      status = VISIONwrite( finder, fl_addr, WORD_LEN, &bytes, &fl_cmd);
      if( status != 0 )  perror(" load_flash_ram_seq: VISIONwrite");
    }
    fl_addr = FLASH_RAM | (i << 2);
    data = (i & 0xFF) << 24;
    status = VISIONwrite( finder, fl_addr, WORD_LEN, &bytes, &data);
    if( status != 0 )  perror(" load_flash_ram_seq: VISIONwrite");

    status = VISIONread( finder, fl_addr, WORD_LEN, &bytes, &fl_data);
    if( status != 0 )  perror(" load_flash_ram_seq: VISIONread");

    fl_data = fl_data & 0xFF000000;
    while( fl_data != data )
    {
       status = VISIONwrite( finder, fl_addr, WORD_LEN, &bytes, &data);
       if( status != 0 )  perror(" load_flash_ram_seq: VISIONwrite");

       status = VISIONread( finder, fl_addr, WORD_LEN, &bytes, &fl_data);
       if( status != 0 )  perror(" load_flash_ram_seq: VISIONread");

       count++;
       if( count > 100)
       {
          printf("\n After 100 attempts, unable to load address %X with data - %02X\n", i, data>>24);
          return;
       }
    }
  }
}