//********************************************************
//
//  file serial.c
//
//  serial console functions by Teunis van Beelen
//
//  teuniz@gmail.com
//
//  for use with BoostC
//
//  revised on 19-12-2005
//
//********************************************************

#include "rs232.h"


volatile unsigned char   RecFifo[FIFO_SIZE_A], RecFifoCnt1=0, RecFifoCnt2=0,
                         SndFifo[FIFO_SIZE_A], SndFifoCnt1=0, SndFifoCnt2=0;


//*****************  SERIAL IO  ***************************

void putch(unsigned char byte)    //  sends a byte to serial port
{
BEGIN_PUTCH:

   if(SndFifoCnt1>SndFifoCnt2)
   {
      if((SndFifoCnt1-SndFifoCnt2)>FIFO_SIZE_B)  goto BEGIN_PUTCH;   //  buffer full
   }
   if(SndFifoCnt1<SndFifoCnt2)
   {
      if((SndFifoCnt2-SndFifoCnt1)<2)  goto BEGIN_PUTCH;   //  buffer full
   }
   clear_bit(intcon,GIE);     // disable interrupts
   SndFifo[SndFifoCnt1] = byte;
   if(SndFifoCnt1<FIFO_SIZE)   SndFifoCnt1++;
   else SndFifoCnt1 = 0;
   set_bit(pie1,TXIE);
   set_bit(intcon,GIE);      //  enable interrupts
}


void print_long_dec(unsigned long q)
{
  unsigned char flag=0, z=0, i=0;

  unsigned long base = 1000000000;

  if(!q)
  {
    putch('0');
    return;
  }

  for(i=10; i; i--)
  {
    z = q / base;
    q %= base;
    if(z||flag)
    {
      putch('0' + z);
      flag = 1;
    }
//    else  putch(' ');
    base /= 10;
  }
}


void print_short_dec(unsigned short q)
{
  unsigned char flag=0, z=0, i=0;

  unsigned short base = 10000;

  if(!q)
  {
    putch('0');
    return;
  }

  for(i=5; i; i--)
  {
    z = q / base;
    q %= base;
    if(z||flag)
    {
      putch('0' + z);
      flag = 1;
    }
//    else  putch(' ');
    base /= 10;
  }
}


void print_dec(unsigned char q)
{
  unsigned char flag=0, z=0, i=0;

  unsigned char base = 100;

  if(!q)
  {
    putch('0');
    return;
  }

  for(i=3; i; i--)
  {
    z = q / base;
    q %= base;
    if(z||flag)
    {
      putch('0' + z);
      flag = 1;
    }
//    else  putch(' ');
    base /= 10;
  }
}


unsigned char kbhit(void)                //  checks serial port receiver
{
  if(RecFifoCnt1!=RecFifoCnt2)   return(1);
  else return(0);
}

unsigned char getch(void)                // receives a byte from the serial port
{
  unsigned char byte;

  byte = RecFifo[RecFifoCnt2];
  if(RecFifoCnt2<FIFO_SIZE)   RecFifoCnt2++;
  else   RecFifoCnt2 = 0;
  return(byte);
}


void cprintf(const unsigned char* text)  // sends a string to serial port
{
  while(*text != 0)   putch(*(text++));
}