// convert hex to human readable binary string
unsigned int hextobinstring(unsigned char *target, unsigned char *source)
{
unsigned int length;
if(!(length= hextobinarray(target, source)))
return 0;
binarraytobinstring(target, target, length);
return length;
}
BOOL hitag2_write_page(BYTE block, BYTE *data)
{
BYTE command[11], tmp[37], tmp1[37], tmp2[37], tmphex[9];
if(block > HITAG2_DATABLOCKS - 1)
return FALSE;
// create 10 bit command block: HITAG2_WRIE_PAGE + 3 bits address + invert(HITAG2_WRITE_PAGE + 3 bits address)
memcpy(command, HITAG2_WRITE_PAGE, 2);
inttobinstring(command + 2, (unsigned int) block, 3);
invertbinstring(command + 5, command);
command[10]= '\0';
// encrypt command if in crypto mode
if(CryptoActive)
hitag2_binstring_crypt(tmp, command);
else
memcpy(tmp, command, 11);
// convert data to binstring for send
if(hextobinstring(tmp1, data) != 32)
return FALSE;
// send command with RX->TX delay and no reset
if(!rwd_send(tmp, strlen(tmp), NO_RESET, BLOCK, RWD_STATE_WAKING, RFIDlerConfig.FrameClock, 0, RFIDlerConfig.RWD_Wait_Switch_RX_TX, RFIDlerConfig.RWD_Zero_Period, RFIDlerConfig.RWD_One_Period, RFIDlerConfig.RWD_Gap_Period, RFIDlerConfig.RWD_Wait_Switch_TX_RX))
return FALSE;
// skip 1/2 bit to synchronise manchester
HW_Skip_Bits= 1;
// get ACK - 10 bytes + sync
if(read_ask_data(RFIDlerConfig.FrameClock, RFIDlerConfig.DataRate, tmp2, 15, RFIDlerConfig.Sync, RFIDlerConfig.SyncBits, RFIDlerConfig.Timeout, ONESHOT_READ, BINARY) == 15)
{
// check sync bits
if (memcmp(tmp2, Hitag2Sync, 5) != 0)
return FALSE;
// decrypt
if(CryptoActive)
hitag2_binarray_crypt(tmp2 + 5, tmp2 + 5, 10);
// check ACK - should be our original command echo'd back
binarraytobinstring(tmp2 + 5, tmp2 + 5, 10);
if(memcmp(command, tmp2 + 5, 10) != 0)
return FALSE;
}
// encrypt data if in crypto mode
if(CryptoActive)
hitag2_binstring_crypt(tmp1, tmp1);
// send data with RX->TX delay and no reset
if(!rwd_send(tmp1, strlen(tmp1), NO_RESET, BLOCK, RWD_STATE_WAKING, RFIDlerConfig.FrameClock, 0, RFIDlerConfig.RWD_Wait_Switch_RX_TX, RFIDlerConfig.RWD_Zero_Period, RFIDlerConfig.RWD_One_Period, RFIDlerConfig.RWD_Gap_Period, RFIDlerConfig.RWD_Wait_Switch_TX_RX))
return FALSE;
// no ack, so read back and verify
// delay for long enough to allow write plus RX->TX period
Delay_us((HITAG2_WRITE_DELAY * RFIDlerConfig.FrameClock + RFIDlerConfig.RWD_Wait_Switch_RX_TX * RFIDlerConfig.FrameClock) / 100);
if(!hitag2_read_page(tmp, block))
return FALSE;
if(memcmp(tmp, data, 8) != 0)
return FALSE;
return TRUE;
}
// convert ulong to binstring, limited to specified number of LSB
void ulongtobinstring(BYTE *target, unsigned long source, unsigned int bits)
{
ulongtobinarray(target, source, bits);
binarraytobinstring(target, target, bits);
}
// convert integer to binstring, limited to specified number of LSB
void inttobinstring(BYTE *target, unsigned int source, unsigned int bits)
{
inttobinarray(target, source, bits);
binarraytobinstring(target, target, bits);
}
