#include "moAsynPar.hh"
#include "asynMasterOscillatorDrv.hh"

template class moAsynPar<unsigned>;
template class moAsynPar<double>;



volatile static int dummyIntUnsigned 	= moAsynPar<unsigned>::initGlobalMutex();
volatile static int dummyIntDouble 		= moAsynPar<double>::initGlobalMutex();

//========================================================================
//				Specializations for template class moAsynPar member functions
//========================================================================


// Method to create the parameter for the driver passed by the argument.
// This method is expected to be called from the AsynDriver constructor
template <>
void moAsynPar<unsigned>::Connect2Driver(asynMasterOscillatorDrv* driver) {
	MtxLock objLock(this->mcMutex);
	driver->createParam( this->mvapParName.c_str(), asynParamUInt32Digital, &this->mvapParNum ) ;
}

// Write unsigned asyn parameter
template<>
asynStatus moAsynPar<unsigned>::Write( asynMasterOscillatorDrv* driver, unsigned channel,
		void* valPtr, epicsUInt32 mask ) {
	MtxLock objLock( this->mcMutex );
	asynStatus aStat = asynError;

	unsigned value = *reinterpret_cast<epicsUInt32*>( valPtr );
//	cout << "Setting UInt32 parameter " << this->mvapParName  << "(" << this->mvapParNum <<
//			") for channel " << channel << " to " << value	<< endl;
	try {
		WriteParameters* parStruct = new WriteParameters( driver, this, static_cast<unsigned>( channel ), value );
//		cout << "Launching thread for " << this->mvapParNum <<
//			" for channel " << channel << " to set it to " << value	<< endl;
		pthread_t  thID;
		int stat = pthread_create( &thID, NULL,
				(void* (*)(void*)) moAsynPar<unsigned>::asynWriteFunc, reinterpret_cast<void*>( parStruct ) );
		if( stat != 0 ) {
			cout << "********************Could not start thread" << " for channel " << channel << " to set it to " << value	<< endl;
			aStat = asynError;
		}
//		this->mapWriteFunc(channel, value);
	} catch ( runtime_error& errMsg ) {
		cerr << errMsg.what() << endl;
		return aStat;
	}
	aStat = driver->setUIntDigitalParam( channel, this->mvapParNum, value, mask, mask );

	return aStat;
}
// Read unsigned asyn parameter
template <>
asynStatus moAsynPar<unsigned>::Read(asynMasterOscillatorDrv* driver, unsigned channel, void* valPtr, epicsUInt32* mask) {

	MtxLock objLock(this->mcMutex);
	asynStatus aStat = asynError;
//	cout << "Calling read function for parameter " << this->mvapParName << " for channel " << channel << endl;
	try {
	this->mapValue = this->mapReadFunc(channel);
	} catch ( runtime_error& errMsg ) {
		cerr << errMsg.what() << endl;
		return aStat;
	}
	aStat = driver->setUIntDigitalParam(channel, this->mvapParNum, this->mapValue, *mask, *mask);
	*(static_cast<epicsUInt32*>(valPtr)) = this->mapValue;
	return aStat;
}


// Method to create the parameter for the driver passed by the argument.
// This method is expected to be called from the AsynDriver constructor
template <>
void moAsynPar<double>::Connect2Driver(asynMasterOscillatorDrv* driver) {
	MtxLock objLock(this->mcMutex);
	driver->createParam( this->mvapParName.c_str(), asynParamFloat64, &this->mvapParNum ) ;
}

// Write double asyn parameter
template <>
asynStatus moAsynPar<double>::Write(asynMasterOscillatorDrv* driver, unsigned channel, void* valPtr, epicsUInt32 mask) {
	MtxLock objLock(this->mcMutex);
	asynStatus aStat = asynError;

	epicsFloat64 value = *static_cast<epicsFloat64*>(valPtr);
//	cout << "Setting Double parameter " << this->mvapParName  << "(" << this->mvapParNum <<
//			") for channel " << channel << " to " << value	<< endl;
	try {
		this->mapWriteFunc(channel, value);
	} catch (runtime_error& errMsg ) {
		cerr << errMsg.what() << endl;
		return aStat;
	}
	aStat = driver->setDoubleParam(channel, this->mvapParNum, value);
	return aStat;
}

// Read double asyn parameter
template <>
asynStatus moAsynPar<double>::Read(asynMasterOscillatorDrv* driver, unsigned channel, void* valPtr, epicsUInt32* mask) {

	MtxLock objLock(this->mcMutex);
	asynStatus aStat = asynError;
	try {
		this->mapValue = this->mapReadFunc(channel);
	} catch ( runtime_error& errMsg ) {
		cerr << errMsg.what() << endl;
		return aStat;
	}
//	cout << "Read value " << this->mapValue << " for channel " << channel << endl;
	aStat = driver->setDoubleParam(channel, this->mvapParNum, this->mapValue);
	*(static_cast<epicsFloat64*>(valPtr)) = this->mapValue;
//	cout << "Sending back value " << *(static_cast<epicsFloat64*>(valPtr)) << endl;
	return aStat;
}