// Copyright 2006 Yamane Akira
//Proto 
//ICC-AVR application builder : 2005/12/26 13:19:01
// Target : M168
// Crystal: 8.0000Mhz

#include <iom168v.h>
#include <macros.h>
#include <assemblyBL.h>

#define PROGPORT PORTD
#define PROGPIN PIND
#define PROGCTRL (1<<PD2)
#define PROGMODE !(PROGPIN & PROGCTRL)  

    unsigned int buffer[64];
	unsigned int *pbuffer;
	char Start_msg[] = "\n\r Input Buff Data : \n\r";
	char Prompt_PgNo[] = "\n\r Input Page#:"; 
    char Query_msg[] = " Again,Next,Exit?: ";
	char Prompt_Op[] = " Write Page(Y/N): ";
	
void port_init(void)
{
 PORTB = 0xFF;
 DDRB  = 0x00;
 PORTC = 0x7F; 
 DDRC  = 0x00;
 PORTD = 0xFF;
 DDRD  = 0x00;
}

//UART0 initialize
// desired baud rate: 19200
// actual: baud rate:19231 (0.2%)
void uart0_init(void)
{
 UCSR0B = 0x00; //disable while setting baud rate
 UCSR0A = 0x00;
 UCSR0C = 0x06;
 UBRR0L = 0x19; //set baud rate lo
 UBRR0H = 0x00; //set baud rate hi
 UCSR0B = 0x18;
}

void init_devices(void)
{
 CLI(); //disable all interrupts
 port_init();
 uart0_init();
}

unsigned char rec_char(void)
    {
	 while (!(UCSR0A & (1<<RXC0)));
	 return UDR0;
    }
	
void send_char(unsigned char dta)
    {
	 while (!(UCSR0A & (1<<UDRE0)));
	 UDR0 = dta;
    }

// Input a Char, return Hex Byte	
unsigned int in_hex(void)
    {
     unsigned char indata, i;
	 unsigned int  hexdata;
	  i =0; 
	  hexdata=0x0000;
	while (i<4) 
	 {
	  indata = rec_char(); 
	  i++;
      if ((indata >= '0') && (indata<='9'))
	   {
	    send_char(indata);
		indata = indata - '0';
	   }
	  else if ((indata >='A') && (indata <= 'F'))
	   {
	    send_char(indata);
	    indata = indata - 0x37; 
	   }
	    else 
		 {
		  // i=0x0f;
		   return(hexdata);
		 }
	   hexdata = ((hexdata<<4) | indata); 
	  }
	 return hexdata;	
	}

void send_nbl2ahex(unsigned char char_data)
    {
	  unsigned char hexchar;
	    char_data = char_data & 0x0F;
	  if (char_data <= 9)
	   hexchar = char_data + '0';
	   else
	   hexchar = char_data + 0x37;
	   send_char(hexchar);
	}

void string_out(char *msg_string)
  {
    unsigned char i;
	  i=0;
     while (msg_string[i] !='\0')
	   {
	   send_char(msg_string[i]);
	    i++;
       }
  } 

void send_int(unsigned int int_no)
   {   
    send_nbl2ahex((char)(int_no>>12));
    send_nbl2ahex((char)(int_no>>8));
    send_nbl2ahex((char)(int_no>>4));
    send_nbl2ahex((char)(int_no));	
	}
   
void main(void)
{
    void (*funcptr)( void ) = 0x0000;       // Set up function pointer   
   
    unsigned int adr;
	unsigned int data;
	unsigned char command,indata;
	unsigned char  page,i,j;

 init_devices();
     PROGPORT |= PROGCTRL;      //enable pull-up on PROGCTRL line on PROGPORT
    if (PROGMODE)               //If PROGPIN is pulled low: programmingmode. 
      {    	   
	    while(1)
		 {   
		   string_out(Start_msg);
		  for (adr=0; adr<64; adr++) 
		   buffer[adr]=0xFF;
		   adr = 0x00;
		  while (adr < 64) 
		     {   
              send_int(adr);
		      send_char('-');	    
			    buffer[adr] = in_hex();
		      string_out(Query_msg);
		        command = rec_char();
			      if (command =='A')
			          ;
				  else if (command =='N')
		             adr++;
				  else 
				     adr=64;
			      send_char(0x0d);	send_char(0x0a);	
              }
		    string_out(Prompt_PgNo);
		       page=in_hex();
			   adr=page*128;
		    string_out(Prompt_Op);
		      command=rec_char();
			   if ((command) == 'Y')
			      write_page(adr,buffer);			
		 }
       }
}