// simpleFIC.cpp : Defines the entry point for the console application.
//

#include "stdafx.h"
#include "FIC.hpp"
#include <conio.h>


int main(int argc, char* argv[])
{
	printf("Hello World!\n");
	printf("Please enter the crate number.\n");
	unsigned int crate;
	scanf("%d",&crate);
	unsigned int slot=5;
	printf("Initializing FIC in slot %d of crate %d.\n",slot,crate);

	FIC myfic(crate,slot);
	int i,ichoice,keeplooping=1, emchoice=1;
	int ichoice1,iloop1=1, nerror=0;
	int clear=0, protocolErrs=0, evttot=0, evti=1;
	int foreva=1,data_nevts=0, emptyfifo=1;;
	unsigned short datach0[160],datach1[160],datach2[160],datach3[160];
	unsigned int data1[160];
	unsigned short data2[160];
	int nevts=0;

	while(keeplooping) {
		printf("Please enter a number:\n");
		printf(" 0: Quit.\n");
		printf(" 1: set up the FIC initially.\n");
		printf(" 2: turn emission off.\n");
		printf(" 3: Turn emission on.\n");
		printf(" 4: enable channels 0 and 1.\n");
		printf(" 5: Enable channels 2 and 3.\n");
		printf(" 6: disable all chanels.\n");
		printf(" 7: send events\n");
		printf(" 8: test submenu.\n");
		printf(" 9: Diagnostic submenu.\n");
		printf("10: Send and Receive events over VME.\n");
		printf("11: Receive events over VME.\n");
		//
		// get the user choice.
		//
		scanf("%d",&ichoice);
		//
		switch(ichoice) {
		case 0:
			keeplooping=0;
			break;
		case 1:
			myfic.setup();
			break;
		case 2:
			myfic.emissionOff();
			emchoice=0;
			break;
		case 3:
			myfic.emissionOn();
			emchoice=1;
			break;
		case 4:
			for(i=0;i<2;i++) myfic.enableChannel(i);
			break;
		case 5:
			for(i=2;i<4;i++) myfic.enableChannel(i);
			break;
		case 6:
			for(i=0;i<4;i++) myfic.disableChannel(i);
			break;
		case 7:
			myfic.emissionOn();
			int i,nevents;
			printf("How many events?\n");
			scanf("%d",&nevents);
			for (i=0;i<nevents;i++) {
			myfic.sendStandardEvent(1);
			myfic.sendStandardEvent(2);
			}
			break;
		case 8:
			// this is the test submenu.
			iloop1=1;
			while(iloop1) {
				printf("Please enter a number for a test to run:\n");
				printf(" 0: Quit the submenu.\n");
				printf(" 1: send events to a FIFO.\n");
				printf(" 2: test histogramming functionality.\n");
				printf(" 3: Get event counts\n");
				printf(" 4: Get G-Link error counts.\n");
				printf(" 5: Get State Machine Status\n");
				printf(" 6: Get Fifo status\n");
				printf(" 7: Get error flags\n");
				printf(" 8: Clear monitoring area\n");
				printf(" 9: Monitor\n");
				printf("10: Monitor Histogram only\n");
				printf("11: Test integrity of VME read\n");


				//
				// get the users choice
				//
				scanf("%d",&ichoice1);
				//
				switch(ichoice1) {
				case 0:
					iloop1=0;
					break;
				case 1:
					myfic.testFifoWrite();
					break;
				case 2:
					unsigned short j,hist0,hist1,hist2,hist4,hist8;
					unsigned short overfill; 
					//Get the histogram
					overfill=myfic.getHistogram(hist0,hist1,hist2,hist4,hist8);
					//Print out histogram values
					printf("Histogram values:\n hist0 = %d\n hist1 = %d\n",hist0,hist1);
					printf(" hist2 = %d\n hist4 = %d\n hist8 = %d\n",hist2,hist4,hist8);
					if (overfill==0) printf("No overfills\n");
					if (overfill&0x1) printf("hist0 overfill\n");
					if (overfill&0x2) printf("hist1 overfill\n");
					if (overfill&0x4) printf("hist2 overfill\n");
					if (overfill&0x8) printf("hist4 overfill\n");
					if (overfill&0x10) printf("hist8 overfill\n");
					printf("\n");
					//Print graphical histogram
					
					printf("hist0 :");
					for (j=0;j<hist0;j++) if (j<50) printf("*");
					printf("%x\n",hist0);
					printf("hist1 :");
					for (j=0;j<hist1;j++) if (j<50) printf("*");
					printf("%x\n",hist1);
					printf("hist2 :");
					for (j=0;j<hist2;j++) if (j<50) printf("*");
					printf("%x\n",hist2);
					printf("hist4 :");
					for (j=0;j<hist4;j++) if (j<50) printf("*");
					printf("%x\n",hist4);
					printf("hist8 :");
					for (j=0;j<hist8;j++) if (j<50) printf("*");
					printf("%x\n",hist8);
					
					break;
				case 3:
					unsigned char cnt0,cnt1,cnt2,cnt3;
					myfic.getFifoCounts(cnt0,cnt1,cnt2,cnt3);
					printf(" ______________________________ \n");
					printf("|  Fifo  |  | number of events |\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |     %2.2d           |\n",cnt0);
					printf("|   1    |  |     %2.2d           |\n",cnt1);
					printf("|   2    |  |     %2.2d           |\n",cnt2);
					printf("|   3    |  |     %2.2d           |\n",cnt3);
					printf("|______________________________|\n");
					break;

				case 4:
					unsigned char gerr0,gerr1,gerr2,gerr3;
					myfic.getGlinkErrors(gerr0,gerr1,gerr2,gerr3);
					printf(" ______________________________ \n");
					printf("| G-Link |  | number of errors |\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |       %2.2d         |\n",gerr0);
					printf("|   1    |  |       %2.2d         |\n",gerr1);
					printf("|   2    |  |       %2.2d         |\n",gerr2);
					printf("|   3    |  |       %2.2d         |\n",gerr3);
					printf("|______________________________|\n");
					break;

				case 5:
					unsigned char ch0,ch1,ch2,ch3;
					myfic.getFSMStaus(ch0,ch1,ch2,ch3);
					printf("0 = Both Out of Event\n");
					printf("1 = G-link Out, Hot link In\n");
					printf("2 = Should not occur\n");
					printf("3 = Both In-Event\n");
					printf(" ______________________________ \n");
					printf("|Channel |  |      Status      |\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |       %2d         |\n",ch0);
					printf("|   1    |  |       %2d         |\n",ch1);
					printf("|   2    |  |       %2d         |\n",ch2);
					printf("|   3    |  |       %2d         |\n",ch3);
					printf("|______________________________|\n");
					break;

				case 6:
					unsigned char fifo0,fifo1,fifo2,fifo3;
					myfic.getFifoStatus(fifo0,fifo1,fifo2,fifo3);
					printf("0 = Empty Fifo\n");
					printf("1 = FIFO has data, not full\n");
					printf("2 = Should not occur\n");
					printf("3 = Full Fifo\n");
					printf(" ______________________________ \n");
					printf("| FIFO   |  |      Status      |\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |       %2d         |\n",fifo0);
					printf("|   1    |  |       %2d         |\n",fifo1);
					printf("|   2    |  |       %2d         |\n",fifo2);
					printf("|   3    |  |       %2d         |\n",fifo3);
					printf("|______________________________|\n");
					break;
					
				case 7:
					unsigned char flag0,flag1,flag2,flag3;
					myfic.getErrorFlags(flag0,flag1,flag2,flag3);
					printf("bit 0 = Error counter overflow\n");
					printf("bit 1 = Protocol error\n");
					printf("bit 2 = More than 16 events entered\n");
					printf("bit 3 = Fifo Full\n");
					printf("bit 4 = G-Link not ready\n");
					printf(" ______________________________ \n");
					printf("|Channel |  |      Status      |\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |      0x%x        |\n",flag0);
					printf("|   1    |  |      0x%x        |\n",flag1);
					printf("|   2    |  |      0x%x        |\n",flag2);
					printf("|   3    |  |      0x%x        |\n",flag3);
					printf("|______________________________|\n");
					break;

				case 8:
					myfic.clearMonitor();
					break;

				case 9:
					while (!kbhit())
					{
					//Get the histogram
					printf("\n\n\n\n");
					overfill=myfic.getHistogram(hist0,hist1,hist2,hist4,hist8);
					//Print out histogram values
//					printf("Histogram values:\n hist0 = %d\n hist1 = %d\n",hist0,hist1);
//					printf(" hist2 = %d\n hist4 = %d\n hist8 = %d\n",hist2,hist4,hist8);
					if (overfill==0) printf("No overfills\n");
					if (overfill&0x1) printf("hist0 overfill\n");
					if (overfill&0x2) printf("hist1 overfill\n");
					if (overfill&0x4) printf("hist2 overfill\n");
					if (overfill&0x8) printf("hist4 overfill\n");
					if (overfill&0x10) printf("hist8 overfill\n");
					printf("\n");
					//Print graphical histogram
					
					printf("hist0 :");
					for (j=0;j<hist0;j++) if (j<50) printf("*");
					printf("%d\n",hist0);
					printf("hist1 :");
					for (j=0;j<hist1;j++) if (j<50) printf("*");
					printf("%d\n",hist1);
					printf("hist2 :");
					for (j=0;j<hist2;j++) if (j<50) printf("*");
					printf("%d\n",hist2);
					printf("hist4 :");
					for (j=0;j<hist4;j++) if (j<50) printf("*");
					printf("%d\n",hist4);
					printf("hist8 :");
					for (j=0;j<hist8;j++) if (j<50) printf("*");
					printf("%d\n",hist8);
					myfic.getFifoCounts(cnt0,cnt1,cnt2,cnt3);
					evttot = (evttot + cnt0 + cnt1 + cnt2 + cnt3);
					printf(" ______________________________ \n");
					printf("|  Fifo  |  | number of events |             Total Protocol errors: %d\n",protocolErrs);
					printf("|______________________________|             Average number of events per fifo: %d\n",(evttot/(evti*4))); 
					printf("|   0    |  |     %2.2d           |\n",cnt0);
					printf("|   1    |  |     %2.2d           |\n",cnt1);
					printf("|   2    |  |     %2.2d           |\n",cnt2);
					printf("|   3    |  |     %2.2d           |\n",cnt3);
					printf("|______________________________|\n");
					myfic.getGlinkErrors(gerr0,gerr1,gerr2,gerr3);
					printf(" ______________________________ \n");
					printf("| G-Link |  | number of errors |\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |       %2.2d         |\n",gerr0);
					printf("|   1    |  |       %2.2d         |\n",gerr1);
					printf("|   2    |  |       %2.2d         |\n",gerr2);
					printf("|   3    |  |       %2.2d         |\n",gerr3);
					printf("|______________________________|\n");
					myfic.getFSMStaus(ch0,ch1,ch2,ch3);
					printf(" ______________________________ \n");
					printf("|Channel |  |      Status      |              Status Key\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |       %2.2d         |     0 = Both Out of Event\n",ch0);
					printf("|   1    |  |       %2.2d         |     1 = G-link Out, Hot link In\n",ch1);
					printf("|   2    |  |       %2.2d         |     2 = Should not occur\n",ch2);
					printf("|   3    |  |       %2.2d         |     3 = Both In-Event\n",ch3);
					printf("|______________________________|\n");
					myfic.getFifoStatus(fifo0,fifo1,fifo2,fifo3);
					printf(" ______________________________ \n");
					printf("| FIFO   |  |      Status      |                Status Key\n");
					printf("|______________________________|\n"); 
					printf("|   0    |  |       %1.1d          |     0 = Empty Fifo\n",fifo0);
					printf("|   1    |  |       %1.1d          |     1 = FIFO has data, not full\n",fifo1);
					printf("|   2    |  |       %1.1d          |     2 = Should not occur\n",fifo2);
					printf("|   3    |  |       %1.1d          |     3 = Full Fifo\n",fifo3);
					printf("|______________________________|\n");
					myfic.getErrorFlags(flag0,flag1,flag2,flag3);
					if ((flag0&0x2) || (flag1&0x2) || (flag2&0x2) || (flag3&0x2)) protocolErrs++; 
					printf(" ______________________________ \n");
					printf("|Channel |  |      Status      |           Status Key\n");
					printf("|______________________________|    bit 0 = Error counter overflow\n"); 
					printf("|   0    |  |      0x%2.2x        |    bit 1 = Protocol error\n",flag0);
					printf("|   1    |  |      0x%2.2x        |    bit 2 = More than 16 events entered\n",flag1);
					printf("|   2    |  |      0x%2.2x        |    bit 3 = Fifo Full\n",flag2);
					printf("|   3    |  |      0x%2.2x        |    bit 4 = G-Link not ready\n",flag3);
					printf("|______________________________|\n");
					evti++;
					if (emchoice==1) myfic.clearMonitor();
					rsleep(100000);
					if (emchoice==0) myfic.emissionOff();
					}
					getchar();
					break;
				case 10:
					while (!kbhit())
					{
					//Get the histogram
					printf("\n\n\n\n");
					overfill=myfic.getHistogram(hist0,hist1,hist2,hist4,hist8);
					//Print out histogram values
//					printf("Histogram values:\n hist0 = %d\n hist1 = %d\n",hist0,hist1);
//					printf(" hist2 = %d\n hist4 = %d\n hist8 = %d\n",hist2,hist4,hist8);
//					if (overfill==0) printf("No overfills\n");
//					if (overfill&0x1) printf("hist0 overfill\n");
//					if (overfill&0x2) printf("hist1 overfill\n");
//					if (overfill&0x4) printf("hist2 overfill\n");
//					if (overfill&0x8) printf("hist4 overfill\n");
//					if (overfill&0x10) printf("hist8 overfill\n");
//					printf("\n");
					//Print graphical histogram
					
					printf("hist0 :");
//					for (j=0;j<hist0;j++) if (j<50) printf("*");
					printf("%d\n",hist0);
					printf("hist1 :");
//					for (j=0;j<hist1;j++) if (j<50) printf("*");
					printf("%d\n",hist1);
					printf("hist2 :");
//					for (j=0;j<hist2;j++) if (j<50) printf("*");
					printf("%d\n",hist2);
					printf("hist4 :");
//					for (j=0;j<hist4;j++) if (j<50) printf("*");
					printf("%d\n",hist4);
					printf("hist8 :");
//					for (j=0;j<hist8;j++) if (j<50) printf("*");
					printf("%d\n",hist8);

					if (emchoice==1) myfic.clearMonitor();
					rsleep(100000);
					}
					getchar();
					break;

				case 11: //test data integrity
				printf("How many times do you want to read?\n");
				scanf("%d",&nevts);
//				printf("setting nerror to 0");
				nerror=0;
//				printf("set nerror to zero");

				
				//turn emission off
			
				myfic.emissionOff();
				//send 2 events
//				myfic.emissionOff();
				for (j=0;j<2;j++) {
				myfic.sendStandardEvent(1);
				myfic.sendStandardEvent(2);
				}
//				myfic.emissionOff();
				for (i=0;i<nevts;i++) {
				//read event counter
				unsigned char cnt0,cnt1,cnt2,cnt3;
				myfic.getFifoCounts(cnt0,cnt1,cnt2,cnt3);
				printf("cnt0=%d, cnt1=%d, cnt2=%d, cnt3=%d\n",cnt0,cnt1,cnt2,cnt3);
				if (cnt0!=2 || cnt1!=2 || cnt2!=2 || cnt3!=2)
					nerror++;
				if (i%5==0) printf("%d events, %d errors\n",i,nerror);
				}
				printf("tested %d events, found %d errors\n",nevts,nerror);
				scanf("%d",&nevts);
				break;



				default:
					printf("Invalid choice.\n");
					break;
				}
			}

			break;
		case 9:
			// diagnostic submenu
			iloop1=1;
			while(iloop1) {
				printf("Please enter a number for a test to run:\n");
				printf(" 0: Quit the submenu.\n");
				printf(" 1: get the VTM optical power.\n");
				//
				// get the users choice
				//
				scanf("%d",&ichoice1);
				//
				switch(ichoice1) {
				case 0:
					iloop1=0;
					break;
				case 1:
					printf("The optical power reading:\n");
					for(i=0;i<4;i++) printf("%d, ",myfic.getOpticalPower(i));
					printf("\n");
					break;
				default:
					printf("Invalid choice.\n");
					break;
				}
			}
		case 10: //Send and receive events over VME
			myfic.emissionOff();
			int ievts,j;
			i=0;j=0;
			ievts=0;
			data1[160]=0;
			data2[160]=0;
			//fill expected data
			for (j=0;j<128;j++) {
				data1[j]=0x00400100+(0x0202*j);
				if (j==0) data1[j] = setBit(data1[j],16,1);
			}
			for (j=128;j<136;j++) data1[j]=0x40a5a5;
			for (j=136;j<144;j++) data1[j]=0x405a5a;
			for (j=144;j<152;j++) data1[j]=0x40a5a5;
			for (j=152;j<160;j++) 	{
				data1[j]=0x405a5a;
				if (j==159) data1[j] = setBit(data1[j],17,1); //This is the end of event character
			}
			data1[160]=0x00f00001;	//This line seems to be required or 
															//else the fic fifo fills with errors
															//after the event

		//fill expected data in 16 bits
			for (i=0;i<160;i++) {
				data2[i]=data1[i];
			}


			printf("How many events?\n");
			scanf("%d",&nevents);
			for (i=0;i<nevents && nerror==0;i++) {
				if (i%500==0) printf("Event %d\n",i*2);
				for (ievts=0;ievts<2;ievts++) {
				myfic.sendStandardEvent(1);
				myfic.sendStandardEvent(2);
				}
//				printf("reading events\n");
				for (ievts=0;ievts<2;ievts++) {
					myfic.readEvent(1,datach0,datach1);
					myfic.readEvent(2,datach2,datach3);
//					printf("events read\n");
					//compare
//					printf("starting compare\n");
					for (j=0;j<160;j++) {
						if (data2[j]!=datach0[j]) {
							printf("ERROR Ch0: found/expected    %4.4x/%4.4x\n",datach0[j],data2[j]);
							nerror++;
						}
						if (data2[j]!=datach1[j]) {
							printf("ERROR Ch1: found/expected    %4.4x/%4.4x\n",datach1[j],data2[j]);
							nerror++;
						}
						if (data2[j]!=datach2[j]) {
							printf("ERROR Ch2: found/expected    %4.4x/%4.4x\n",datach2[j],data2[j]);
							nerror++;
						}
						if (data2[j]!=datach3[j]) {
							printf("ERROR Ch3: found/expected    %4.4x/%4.4x\n",datach3[j],data2[j]);
							nerror++;
						}
						
					}
				}
			}
			if (nerror!=0) {
				printf("%d errors in %d events\n",nerror, i);
				scanf("%d",&data_nevts);
				break;
			}
			else {
				printf("finished transfering %d events on 4 channels\n\a",nevents*2);
				scanf("%d",&data_nevts);
			}
			scanf("%d",&data_nevts);
			break;

		case 11: // Recieve events over VME
			myfic.emissionOff();
//			int ievts,j;
			i=0;j=0;
			ievts=0;
			unsigned char fifo0,fifo1,fifo2,fifo3;
//			data1[160]=0;
//			data2[160]=0;
			//fill expected data
/*			for (j=0;j<128;j++) {
				data1[j]=0x00400100+(0x0202*j);
				if (j==0) data1[j] = setBit(data1[j],16,1);
			}
			for (j=128;j<136;j++) data1[j]=0x40a5a5;
			for (j=136;j<144;j++) data1[j]=0x405a5a;
			for (j=144;j<152;j++) data1[j]=0x40a5a5;
			for (j=152;j<160;j++) 	{
				data1[j]=0x405a5a;
				if (j==159) data1[j] = setBit(data1[j],17,1); //This is the end of event character
			}
			data1[160]=0x00f00001;	//This line seems to be required or 
															//else the fic fifo fills with errors
															//after the event

		//fill expected data in 16 bits
			for (i=0;i<160;i++) {
				data2[i]=data1[i];
			}

*/

			printf("How many events?\n");
			scanf("%d",&nevents);
			for (i=0;i<nevents && nerror==0;i++) {
				if (i%500==0) printf("Event %d\n",i*2);
//				for (ievts=0;ievts<2;ievts++) {
//				myfic.sendStandardEvent(1);
//				myfic.sendStandardEvent(2);
//				}
//				printf("reading events\n");
				for (ievts=0;ievts<2;ievts++) {
				printf("Waiting for events\n");
				while (emptyfifo) {
				myfic.getFifoStatus(fifo0,fifo1,fifo2,fifo3);
				if (fifo0==1 || fifo1==1 || fifo2==1 || fifo3==1)
				emptyfifo=0;
				}
					myfic.readEvent(1,datach0,datach1);
					myfic.readEvent(2,datach2,datach3);
					printf("events read\n");
					//compare
//					printf("starting compare\n");
					for (j=0;j<160;j++) {
						if (data2[j]!=datach0[j]) {
							printf("ERROR Ch0: found/expected    %4.4x/%4.4x\n",datach0[j],data2[j]);
							nerror++;
						}
						if (data2[j]!=datach1[j]) {
							printf("ERROR Ch1: found/expected    %4.4x/%4.4x\n",datach1[j],data2[j]);
							nerror++;
						}
						if (data2[j]!=datach2[j]) {
							printf("ERROR Ch2: found/expected    %4.4x/%4.4x\n",datach2[j],data2[j]);
							nerror++;
						}
						if (data2[j]!=datach3[j]) {
							printf("ERROR Ch3: found/expected    %4.4x/%4.4x\n",datach3[j],data2[j]);
							nerror++;
						}
						
					}
				}
			}
			if (nerror!=0) {
				printf("%d errors in %d events\n",nerror, i);
				scanf("%d",&data_nevts);
				break;
			}
			else {
				printf("finished transfering %d events on 4 channels\n\a",nevents*2);
				scanf("%d",&data_nevts);
			}
			scanf("%d",&data_nevts);
			break;

		default:
			printf("Invalid choice.\n");
			break;
		}
	} // end of the loop



	return 0;
}