#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 data;			unsigned char _unused1;
	unsigned char done;			unsigned char _unused2;
	unsigned char control;		unsigned char _unused3;
	unsigned char status;		unsigned char _unused4;
	unsigned char interrupt;	unsigned char _unused5;
}vs4_register_t;

volatile vs4_register_t *vs4_register;

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

//----------------------
// main
//----------------------
int main(int narg, char *argv[])
{
	GEF_VME_BUS_HDL hdl;
	GEF_STATUS status;
	GEF_UINT16 id = 0, sdata = 0;
	GEF_VERSION drv_version, lib_version;
	
	// Open the driver
	cout<<"Opening VME driver ... ";
	status = gefVmeOpen(&hdl);
	if (status != GEF_STATUS_SUCCESS) {
		cout<<"gefVmeOpen failed: 0x"<<hex<<status<<dec<<endl;
		return -1;
	}

	// Get driver and library versions
	gefVmeVersion(hdl, &drv_version, &lib_version);
	cout<<" gefVme driver version: "<<drv_version.major<<"."<<drv_version.minor<<"."<<drv_version.build<<endl;
	cout<<"gefVme library version: "<<lib_version.major<<"."<<lib_version.minor<<"."<<lib_version.build<<endl;

	// Create a window to the A16 address space
	cout<<"Opening A16 Window"<<endl;
	addr_A16.upper = 0x00000000;
	addr_A16.lower = 0x00000000;
	addr_A16.addr_space = GEF_VME_ADDR_SPACE_A16;
	addr_A16.addr_mode = GEF_VME_ADDR_MODE_USER | GEF_VME_ADDR_MODE_DATA;
	addr_A16.transfer_mode = GEF_VME_TRANSFER_MODE_SCT;
	addr_A16.transfer_max_dwidth = GEF_VME_TRANSFER_MAX_DWIDTH_8;
	addr_A16.vme_2esst_rate = GEF_VME_2ESST_RATE_160;
	addr_A16.broadcast_id = 0;
	addr_A16.flags = GEF_VME_WND_EXCLUSIVE;

	status = gefVmeCreateMasterWindow(hdl, &addr_A16, 0x10000, &a16_hdl);
	if (status != GEF_STATUS_SUCCESS) {
		cerr<<"ERROR: gefVmeCreateMasterWindow A16 failed: code 0x"<<hex<<status<<dec<<endl;
		gefVmeClose(hdl);
		return -1;
	} 

	// Now map the VME A16 Window into a local address
	status = gefVmeMapMasterWindow(a16_hdl, VS4_BASE_ADDR, 0x20, &a16map_hdl, &a16p);
	if(status != GEF_STATUS_SUCCESS) {
		cerr<<endl<<"gefVmeMapMasterWindow failed: code 0x"<<hex<<status<<dec<<endl;
	}else{
		// Set the VS4 structure pointer
		vs4_register = (volatile vs4_register_t*)(a16p);
	}

	// Unmap A16 address space
	cout<<"Calling gefVmeUnmapMasterWindow"<<endl;
	status = gefVmeUnmapMasterWindow(a16map_hdl);
	if(status != GEF_STATUS_SUCCESS){
		cout<<"\ngefVmeUnmapMasterWindow failed: code 0x"<<hex<<status<<dec<<endl;
	}

	// Release the A16 Master window
	cout<<"Calling gefVmeReleaseMasterWindow"<<endl;
	status = gefVmeReleaseMasterWindow(a16_hdl);
	if(status != GEF_STATUS_SUCCESS){
		cerr<<"ERROR: gefVmeReleaseMasterWindow failed: code 0x"<<hex<<status<<dec<<endl;
	}
        
	// Close the VME Device file */
	printf("Calling gefVmeClose\n");
	status = gefVmeClose(hdl);
	if (status != GEF_SUCCESS){
		cout<<"gefVmeClose failed: code 0x"<<hex<<status<<dec<<endl;
		return -1;
	}

	return 0;
}