def parseCardStruct(connection, structure, data=[], sizeParsed=[], defaultStruct=[]):
table = {}
keys = []
total = 0
while (structure != []):
#print structure
#print table
#print ""
# TODO : maj total
if structure == -1: #TLV !
# TODO : Le faire sans bruteforce
structure = []
mode = findReadRecordMode(connection)
fileCounter = 0
while mode != -1:
entry = {}
subkeys = []
for number in range(1, MAX_RECORDS):
cardData, sw1, sw2 = readRecord(connection, number, 0, mode)
if len(cardData)>0:
try:
entry[number] = parseTLV(cardData)
except notTLVRecord:
''''
interpretersTable = plugin.getInterpretersTable()
if "default" in plugin.getInterpretersTable():
entry[number] = interpretersTable["default"](data)
else:
entry[number] = "No interpreter found for this NOT TLV field"
'''
# TODO : if defaultStruct !- [] ?
entry[number] = parseCardStruct(connection, defaultStruct, cardData, sizeParsed, defaultStruct)
subkeys.append(number)
else:
break
mode = findReadRecordMode(connection, mode)
fileCounter += 1
entry["Keys"] = subkeys
keys.append(fileCounter)
table[fileCounter] = entry
else:
field = structure[0]
name = field[0]
if type(name) == type([]):
hiddenFields = True
else:
hiddenFields = False
structure = structure[1:]
if field[1] == FieldType.Bitmap:
if type(data) != type(""): # TODO : check si c'est bien des 0 et des 1
data = display.hexListToBinaryString(data)
length = field[2]
bitmap = data[0:length]
#print bitmap
data = data[length:]
total += length
counter = 0
subfields = []
for subfield in field[3]:
try:
if bitmap[len(bitmap)-counter-1] == '1':
subfields.append(subfield)
except IndexError:
raise IncorrectStructure
counter += 1
structure = subfields + structure
elif field[1] == FieldType.FinalRepeated:
length = field[2]
datalen = len(data)
subfields = []
for i in range(datalen/length):
if data[i*length: (i+1)*length] == [0xff]*length: # TODO : faire avec des strings
break
subfields.append( ("%s %u" % (field[0], i+1), FieldType.Final, field[2], field[3], field[4]) )
structure = subfields + structure
elif field[1] == FieldType.StructRepeated:
#print data
length = field[2]
datalen = len(data)
number = 0
for i in range(datalen/length):
#print i,number, length
#print toHexString(data[i*number: i*number+length])
if data[i*length: (i+1)*length] == [0xff]*length: # TODO : faire avec des strings
break
number += 1
field = [(field[0], FieldType.Counter, 1, field[3])]
data = [number] + data
structure = field + structure
#print structure
# TODO : regrouper avec le cas précédent ? faire un reverse d'autres cas ?
elif field[1] == FieldType.ReversedStructRepeated:
length = field[2]
datalen = len(data)
newdata = []
for i in reversed(range(datalen/length)):
newdata += data[i*length: (i+1)*length]
data = newdata
#print data, newdata
structure = [(field[0], FieldType.StructRepeated, field[2], field[3])] + structure
else:
if field[1] == FieldType.DF:
entry = parseCardStruct(connection, field[3], data+field[2])
elif field[1] == FieldType.DFName:
# TODO : Check error
selectFileByName(connection, field[2])
entry = parseCardStruct(connection, field[3],[])
elif field[1] == FieldType.DFList:
entry = {}
subkeys = []
for addr in field[2]:
selectFile(connection, addr, 0x04)
addr= toHexString(addr)
subkeys.append(addr)
# TODO : le faire dans les autres cas, style DFName
if len(field)>4:
defaultStruct = field[4]
entry[addr] = parseCardStruct(connection, field[3], [], sizeParsed, defaultStruct)
entry["Keys"] = subkeys
elif field[1] == FieldType.TransparentEF:
(response, sw1, sw2, size) = selectFile(connection, data+field[2])
# TODO : code d'erreur ?
#try:
# size = findTransparentEFSize(connection, sw2)
#except:
# entry = "File not found"
if not statusIsOK(sw1, sw2): # or size == 0:
entry = "File not found"
else:
hexdata, sw1, sw2 = readData(connection, size)
entry = parseCardStruct(connection, field[3], hexdata)
# TODO : Quand est-on en binaire ou en hexa ?
elif field[1] == FieldType.RecordEF:
(response, sw1, sw2, size) = selectFile(connection, data+field[2])
if not statusIsOK(sw1, sw2):
entry = "Could not select the file in order to fetch the data"
else:
if hiddenFields:
newSizeParsed = []
entry = []
for i in range(len(name)):
entry.append({})
else:
entry = {}
subkeys = []
for number in range(1, MAX_RECORDS):
cardData, sw1, sw2 = readRecord(connection, number, size)
if len(cardData) > 0:
if cardData == [0xff]*len(cardData):
continue
interpreterTable = plugin.getInterpretersTable()
if "FORMAT" in interpreterTable:
cardData = interpreterTable["FORMAT"](cardData)
if hiddenFields:
counter = 0
for struct in field[3]:
entry[counter][number] = parseCardStruct(connection, struct, cardData, newSizeParsed)
cardData = cardData[newSizeParsed[0]:]
counter += 1
else:
entry[number] = parseCardStruct(connection, field[3], cardData)
subkeys.append(number)
else:
break
if hiddenFields:
for i in range(len(name)):
entry[i]["Keys"] = subkeys
else:
entry["Keys"] = subkeys
elif field[1] == FieldType.Counter:
length = field[2]
# TODO : bof, faire une fonction qui virifie si c'est du binaire ?
if type(data) == type(""):
counter = int(data[0:length], 2)
else:
counter = data[0] # TODO : data sur plusieurs octets
data = data[length:]
total += length
entry = {}
subkeys = []
for number in range(counter):
size = []
entry[number] = parseCardStruct(connection, field[3], data, size)
subkeys.append(number)
data = data[size[0]:]
entry["Keys"] = subkeys
elif field[1] == FieldType.Final:
length = field[2]
if type(length)==type([]):
length = length[0]
if length != 0:
#print length
value = data[0:length]
data = data[length:]
total += length
else:
value = data
data = []
total += len(value)
#print value
interpretation = interpretFinalField(value, field[4], name)
# TODO : beurk
if type(value) == type([]):
value = toHexString(value)
entry = display.formatOutput(interpretation, value, field[3])
if hiddenFields:
counter = 0
for subname in name:
table[subname] = entry[counter]
keys.append(subname)
counter += 1
else:
table[name] = entry
keys.append(name)
sizeParsed.append(total)
table["Keys"] = keys
#print table
return table
def parseCardStruct(connection, structure, data=[], sizeParsed=[], defaultStruct=[]):
table = {}
keys = []
total = 0
while (structure != []):
if structure == -1: # TLV
structure = []
mode = findReadRecordMode(connection)
fileCounter = 0
while mode != -1:
entry = {}
subkeys = []
for number in range(1, MAX_RECORDS):
cardData, sw1, sw2 = readRecord(connection, number, 0, mode)
if len(cardData)>0:
try:
entry[number] = parseTLV(cardData)
except notTLVRecord:
entry[number] = parseCardStruct(connection, defaultStruct, cardData, sizeParsed, defaultStruct)
subkeys.append(number)
else:
break
mode = findReadRecordMode(connection, mode)
fileCounter += 1
entry["Keys"] = subkeys
keys.append(fileCounter)
table[fileCounter] = entry
else:
field = structure[0]
name = field[0]
if type(name) == types.ListType:
hiddenFields = True
else:
hiddenFields = False
structure = structure[1:]
if field[1] == FieldType.Bitmap:
if not (type(data) is types.StringType):
data = display.hexListToBinaryString(data)
for bit in data:
if bit != '0' and bit != '1':
raise IncorrectStructure
length = field[2]
bitmap = data[0:length]
data = data[length:]
total += length
counter = 0
subfields = []
for subfield in field[3]:
try:
if bitmap[len(bitmap)-counter-1] == '1':
subfields.append(subfield)
except IndexError:
raise IncorrectStructure
counter += 1
structure = subfields + structure
elif field[1] == FieldType.FinalRepeated:
length = field[2]
datalen = len(data)
subfields = []
for i in range(datalen/length):
if data[i*length: (i+1)*length] == [0xff]*length:
break
subfields.append( ("%s %u" % (field[0], i+1), FieldType.Final, field[2], field[3], field[4]) )
structure = subfields + structure
elif field[1] == FieldType.StructRepeated:
length = field[2]
datalen = len(data)
number = 0
for i in range(datalen/length):
if data[i*length: (i+1)*length] == [0xff]*length:
break
number += 1
field = [(field[0], FieldType.Counter, 1, field[3])]
data = [number] + data
structure = field + structure
elif field[1] == FieldType.ReversedStructRepeated:
length = field[2]
datalen = len(data)
newdata = []
for i in reversed(range(datalen/length)):
newdata += data[i*length: (i+1)*length]
data = newdata
structure = [(field[0], FieldType.StructRepeated, field[2], field[3])] + structure
else:
if field[1] == FieldType.DF:
entry = parseCardStruct(connection, field[3], data+field[2])
elif field[1] == FieldType.DFName:
selectFileByName(connection, field[2])
entry = parseCardStruct(connection, field[3],[])
elif field[1] == FieldType.DFList:
entry = {}
subkeys = []
for addr in field[2]:
selectFile(connection, addr, 0x04)
addr= toHexString(addr)
subkeys.append(addr)
if len(field)>4:
defaultStruct = field[4]
entry[addr] = parseCardStruct(connection, field[3], [], sizeParsed, defaultStruct)
entry["Keys"] = subkeys
elif field[1] == FieldType.TransparentEF:
(response, sw1, sw2, size) = selectFile(connection, data+field[2])
if not statusIsOK(sw1, sw2):
entry = "File not found"
else:
hexdata, sw1, sw2 = readData(connection, size)
entry = parseCardStruct(connection, field[3], hexdata)
elif field[1] == FieldType.RecordEF:
(response, sw1, sw2, size) = selectFile(connection, data+field[2])
if not statusIsOK(sw1, sw2):
entry = "Could not select the file in order to fetch the data"
else:
if hiddenFields:
newSizeParsed = []
entry = []
for i in range(len(name)):
entry.append({})
else:
entry = {}
subkeys = []
for number in range(1, MAX_RECORDS):
cardData, sw1, sw2 = readRecord(connection, number, size)
if len(cardData) > 0:
if cardData == [0xff]*len(cardData):
continue
interpreterTable = plugin.getInterpretersTable()
if "FORMAT" in interpreterTable:
cardData = interpreterTable["FORMAT"](cardData)
if hiddenFields:
counter = 0
for struct in field[3]:
entry[counter][number] = parseCardStruct(connection, struct, cardData, newSizeParsed)
cardData = cardData[newSizeParsed[0]:]
counter += 1
else:
entry[number] = parseCardStruct(connection, field[3], cardData)
subkeys.append(number)
else:
break
if hiddenFields:
for i in range(len(name)):
entry[i]["Keys"] = subkeys
else:
entry["Keys"] = subkeys
elif field[1] == FieldType.Counter:
length = field[2]
if type(data) is types.StringType:
counter = int(data[0:length], 2)
else:
counter = data[0]
data = data[length:]
total += length
entry = {}
subkeys = []
for number in range(counter):
size = []
entry[number] = parseCardStruct(connection, field[3], data, size)
subkeys.append(number)
data = data[size[0]:]
entry["Keys"] = subkeys
elif field[1] == FieldType.Final:
length = field[2]
if type(length) is types.ListType:
length = length[0]
if length != 0:
value = data[0:length]
data = data[length:]
total += length
else:
value = data
data = []
total += len(value)
interpretation = interpretFinalField(value, field[4], name)
if type(value) is types.ListType:
value = toHexString(value)
entry = display.formatOutput(interpretation, value, field[3])
if hiddenFields:
counter = 0
for subname in name:
table[subname] = entry[counter]
keys.append(subname)
counter += 1
else:
table[name] = entry
keys.append(name)
sizeParsed.append(total)
table["Keys"] = keys
return table
def parseCardStruct(connection, structure, data=[], sizeParsed=[], defaultStruct=[]):
table = {}
keys = []
total = 0
while (structure != []):
if structure == -1: # TLV
structure = []
mode = findReadRecordMode(connection)
fileCounter = 0
while mode != -1:
entry = {}
subkeys = []
for number in range(1, MAX_RECORDS+1):
cardData, sw1, sw2 = readRecord(connection, number, 0, mode)
if len(cardData)>0:
try:
entry[number] = parseTLV(cardData)
except notTLVRecord:
entry[number] = parseCardStruct(connection, defaultStruct, cardData, sizeParsed, defaultStruct)
subkeys.append(number)
else:
break
mode = findReadRecordMode(connection, mode)
fileCounter += 1
entry["Keys"] = subkeys
keys.append(fileCounter)
table[fileCounter] = entry
else:
field = structure[0]
name = field[0]
if type(name) == types.ListType:
hiddenFields = True
else:
hiddenFields = False
structure = structure[1:]
if field[1] == FieldType.Bitmap:
if not (type(data) is types.StringType):
data = display.hexListToBinaryString(data)
for bit in data:
if bit != '0' and bit != '1':
raise IncorrectStructure
length = field[2]
bitmap = data[0:length]
data = data[length:]
total += length
counter = 0
subfields = []
for subfield in field[3]:
try:
if bitmap[len(bitmap)-counter-1] == '1':
subfields.append(subfield)
except IndexError:
raise IncorrectStructure
counter += 1
structure = subfields + structure
elif field[1] == FieldType.FinalRepeated:
length = field[2]
datalen = len(data)
subfields = []
for i in range(datalen/length):
if data[i*length: (i+1)*length] == [0xff]*length:
break
subfields.append( ("%s %u" % (field[0], i+1), FieldType.Final, field[2], field[3], field[4]) )
structure = subfields + structure
elif field[1] == FieldType.StructRepeated:
length = field[2]
datalen = len(data)
number = 0
for i in range(datalen/length):
if data[i*length: (i+1)*length] == [0xff]*length:
break
number += 1
field = [(field[0], FieldType.Counter, 1, field[3])]
data = [number] + data
structure = field + structure
elif field[1] == FieldType.ReversedStructRepeated:
length = field[2]
datalen = len(data)
newdata = []
for i in reversed(range(datalen/length)):
newdata += data[i*length: (i+1)*length]
data = newdata
structure = [(field[0], FieldType.StructRepeated, field[2], field[3])] + structure
else:
entry = None
if field[1] == FieldType.DF:
entry = parseCardStruct(connection, field[3], data+field[2])
elif field[1] == FieldType.DFName:
selectFileByName(connection, field[2])
entry = parseCardStruct(connection, field[3],[])
elif field[1] == FieldType.DFList:
entry = {}
subkeys = []
for addr in field[2]:
selectFile(connection, addr, 0x04)
addr= toHexString(addr)
subkeys.append(addr)
if len(field)>4:
defaultStruct = field[4]
entry[addr] = parseCardStruct(connection, field[3], [], sizeParsed, defaultStruct)
entry["Keys"] = subkeys
elif field[1] == FieldType.TransparentEF:
(response, sw1, sw2, size) = selectFile(connection, data+field[2])
if not statusIsOK(sw1, sw2):
entry = "File not found"
else:
hexdata, sw1, sw2 = readData(connection, size)
entry = parseCardStruct(connection, field[3], hexdata)
elif field[1] == FieldType.RecordEF:
(response, sw1, sw2, size) = selectFile(connection, data+field[2])
if not statusIsOK(sw1, sw2):
entry = "Could not select the file in order to fetch the data"
else:
if hiddenFields:
newSizeParsed = []
entry = []
for i in range(len(name)):
entry.append({})
else:
entry = {}
subkeys = []
for number in range(1, MAX_RECORDS+1):
cardData, sw1, sw2 = readRecord(connection, number, size)
if len(cardData) > 0:
if cardData == [0xff]*len(cardData):
continue
interpreterTable = plugin.getInterpretersTable()
if "FORMAT" in interpreterTable:
cardData = interpreterTable["FORMAT"](cardData)
if hiddenFields:
counter = 0
for struct in field[3]:
entry[counter][number] = parseCardStruct(connection, struct, cardData, newSizeParsed)
cardData = cardData[newSizeParsed[0]:]
counter += 1
else:
entry[number] = parseCardStruct(connection, field[3], cardData)
subkeys.append(number)
else:
break
if hiddenFields:
for i in range(len(name)):
entry[i]["Keys"] = subkeys
else:
entry["Keys"] = subkeys
elif field[1] == FieldType.Counter:
length = field[2]
if type(data) is types.StringType:
counter = int(data[0:length], 2)
else:
counter = data[0]
data = data[length:]
total += length
entry = {}
subkeys = []
for number in range(counter):
size = []
entry[number] = parseCardStruct(connection, field[3], data, size)
subkeys.append(number)
data = data[size[0]:]
entry["Keys"] = subkeys
elif field[1] == FieldType.Final or field[1] == FieldType.FinalWithHeader:
value = None
if field[1] == FieldType.Final:
length = field[2]
description = field[3]
finalType = field[4]
elif field[1] == FieldType.FinalWithHeader:
headerLength = field[2]
header = data[0:headerLength]
data = data[headerLength:]
length = header[field[3]]
description = field[4]
finalType = field[5]
if type(length) is types.ListType:
length = length[0]
if length != 0:
value = data[0:length]
data = data[length:]
total += length
elif field[1] == FieldType.Final:
value = data
data = []
total += len(value)
if value is not None:
interpretation = interpretFinalField(value, finalType, name)
if type(value) is types.ListType:
value = toHexString(value)
entry = display.formatOutput(interpretation, value, description)
else:
entry = display.formatOutput("", "", description)
if entry is not None:
if hiddenFields:
counter = 0
for subname in name:
table[subname] = entry[counter]
keys.append(subname)
counter += 1
else:
table[name] = entry
keys.append(name)
sizeParsed.append(total)
table["Keys"] = keys
return table
