forked from AdamLaurie/RFIDIOt
-
Notifications
You must be signed in to change notification settings - Fork 12
/
writelfx.py
executable file
·179 lines (165 loc) · 5.59 KB
/
writelfx.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
#!/usr/bin/python
# writelfx.py - read and then write all sectors from a LFX reader
#
# Adam Laurie <adam@algroup.co.uk>
# http://rfidiot.org/
#
# This code is copyright (c) Adam Laurie, 2009, All rights reserved.
# For non-commercial use only, the following terms apply - for all other
# uses, please contact the author:
#
# This code is free software; you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation; either version 2 of the License, or
# (at your option) any later version.
#
# This code is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
# GNU General Public License for more details.
#
import rfidiot
import sys
import os
try:
card= rfidiot.card
except:
print "Couldn't open reader!"
os._exit(True)
args= rfidiot.args
help= rfidiot.help
Q5Mod= { '000':'Manchester',\
'001':'PSK 1',\
'010':'PSK 2',\
'011':'PSK 3',\
'100':'FSK 1 (a = 0)',\
'101':'FSK 2 (a = 0)',\
'110':'Biphase',\
'111':'NRZ / direct'}
card.info('writelfx v0.1c')
# force card type if specified
if len(args) > 0:
print 'Setting tag type:', args[0]
card.settagtype(args[0])
else:
card.settagtype(card.ALL)
card.select()
ID= card.uid
print 'Card ID: ' + ID
print 'Tag type: ' + card.LFXTags[card.tagtype]
# set key if specified
if len(args) > 1:
key= args[1]
else:
key= ''
# Login to Hitag2
if card.tagtype == card.HITAG2 and card.readertype == card.READER_ACG:
if not key:
key= card.HITAG2_TRANSPORT_RWD
print ' Logging in with key: ' + key
if not card.login('','',key):
print 'Login failed!'
os._exit(True)
# Interpret EM4x05 ID structure
if card.tagtype == card.EM4x05:
card.FDXBIDPrint(ID)
# Q5 cards can emulate other cards, so check if this one responds as Q5
if card.tagtype == card.EM4x02 or card.tagtype == card.Q5 or card.tagtype == card.EM4x05:
print ' Checking for Q5'
card.settagtype(card.Q5)
card.select()
Q5ID= card.uid
if card.tagtype == card.Q5:
print ' Q5 ID: ' + Q5ID
print
card.readblock(0)
print ' Config Block: ',
print card.ToHex(card.binary)
print ' Config Binary: ',
configbin= card.ToBinaryString(card.binary)
print configbin
print ' Reserved: ' + configbin[:12]
print ' Page Select: ' + configbin[12]
print ' Fast Write: ' + configbin[13]
print ' Data Bit Rate n5: ' + configbin[14]
print ' Data Bit Rate n4: ' + configbin[15]
print ' Data Bit Rate n3: ' + configbin[16]
print ' Data Bit Rate n2: ' + configbin[17]
print ' Data Bit Rate n1: ' + configbin[18]
print ' Data Bit Rate n0: ' + configbin[19]
print ' (Field Clocks/Bit: %d)' % (2 * int(configbin[14:20],2) + 2)
print ' Use AOR: ' + configbin[20]
print ' Use PWD: ' + configbin[21]
print ' PSK Carrier Freq: ' + configbin[22] + configbin[23]
print ' Inverse data out: ' + configbin[24]
print ' Modulation: ' + configbin[25] + configbin[26] + configbin[27] + " (%s)" % Q5Mod[configbin[25] + configbin[26] + configbin[27]]
print ' Maxblock: ' + configbin[28] + configbin[29] + configbin[30] + " (%d)" % int (configbin[28] + configbin[29] + configbin[30],2)
print ' Terminator: ' + configbin[31]
print
# Emulated ID is contained in 'traceability data'
print ' Traceability Data 1: ',
card.readblock(1)
td1= card.binary
# to test a hardwired number, uncomment following line (and td2 below)
# td1= chr(0xff) + chr(0x98) + chr(0xa6) + chr(0x4a)
print card.ToHex(td1)
print ' Traceability Data 2: ',
card.readblock(2)
td2= card.binary
# don't forget to set column parity!
# td2= chr(0x98) + chr(0xf8) + chr(0xc8) + chr(0x06)
print card.ToHex(td2)
print ' Traceability Binary: ',
tdbin= card.ToBinaryString(td1 + td2)
print tdbin
# traceability is broken into 4 bit chunks with even parity
print
print ' Header:',
print tdbin[:9]
print ' Parity (even)'
print ' D00-D03: ' + tdbin[9:13] + ' ' + tdbin[13]
print ' D10-D13: ' + tdbin[14:18] + ' ' + tdbin[18]
print ' D20-D23: ' + tdbin[19:23] + ' ' + tdbin[23]
print ' D30-D33: ' + tdbin[24:28] + ' ' + tdbin[28]
print ' D40-D43: ' + tdbin[29:33] + ' ' + tdbin[33]
print ' D50-D53: ' + tdbin[34:38] + ' ' + tdbin[38]
print ' D60-D63: ' + tdbin[39:43] + ' ' + tdbin[43]
print ' D70-D73: ' + tdbin[44:48] + ' ' + tdbin[48]
print ' D80-D83: ' + tdbin[49:53] + ' ' + tdbin[53]
print ' D90-D93: ' + tdbin[54:58] + ' ' + tdbin[58]
print ' ' + tdbin[59:63] + ' ' + tdbin[63] + ' Column Parity & Stop Bit'
# reconstruct data bytes
d0= chr(int(tdbin[9:13] + tdbin[14:18],2))
d1= chr(int(tdbin[19:23] + tdbin[24:28],2))
d2= chr(int(tdbin[29:33] + tdbin[34:38],2))
d3= chr(int(tdbin[39:43] + tdbin[44:48],2))
d4= chr(int(tdbin[49:53] + tdbin[54:58],2))
print
print ' Reconstructed data D00-D93 (UNIQUE ID): ',
card.HexPrint(d0 + d1 + d2 + d3 + d4)
# set ID to Q5ID so block reading works
ID= Q5ID
print
else:
print ' Native - UNIQUE ID: ' + card.EMToUnique(ID)
sector = 0
print
print ' Writing...'
print
while sector < card.LFXTagBlocks[card.tagtype]:
print ' sector %02x: ' % sector,
if card.readblock(sector):
print card.data,
if not card.writeblock(sector,card.data):
print 'Write failed'
else:
print 'OK'
else:
print 'Read error: ' + card.errorcode
sector += 1
print
# set reader back to all cards
card.settagtype(card.ALL)
card.select()
print
os._exit(False)