#include "commdrv.h"
#include <conio.h>
#include <stdio.h>
#include <process.h>
#include <string.h>

const int base = 0x300;

void ErrorCheck (char checkstring[255])
{
   char Error;
   Error = strcmp(checkstring, "??ERROR!");
   if (Error == 0) {
      puts("A communications error has occurred!");
      exit(Error == 0);}
}

void DrawBits(int mask)
{
  int i,x = 0;
  gotoxy(50,9);
  puts("    Bit Mask");
  gotoxy(50,10);
  puts("6  5  4  3  2  1  0");
  gotoxy(50,wherey()+1);
  textcolor(WHITE);
  for (i = 6; i >= 0; i--){
    if (mask & (1<<i))
       cprintf("O  ");
    else
       cprintf("I  ");
  }
  textcolor(LIGHTGRAY);
}

void main(void)
{
   int x,y;
   char retstring[255];
   char check;
   char key;
   char MyStr[255];
   char bitstring[255];
   int value;
   int done = 0;
   int bitmask = 0;
   unsigned int bitnum = 0;
   clrscr();
   initCommCard(base, 28800);           //H
   printf("Press a key to say hello to the Pod...\n");
   getch();
   writePod(base,"H");
   readPod(base, retstring);
   printf("%s\n", retstring);
   check = strcmp(retstring, "??ERROR!");
   if (check == 0) {
      puts("A communications error has occurred!");
      puts("Baud rate must be set at 28800.");
      exit(check == 0);
   }
   puts("");
   puts("RA1216 Digital Sample");
   puts("");
   puts("Select an option from the following menu.");
   puts("Refer to the diagram to the right for I/O mask.");
   puts("");
   puts("1. Set all bits for input.");               //M00
   puts("2. Set all bits for output.");              //MFF
   puts("3. Configure individual bit for input.");   //Mn-
   puts("4. Configure individual bit for output.");  //Mn+
   puts("5. Read all bits.");                        //I
   puts("6. Read individual bit.");                  //In
   puts("7. Write to all bits.");                    //Oxx
   puts("8. Set individual bit high or low.");       //Ox+/-
   puts("Q  Exit program.");
   while(!done){
     key=getch();
     switch(key){
       case '1': clreol();
		 writePod(base,"M00");       //Mxx
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 puts("All bits set for input.");
		 gotoxy(1,wherey()-1);
		 bitmask = 0;               //for display in DrawBits
		 break;

       case '2': clreol();
		 writePod(base, "MFF");      //Mxx
		 readPod(base,retstring);
		 ErrorCheck (retstring);
		 puts("All bits set for output.");
		 gotoxy(1,wherey()-1);
		 bitmask = 0xff;             //for display in DrawBits
		 break;

       case '3': clreol();
		 printf("Enter bit number to configure for input (0-6) >");//Mx-
		 scanf("%u",&bitnum);
		 sprintf(MyStr,"M%u-",bitnum);
		 clreol();
		 printf("Bit %u configured for input.\n",bitnum);
		 bitmask = bitmask & ~(1<<bitnum); //display in DrawBits
		 gotoxy(1,wherey()-2);
		 writePod(base, MyStr);
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 break;

       case '4': clreol();
		 printf("Enter bit number to configure for output (0-6) > ");//Mx+
		 scanf("%u",&bitnum);
		 sprintf(MyStr,"M%u+",bitnum);
		 clreol();
		 printf("Bit %u configured for output.\n",bitnum);
		 bitmask = bitmask | (1<<bitnum); //display in DrawBits
		 gotoxy(1,wherey()-2);
		 writePod(base, MyStr);
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 break;

       case '5': clreol();
		 writePod(base, "I");        //I
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 printf("Value read: %s\n", retstring);
		 gotoxy(1,wherey()-1);
		 break;

       case '6': clreol();
		 printf("Enter bit number to read (0-6) >");  //In
		 scanf("%u",&bitnum);
		 sprintf(MyStr,"I%u",bitnum);
		 writePod(base, MyStr);
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 clreol();
		 printf("Bit %u is %s\n", bitnum,retstring);
		 gotoxy(1,wherey()-2);
		 break;

       case '7': clreol();
		 printf("Enter a value to write (hex) >");//Oxx
		 scanf("%x",&value);
		 clreol();
		 printf("Value written: %x",value);
		 sprintf(MyStr,"O%02x",value);
		 gotoxy(1,wherey()-1);
		 writePod(base, MyStr);
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 break;

       case '8': clreol();
		 printf("Enter bit number, followed by + for one or a - for zero.\n");
		 clreol();
		 printf("Ex.: 3+");
		 scanf("%s",&bitstring);
		 gotoxy(1,wherey()-2);
		 sprintf(MyStr,"O%s",bitstring);
		 writePod(base, MyStr);
		 readPod(base, retstring);
		 ErrorCheck (retstring);
		 break;

       case 'q': case 'Q': done = 1; break;
       }
       x = wherex();
       y = wherey();
       DrawBits(bitmask);
       gotoxy(x,y);
    }

   puts("\n");
   puts("\n");
   printf("Exiting the RA1216 Digital sample program.\n");

}