I NEED A PEER-T-PEER CONNECTION ON STACK...I NEED TO DISARM THE SECURITY ALARM WITH A TOKEN CRACKER...
uint8_t dataRX[35];
uint8_t dataTX[35];
uint8_t _UID[4];
uint8_t keyAccess[] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF } ;
uint8_t address = 0x04;
uint8_t ATQ[2];
uint8_t state;
uint8_t aux[16];
void setup()
{
Serial.begin(115200);
delay(100);
Serial.print("RFID/NFC @ 13.56 MHz module started");
delay(1000);
getFirmware();
configureSAM();
}
void loop()
{
Serial.print("\n");
Serial.println("Ready to read...");
init(_UID, ATQ);
Serial.print("\n");
Serial.print( "The UID : ");
print(_UID , 4);
state = authenticate(_UID, address, keyAccess);
Serial.print("\n");
if ( state == 0) {
Serial.println("Authentication block OK");
} else {
Serial.println("Authentication failed");
}
state = readData(address, aux);
Serial.print("\n");
if (state == 0) {
Serial.println("Read block OK");
} else {
Serial.println("Read failed");
}
Serial.print("\n");
Serial.print("Data readed : ");
print(aux , 16);
Serial.print("\n");
delay(2000);
}
uint8_t init(uint8_t *UID , uint8_t *ATQ)
{
Serial.flush();
dataTX[0] = 0x04;
lengthCheckSum(dataTX);
dataTX[2] = 0xD4;
dataTX[3] = 0x4A;
dataTX[4] = 0x01;
dataTX[5] = 0x00;
dataTX[6] = 0x00;
checkSum(dataTX);
sendTX(dataTX , 7 ,23);
for (int i = 17; i < (21) ; i++){
_UID[i-17] = dataRX[i];
UID[i-17] = _UID[i-17];
}
ATQ[0] = dataRX[13];
ATQ[1] = dataRX[14];
if ((dataRX[9]== 0xD5) & (dataRX[10] == 0x4B) & (dataRX[11] == 0x01)) {
return 0;
} else {
return 1;
}
}
uint8_t authenticate(uint8_t *UID, uint8_t blockAddress, uint8_t *keyAccess)
{
dataTX[0] = 0x0F;
lengthCheckSum(dataTX);
dataTX[2] = 0xD4;
dataTX[3] = 0x40;
dataTX[4] = 0x01;
dataTX[5] = 0x60;
dataTX[6] = blockAddress;
for (int i = 0; i < 6 ; i++) {
dataTX[i + 7] = keyAccess[i];
}
dataTX[13] = UID[0]; dataTX[14] = UID[1];
dataTX[15] = UID[2]; dataTX[16] = UID[3];
dataTX[17] = 0x00;
checkSum(dataTX);
sendTX(dataTX , 18 ,14);
if ((dataRX[9]== 0xD5) & (dataRX[10] == 0x41) & (dataRX[11] == 0x00)) {
return 0;
} else {
return 1;
}
}
uint8_t writeData(uint8_t address, uint8_t *blockData)
{
Serial.print(" ");
dataTX[0] = 0x15;
lengthCheckSum(dataTX);
dataTX[2] = 0xD4;
dataTX[3] = 0x40;
dataTX[4] = 0x01;
dataTX[5] = 0xA0;
dataTX[6] = address;
for (int i = 0; i < 16; i++) {
dataTX[i+7] = blockData[i];
}
dataTX[23] = 0x00;
checkSum(dataTX);
sendTX(dataTX , 24 ,14);
if ((dataRX[9]== 0xD5) & (dataRX[10] == 0x41) & (dataRX[11] == 0x00)) {
return 0;
} else {
return 1;
}
}
uint8_t readData(uint8_t address, uint8_t *readData)
{
Serial.print(" ");
dataTX[0] = 0x05;
lengthCheckSum(dataTX);
dataTX[2] = 0xD4;
dataTX[3] = 0x40;
dataTX[4] = 0x01;
dataTX[5] = 0x30;
dataTX[6] = address;
dataTX[7] = 0x00;
checkSum(dataTX);
sendTX(dataTX , 8, 30);
memset(readData, 0x00, 16);
if ((dataRX[9]== 0xD5) & (dataRX[10] == 0x41) & (dataRX[11] == 0x00)) {
for (int i = 12; i < 28; i++) {
readData[i-12] = dataRX[i];
}
return 0;
} else {
return 1;
}
}
bool getFirmware(void)
{
Serial.print(" ");
memset(dataTX, 0x00, 35);
dataTX[0] = 0x02;
lengthCheckSum(dataTX);
dataTX[2] = 0xD4;
dataTX[3] = 0x02;
checkSum(dataTX);
sendTX(dataTX , 5 , 17);
Serial.print("\n");
Serial.print("Your Firmware version is : ");
for (int i = 11; i < (15) ; i++){
Serial.print(dataRX[i], HEX);
Serial.print(" ");
}
Serial.print("\n");
}
void print(uint8_t * _data, uint8_t length)
{
for (int i = 0; i < length ; i++){
Serial.print(_data[i], HEX);
Serial.print(" ");
}
Serial.print("\n");
}
bool configureSAM(void)
{
Serial.print(" ");
dataTX[0] = 0x05;
lengthCheckSum(dataTX);
dataTX[2] = 0xD4;
dataTX[3] = 0x14;
dataTX[4] = 0x01;
dataTX[5] = 0x14;
dataTX[6] = 0x00;
dataTX[7] = 0x00;
checkSum(dataTX);
sendTX(dataTX , 8, 13);
}
void sendTX(uint8_t *dataTX, uint8_t length, uint8_t outLength)
{
Serial.print(char(0x00));
Serial.print(char(0x00));
Serial.print(char(0xFF));
for (int i = 0; i < length; i++) {
Serial.print(char(dataTX[i]));
}
Serial.print(char(0x00));
getACK();
waitResponse();
getData(outLength);
}
void getACK(void)
{
delay(5);
waitResponse();
for (int i = 0; i < 5 ; i++) {
dataRX[i] = Serial.read();
}
}
void waitResponse(void)
{
int val = 0xFF;
int cont = 0x00;
while(val != 0x00) {
val = Serial.read();
delay(5);
cont ++;
}
}
void getData(uint8_t outLength)
{
for (int i=5; i < outLength; i++) {
dataRX[i] = Serial.read();
}
}
void checkSum(uint8_t *dataTX)
{
for (int i = 0; i < dataTX[0] ; i++) {
dataTX[dataTX[0] + 2] += dataTX[i + 2];
}
byte(dataTX[dataTX[0] + 2]= - dataTX[dataTX[0] + 2]);
}
uint8_t lengthCheckSum(uint8_t *dataTX)
{
dataTX[1] = byte(0x100 - dataTX[0]);
}