Wiegand.cpp

#include "Wiegand.h"

unsigned long WIEGAND::_sysTick=0;
unsigned long WIEGAND::_lastWiegand=0;
int			  WIEGAND::_GateActive=0;    // 1 = Active A   --   2 = Active B  ----  3 = Active C 

unsigned long WIEGAND::_cardTempHighA=0;
unsigned long WIEGAND::_cardTempA=0;
unsigned long WIEGAND::_codeA=0;
int 		  WIEGAND::_bitCountA=0;	
int			  WIEGAND::_wiegandTypeA=0;

unsigned long WIEGAND::_cardTempHighB=0;
unsigned long WIEGAND::_cardTempB=0;
unsigned long WIEGAND::_codeB=0;
int 		  WIEGAND::_bitCountB=0;	
int			  WIEGAND::_wiegandTypeB=0;

unsigned long WIEGAND::_cardTempHighC=0;
unsigned long WIEGAND::_cardTempC=0;
unsigned long WIEGAND::_codeC=0;
int 		  WIEGAND::_bitCountC=0;	
int			  WIEGAND::_wiegandTypeC=0;


WIEGAND::WIEGAND()
{

}


unsigned long WIEGAND::getCode()
{
  switch (_GateActive) {
    case 1:
		return _codeA;
      break;
    case 2:
		return _codeB;
      break;
	case 3:
		return _codeC;
      break;
    default: 
		return 0;
  }
}

int WIEGAND::getWiegandType()
{
  switch (_GateActive) {
    case 1:
		return _wiegandTypeA;
      break;
    case 2:
		return _wiegandTypeB;
      break;
	case 3:
		return _wiegandTypeC;
      break;
    default: 
		return 0;
  }
	
}

int WIEGAND::getGateActive()
{
	return _GateActive;
}

bool WIEGAND::available()
{
	return DoWiegandConversion();
}

void WIEGAND::begin(bool GateA, bool GateB, bool GateC)
{
	_sysTick=millis();
	_lastWiegand = 0;

	if (GateA == 1 ) 
	{	
		_cardTempHighA = 0;
		_cardTempA = 0;
		_codeA = 0;
		_wiegandTypeA = 0;
		_bitCountA = 0;  
		
		pinMode(D0PinA, INPUT);					// Set D0 pin as input
		pinMode(D1PinA, INPUT);					// Set D1 pin as input
		attachInterrupt(digitalPinToInterrupt(D0PinA), ReadD0A, FALLING);	// Hardware interrupt - high to low pulse
		attachInterrupt(digitalPinToInterrupt(D1PinA), ReadD1A, FALLING);	// Hardware interrupt - high to low pulse
	}
	
	if (GateB == 1 ) 
	{		
		_cardTempHighB = 0;
		_cardTempB = 0;
		_codeB = 0;
		_wiegandTypeB = 0;
		_bitCountB = 0;  
	
		pinMode(D0PinB, INPUT);					// Set D0 pin as input
		pinMode(D1PinB, INPUT);					// Set D1 pin as input
		attachInterrupt(digitalPinToInterrupt(D0PinB), ReadD0B, FALLING);	// Hardware interrupt - high to low pulse
		attachInterrupt(digitalPinToInterrupt(D1PinB), ReadD1B, FALLING);	// Hardware interrupt - high to low pulse
	}
	
	if (GateC == 1 ) 
	{		
		_cardTempHighC = 0;
		_cardTempC = 0;
		_codeC = 0;
		_wiegandTypeC = 0;
		_bitCountC = 0; 

		pinMode(D0PinC, INPUT);					// Set D0 pin as input
		pinMode(D1PinC, INPUT);					// Set D1 pin as input
		attachInterrupt(digitalPinToInterrupt(D0PinC), ReadD0C, FALLING);	// Hardware interrupt - high to low pulse
		attachInterrupt(digitalPinToInterrupt(D1PinC), ReadD1C, FALLING);	// Hardware interrupt - high to low pulse	
	}
	
	Serial.print("GateA Enabled = ");
	Serial.println(GateA);
	Serial.print("GateB Enabled = ");
	Serial.println(GateB);
	Serial.print("GateC Enabled = ");
	Serial.println(GateC);
		
}

void WIEGAND::ReadD0A ()
{
	_bitCountA++;				// Increament bit count for Interrupt connected to D0
	if (_bitCountA>31)			// If bit count more than 31, process high bits
	{
		_cardTempHighA |= ((0x80000000 & _cardTempA)>>31);	//	shift value to high bits
		_cardTempHighA <<= 1;
		_cardTempA <<=1;
	}
	else
	{
		_cardTempA <<= 1;		// D0 represent binary 0, so just left shift card data
	}
	_lastWiegand = _sysTick;	// Keep track of last wiegand bit received
}

void WIEGAND::ReadD1A()
{
	_bitCountA ++;				// Increment bit count for Interrupt connected to D1
	if (_bitCountA>31)			// If bit count more than 31, process high bits
	{
		_cardTempHighA |= ((0x80000000 & _cardTempA)>>31);	// shift value to high bits
		_cardTempHighA <<= 1;
		_cardTempA |= 1;
		_cardTempA <<=1;
	}
	else
	{
		_cardTempA |= 1;			// D1 represent binary 1, so OR card data with 1 then
		_cardTempA <<= 1;		// left shift card data
	}
	_lastWiegand = _sysTick;	// Keep track of last wiegand bit received
}


void WIEGAND::ReadD0B ()
{
	_bitCountB++;				// Increament bit count for Interrupt connected to D0
	if (_bitCountB>31)			// If bit count more than 31, process high bits
	{
		_cardTempHighB |= ((0x80000000 & _cardTempB)>>31);	//	shift value to high bits
		_cardTempHighB <<= 1;
		_cardTempB <<=1;
	}
	else
	{
		_cardTempB <<= 1;		// D0 represent binary 0, so just left shift card data
	}
	_lastWiegand = _sysTick;	// Keep track of last wiegand bit received
}

void WIEGAND::ReadD1B()
{
	_bitCountB ++;				// Increment bit count for Interrupt connected to D1
	if (_bitCountB>31)			// If bit count more than 31, process high bits
	{
		_cardTempHighB |= ((0x80000000 & _cardTempB)>>31);	// shift value to high bits
		_cardTempHighB <<= 1;
		_cardTempB |= 1;
		_cardTempB <<=1;
	}
	else
	{
		_cardTempB |= 1;			// D1 represent binary 1, so OR card data with 1 then
		_cardTempB <<= 1;		// left shift card data
	}
	_lastWiegand = _sysTick;	// Keep track of last wiegand bit received
}


void WIEGAND::ReadD0C ()
{
	_bitCountC++;				// Increament bit count for Interrupt connected to D0
	if (_bitCountC>31)			// If bit count more than 31, process high bits
	{
		_cardTempHighC |= ((0x80000000 & _cardTempC)>>31);	//	shift value to high bits
		_cardTempHighC <<= 1;
		_cardTempC <<=1;
	}
	else
	{
		_cardTempC <<= 1;		// D0 represent binary 0, so just left shift card data
	}
	_lastWiegand = _sysTick;	// Keep track of last wiegand bit received
}

void WIEGAND::ReadD1C()
{
	_bitCountC ++;				// Increment bit count for Interrupt connected to D1
	if (_bitCountC>31)			// If bit count more than 31, process high bits
	{
		_cardTempHighC |= ((0x80000000 & _cardTempC)>>31);	// shift value to high bits
		_cardTempHighC <<= 1;
		_cardTempC |= 1;
		_cardTempC <<=1;
	}
	else
	{
		_cardTempC |= 1;			// D1 represent binary 1, so OR card data with 1 then
		_cardTempC <<= 1;		// left shift card data
	}
	_lastWiegand = _sysTick;	// Keep track of last wiegand bit received
}


unsigned long WIEGAND::GetCardId (unsigned long *codehigh, unsigned long *codelow, char bitlength)
{
	unsigned long cardID=0;

	if (bitlength==26)								// EM tag
		cardID = (*codelow & 0x1FFFFFE) >>1;

	if (bitlength==34)								// Mifare 
	{
		*codehigh = *codehigh & 0x03;				// only need the 2 LSB of the codehigh
		*codehigh <<= 30;							// shift 2 LSB to MSB		
		*codelow >>=1;
		cardID = *codehigh | *codelow;
	}
	return cardID;
}

bool WIEGAND::DoWiegandConversion ()
{
	unsigned long cardIDA;
	unsigned long cardIDB;
	unsigned long cardIDC;

	
	_sysTick=millis();
	if ((_sysTick - _lastWiegand) > 25)								// if no more signal coming through after 25ms
	{
		if ((_bitCountA==26) || (_bitCountA==34) || (_bitCountA==8) || (_bitCountB==26) || (_bitCountB==34) || (_bitCountB==8) || (_bitCountC==26) || (_bitCountC==34) || (_bitCountC==8) ) 	// bitCount for keypress=8, Wiegand 26=26, Wiegand 34=34
		{
			if ((_bitCountA==26) || (_bitCountA==34) || (_bitCountA==8)) 	// bitCount for keypress=8, Wiegand 26=26, Wiegand 34=34
			{
				_cardTempA >>= 1;			// shift right 1 bit to get back the real value - interrupt done 1 left shift in advance
				if (_bitCountA>32)			// bit count more than 32 bits, shift high bits right to make adjustment
					_cardTempHighA >>= 1;	

				if((_bitCountA==26) || (_bitCountA==34))		// wiegand 26 or wiegand 34
				{
					cardIDA = GetCardId (&_cardTempHighA, &_cardTempA, _bitCountA);
					_wiegandTypeA=_bitCountA;
					_bitCountA=0;
					_cardTempA=0;
					_cardTempHighA=0;
					_GateActive=1;
					_codeA=cardIDA;
					return true;				
				}
				else if (_bitCountA==8)		// keypress wiegand
				{
					// 8-bit Wiegand keyboard data, high nibble is the "NOT" of low nibble
					// eg if key 1 pressed, data=E1 in binary 11100001 , high nibble=1110 , low nibble = 0001 
					char highNibble = (_cardTempA & 0xf0) >>4;
					char lowNibble = (_cardTempA & 0x0f);
					_wiegandTypeA=_bitCountA;					
					_bitCountA=0;
					_cardTempA=0;
					_cardTempHighA=0;
					_GateActive=1;
					
					if (lowNibble == (~highNibble & 0x0f))		// check if low nibble matches the "NOT" of high nibble.
					{
						if (lowNibble==0x0b)					// ENT pressed
						{
							_codeA=0x0d;							
						}
						else if (lowNibble==0x0a)				// ESC pressed
						{
							_codeA=0x1b;							
						}
						else
						{
						_codeA=(int)lowNibble;				// 0 - 9 keys
						}
						return true;
					}
				}
			}
			else
			{
				// well time over 25 ms and bitCount !=8 , !=26, !=34 , must be noise or nothing then.
				_lastWiegand=_sysTick;
				_bitCountA=0;			
				_cardTempA=0;
				_cardTempHighA=0;
				_GateActive=0;
			}	
				// fine controllo accesso A 
				
				
				
				
				
				// inizio controllo accesso B 
			if ((_bitCountB==26) || (_bitCountB==34) || (_bitCountB==8)) 	// bitCount for keypress=8, Wiegand 26=26, Wiegand 34=34
			{
				_cardTempB >>= 1;			// shift right 1 bit to get back the real value - interrupt done 1 left shift in advance
				if (_bitCountB>32)			// bit count more than 32 bits, shift high bits right to make adjustment
					_cardTempHighB >>= 1;	

				if((_bitCountB==26) || (_bitCountB==34))		// wiegand 26 or wiegand 34
				{
					cardIDB = GetCardId (&_cardTempHighB, &_cardTempB, _bitCountB);
					_wiegandTypeB=_bitCountB;
					_bitCountB=0;
					_cardTempB=0;
					_cardTempHighB=0;
					_GateActive=2;
					_codeB=cardIDB;
					return true;				
				}
				else if (_bitCountB==8)		// keypress wiegand
				{
					// 8-bit Wiegand keyboard data, high nibble is the "NOT" of low nibble
					// eg if key 1 pressed, data=E1 in binary 11100001 , high nibble=1110 , low nibble = 0001 
					char highNibble = (_cardTempB & 0xf0) >>4;
					char lowNibble = (_cardTempB & 0x0f);
					_wiegandTypeB=_bitCountB;					
					_bitCountB=0;
					_cardTempB=0;
					_cardTempHighB=0;
					_GateActive=2;
				
					if (lowNibble == (~highNibble & 0x0f))		// check if low nibble matches the "NOT" of high nibble.
					{
						if (lowNibble==0x0b)					// ENT pressed
						{
							_codeB=0x0d;							
						}
						else if (lowNibble==0x0a)				// ESC pressed
						{
							_codeB=0x1b;							
						}
						else
						{
							_codeB=(int)lowNibble;				// 0 - 9 keys
						}
						return true;
					}
				}
			}
			else
			{
				// well time over 25 ms and bitCount !=8 , !=26, !=34 , must be noise or nothing then.
				_lastWiegand=_sysTick;
				_bitCountB=0;			
				_cardTempB=0;
				_cardTempHighB=0;
				_GateActive=0;
			}
			
			// fine controllo accesso B
			
			
			
			// inizio controllo accesso C 
			if ((_bitCountC==26) || (_bitCountC==34) || (_bitCountC==8)) 	// bitCount for keypress=8, Wiegand 26=26, Wiegand 34=34
			{
				_cardTempC >>= 1;			// shift right 1 bit to get back the real value - interrupt done 1 left shift in advance
				if (_bitCountC>32)			// bit count more than 32 bits, shift high bits right to make adjustment
					_cardTempHighC >>= 1;	

				if((_bitCountC==26) || (_bitCountC==34))		// wiegand 26 or wiegand 34
				{
					cardIDC = GetCardId (&_cardTempHighC, &_cardTempC, _bitCountC);
					_wiegandTypeC=_bitCountC;
					_bitCountC=0;
					_cardTempC=0;
					_cardTempHighC=0;
					_GateActive=3;
					_codeC=cardIDC;
					return true;				
				}
				else if (_bitCountC==8)		// keypress wiegand
				{
					// 8-bit Wiegand keyboard data, high nibble is the "NOT" of low nibble
					// eg if key 1 pressed, data=E1 in binary 11100001 , high nibble=1110 , low nibble = 0001 
					char highNibble = (_cardTempC & 0xf0) >>4;
					char lowNibble = (_cardTempC & 0x0f);
					_wiegandTypeC=_bitCountC;					
					_bitCountC=0;
					_cardTempC=0;
					_cardTempHighC=0;
					_GateActive=3;
				
					if (lowNibble == (~highNibble & 0x0f))		// check if low nibble matches the "NOT" of high nibble.
					{
						if (lowNibble==0x0b)					// ENT pressed
						{
							_codeB=0x0d;							
						}
						else if (lowNibble==0x0a)				// ESC pressed
						{
							_codeB=0x1b;							
						}
						else
						{
							_codeB=(int)lowNibble;				// 0 - 9 keys
						}
						return true;
					}
				}
			}
			else
			{
				// well time over 25 ms and bitCount !=8 , !=26, !=34 , must be noise or nothing then.
				_lastWiegand=_sysTick;
				_bitCountC=0;			
				_cardTempC=0;
				_cardTempHighC=0;
				_GateActive=0;
			}
			
			// fine controllo accesso C			
			
	
		return false;
		}
		else
		    return false;
	}
	else
		return false;
}