#include <iostream>
using namespace std;

#include <stdlib.h>
#include <string.h>
#include <stdio.h>
#include <gef/gefcmn_vme.h>


#define VS4_BASE_ADDR 0x8000

// VME A16 address handles for GEF library
GEF_VME_MASTER_HDL a16_hdl;
GEF_MAP_HDL a16map_hdl;
GEF_VME_ADDR addr_A16;
void *a16p;

typedef struct {
	unsigned char _unused1; unsigned char data;		
	unsigned char _unused2; unsigned char done;
	unsigned char _unused3; unsigned char control;
	unsigned char _unused4; unsigned char status;
	unsigned char _unused5; unsigned char interrupt;
}vs4_register_t;

volatile vs4_register_t *vs4_register=NULL;

enum done_register_t{
	XAXIS,
	YAXIS,
	ZAXIS,
	TAXIS
};

void PrintError(const char *mess, GEF_STATUS status);


//----------------------
// main
//----------------------
int main(int narg, char *argv[])
{
	GEF_VME_BUS_HDL hdl;
	GEF_STATUS status;
	GEF_UINT16 id = 0, sdata = 0;

	cout<<"Testing Communication with VS4 board at base addr:";
	cout<<" 0x"<<hex<<VS4_BASE_ADDR<<dec<<" ..."<<endl;

	status = gefVmeOpen(&hdl);
	if (status != GEF_STATUS_SUCCESS) {
		PrintError("gefVmeOpen failed",status);;
		return -1;
	}

	cout<<"Opening A16 Window"<<endl;
	addr_A16.upper = 0x00000000;
	addr_A16.lower = 0x00000000;
	addr_A16.addr_space = GEF_VME_ADDR_SPACE_A16;
	addr_A16.vme_2esst_rate = GEF_VME_2ESST_RATE_INVALID;
	addr_A16.addr_mode = GEF_VME_ADDR_MODE_DEFAULT;
	addr_A16.transfer_mode = GEF_VME_TRANSFER_MODE_SCT;
	addr_A16.broadcast_id = GEF_VME_BROADCAST_ID_DISABLE;
	addr_A16.transfer_max_dwidth = GEF_VME_TRANSFER_MAX_DWIDTH_8;
	addr_A16.flags = GEF_VME_WND_EXCLUSIVE;

	status = gefVmeCreateMasterWindow(hdl, &addr_A16, 0x10000, &a16_hdl);
	if (status != GEF_STATUS_SUCCESS) {
		PrintError("gefVmeCreateMasterWindow A16 failed",status);
		
		gefVmeClose(hdl);
		return -1;
	}

	// Read from the interrupt register
	unsigned char int_vec = 0x00;
	status = gefVmeRead8(a16_hdl, VS4_BASE_ADDR+9, 1, &int_vec);
	if(status != GEF_STATUS_SUCCESS) {
		PrintError("gefVmeRead8 failed",status);
	}else{
		cout<<"Initial interrupt vector: 0x"<<hex<<(int)int_vec<<dec<<endl;
	}

#if 0
	
	// Write to the interrupt register
	int_vec = 0x07;
	status = gefVmeWrite8(a16_hdl, VS4_BASE_ADDR+9, 1, &int_vec);
	if(status != GEF_STATUS_SUCCESS) {
		PrintError("gefVmeWrite8 failed", status);
	}

	// Read from the interrupt register
	int_vec = 0x00;
	status = gefVmeRead8(a16_hdl, VS4_BASE_ADDR+9, 1, &int_vec);
	if(status != GEF_STATUS_SUCCESS) {
		PrintError("gefVmeRead8 failed",status);
	}else{
		cout<<"Final interrupt vector: 0x"<<hex<<(int)int_vec<<dec<<endl;
	}
#endif

#if 0
	// Now map the VME A16 Window into a local address
	status = gefVmeMapMasterWindow(a16_hdl, 0x0, 0x10000, &a16map_hdl, &a16p);
	if(status != GEF_STATUS_SUCCESS) {
		PrintError("gefVmeMapMasterWindow failed",status);
	}else{
		// Set the VS4 structure pointer
		vs4_register = (volatile vs4_register_t*)((unsigned long)a16p+VS4_BASE_ADDR);
	
		cout<<"Initial value of interrupt register: 0x"<<hex<<(int)vs4_register->interrupt<<dec<<endl;
		//cout<<"Setting interrupt register to 0x07 ..."<<endl;
		//vs4_register->interrupt = 0x07;
		cout<<"Current value of interrupt register: 0x"<<hex<<(int)vs4_register->interrupt<<dec<<endl;
	}

	// Unmap A16 address space
	cout<<"Calling gefVmeUnmapMasterWindow"<<endl;
	status = gefVmeUnmapMasterWindow(a16map_hdl);
	if(status != GEF_STATUS_SUCCESS){
		PrintError("gefVmeUnmapMasterWindow failed", status);
	}
#endif

	// Release the A16 Master window
	cout<<"Calling gefVmeReleaseMasterWindow"<<endl;
	status = gefVmeReleaseMasterWindow(a16_hdl);
	if(status != GEF_STATUS_SUCCESS){
		PrintError("gefVmeReleaseMasterWindow failed", status);
	}
        
	// Close the VME Device file */
	printf("Calling gefVmeClose\n");
	status = gefVmeClose(hdl);
	if (status != GEF_SUCCESS){
		PrintError("gefVmeClose failed", status);
		return -1;
	}

	return 0;
}

//---------------------------
// PrintError
//---------------------------
void PrintError(const char *mess, GEF_STATUS status)
{
	cerr<<mess<<endl;
	cerr<<"code 0x"<<hex<<status<<dec<<" : ";

	switch(status){
 		case GEF_STATUS_NOT_SUPPORTED: 	cerr<<"GEF_STATUS_NOT_SUPPORTED"<<endl;	break;
 		case GEF_STATUS_BAD_PARAMETER_1:	cerr<<"GEF_STATUS_BAD_PARAMETER_1"<<endl;	break;
 		case GEF_STATUS_BAD_PARAMETER_2:	cerr<<"GEF_STATUS_BAD_PARAMETER_2"<<endl;	break;
 		case GEF_STATUS_BAD_PARAMETER_3:	cerr<<"GEF_STATUS_BAD_PARAMETER_3"<<endl;	break;
 		case GEF_STATUS_BAD_PARAMETER_4:	cerr<<"GEF_STATUS_BAD_PARAMETER_4"<<endl;	break;
		
		default:
			cerr<<"No message for specified error code"<<endl;
	}

}