FIX: tnp3sim, now can insert keys if the dumpfile is blank. Like the ,,,lander dumps...

diff --git a/client/scripts/tnp3dump.lua b/client/scripts/tnp3dump.lua
index 211d146fd1c4da89d200ea05d568cb1a3f0a1fa6..44e59657d6398782bccfad7141e72359e897e6bf 100644 (file)
--- a/client/scripts/tnp3dump.lua
+++ b/client/scripts/tnp3dump.lua
@@ -38,9 +38,7 @@ local numSectors = 16
 --- 
 -- A debug printout-function
 function dbg(args)
 --- 
 -- A debug printout-function
 function dbg(args)

-       if not DEBUG then
-               return
-       end
+       if not DEBUG then return end

        
     if type(args) == "table" then
                local i = 1
        
     if type(args) == "table" then
                local i = 1


@@ -56,6 +54,7 @@ end
 -- This is only meant to be used when errors occur
 function oops(err)
        print("ERROR: ",err)
 -- This is only meant to be used when errors occur
 function oops(err)
        print("ERROR: ",err)

+       return nil,err

 end
 --- 
 -- Usage help
 end
 --- 
 -- Usage help


@@ -166,6 +165,8 @@ local function main(args)
        local block0, err = waitCmd()
        if err then return oops(err) end
        
        local block0, err = waitCmd()
        if err then return oops(err) end
        

+       core.clearCommandBuffer()
+       

        -- Read block 1
        cmd = Command:new{cmd = cmds.CMD_MIFARE_READBL, arg1 = 1,arg2 = 0,arg3 = 0, data = keyA}
        err = core.SendCommand(cmd:getBytes())
        -- Read block 1
        cmd = Command:new{cmd = cmds.CMD_MIFARE_READBL, arg1 = 1,arg2 = 0,arg3 = 0, data = keyA}
        err = core.SendCommand(cmd:getBytes())


@@ -173,16 +174,15 @@ local function main(args)
        local block1, err = waitCmd()
        if err then return oops(err) end
 
        local block1, err = waitCmd()
        if err then return oops(err) end
 

+       core.clearCommandBuffer()
+       

        local tmpHash = block0..block1..'%02x'..RANDOM
 
        local key
        local pos = 0
        local blockNo
        local blocks = {}
        local tmpHash = block0..block1..'%02x'..RANDOM
 
        local key
        local pos = 0
        local blockNo
        local blocks = {}

-
-       print('Reading card data')
-       core.clearCommandBuffer()
-               
+       

        -- main loop
        io.write('Reading blocks > ')
        for blockNo = 0, numBlocks-1, 1 do
        -- main loop
        io.write('Reading blocks > ')
        for blockNo = 0, numBlocks-1, 1 do


@@ -192,6 +192,8 @@ local function main(args)
                        break
                end
        
                        break
                end
        

+               core.clearCommandBuffer()
+               

                pos = (math.floor( blockNo / 4 ) * 12)+1
                key = akeys:sub(pos, pos + 11 )
                cmd = Command:new{cmd = cmds.CMD_MIFARE_READBL, arg1 = blockNo ,arg2 = 0,arg3 = 0, data = key}
                pos = (math.floor( blockNo / 4 ) * 12)+1
                key = akeys:sub(pos, pos + 11 )
                cmd = Command:new{cmd = cmds.CMD_MIFARE_READBL, arg1 = blockNo ,arg2 = 0,arg3 = 0, data = key}


@@ -214,8 +216,8 @@ local function main(args)
                                        local baseStr = utils.ConvertHexToAscii(tmpHash:format(blockNo))
                                        local key = md5.sumhexa(baseStr)
                                        local aestest = core.aes128_decrypt(key, blockdata)
                                        local baseStr = utils.ConvertHexToAscii(tmpHash:format(blockNo))
                                        local key = md5.sumhexa(baseStr)
                                        local aestest = core.aes128_decrypt(key, blockdata)

-                                       local hex = utils.ConvertAsciiToBytes(aestest)
-                                       hex = utils.ConvertBytesToHex(hex)
+                                       local hex = ConvertAsciiToHex(aestest)
+                                       

                                        blocks[blockNo+1] = ('%02d  :: %s'):format(blockNo,hex)
                                        io.write(blockNo..',')
                                end             
                                        blocks[blockNo+1] = ('%02d  :: %s'):format(blockNo,hex)
                                        io.write(blockNo..',')
                                end             


@@ -235,9 +237,7 @@ local function main(args)
 
        for _,s in pairs(blocks) do
                local slice = s:sub(8,#s)
 
        for _,s in pairs(blocks) do
                local slice = s:sub(8,#s)

-               local str = utils.ConvertBytesToAscii(
-                                utils.ConvertHexToBytes(slice)
-                               )
+               local str = utils.ConvertHexToAscii(slice)

                emldata = emldata..slice..'\n'
                for c in (str):gmatch('.') do
                        bindata[#bindata+1] = c
                emldata = emldata..slice..'\n'
                for c in (str):gmatch('.') do
                        bindata[#bindata+1] = c

diff --git a/client/scripts/tnp3sim.lua b/client/scripts/tnp3sim.lua
index 11b268dd04ba94497e850c1aa9321575b49f37d6..ca729f38dcdf9b14c863777a882394c36aa90912 100644 (file)
--- a/client/scripts/tnp3sim.lua
+++ b/client/scripts/tnp3sim.lua
@@ -5,7 +5,8 @@ local lib14a = require('read14a')
 local utils = require('utils')
 local md5 = require('md5')
 local toys = require('default_toys')
 local utils = require('utils')
 local md5 = require('md5')
 local toys = require('default_toys')

-
+local pre = require('precalc')
+               

 example =[[
        1. script run tnp3sim
        2. script run tnp3sim -m
 example =[[
        1. script run tnp3sim
        2. script run tnp3sim -m


@@ -27,7 +28,7 @@ Arguments:
        ]]
 
 local TIMEOUT = 2000 -- Shouldn't take longer than 2 seconds
        ]]
 
 local TIMEOUT = 2000 -- Shouldn't take longer than 2 seconds

-local DEBUG = false -- the debug flag
+local DEBUG = true -- the debug flag

 local RANDOM = '20436F707972696768742028432920323031302041637469766973696F6E2E20416C6C205269676874732052657365727665642E20'
 
 local band = bit32.band
 local RANDOM = '20436F707972696768742028432920323031302041637469766973696F6E2E20416C6C205269676874732052657365727665642E20'
 
 local band = bit32.band


@@ -42,9 +43,7 @@ local format = string.format
 --- 
 -- A debug printout-function
 function dbg(args)
 --- 
 -- A debug printout-function
 function dbg(args)

-       if not DEBUG then
-               return
-       end
+       if not DEBUG then return end

        
     if type(args) == "table" then
                local i = 1
        
     if type(args) == "table" then
                local i = 1


@@ -107,6 +106,14 @@ local function GetCheckSum(blocks, dataarea, chksumtype)
        return utils.SwapEndianness(crc,16)
 end
 
        return utils.SwapEndianness(crc,16)
 end
 

+local function SetAllCheckSum(blocks)
+       print('Updating all checksums')
+       SetCheckSum(blocks, 3)
+       SetCheckSum(blocks, 2)
+       SetCheckSum(blocks, 1)
+       SetCheckSum(blocks, 0)
+end
+

 local function SetCheckSum(blocks, chksumtype)
 
        if blocks == nil then return nil, 'Argument \"blocks\" nil' end
 local function SetCheckSum(blocks, chksumtype)
 
        if blocks == nil then return nil, 'Argument \"blocks\" nil' end


@@ -154,7 +161,8 @@ function CalcCheckSum(blocks, dataarea, chksumtype)
 end
 
 local function ValidateCheckSums(blocks)
 end
 
 local function ValidateCheckSums(blocks)

-
+       print(' Validating checksums')
+       

        local isOk, crc, calc
        -- Checksum Type 0
        crc = GetCheckSum(blocks,1,0)
        local isOk, crc, calc
        -- Checksum Type 0
        crc = GetCheckSum(blocks,1,0)


@@ -199,9 +207,17 @@ local function ValidateCheckSums(blocks)
        io.write( ('TYPE 3 area 2: %04x = %04x -- %s\n'):format(crc,calc,isOk))
 
 end
        io.write( ('TYPE 3 area 2: %04x = %04x -- %s\n'):format(crc,calc,isOk))
 
 end

-local function LoadEmulator(blocks)
-       local cmd
-       local blockdata
+
+local function AddKey(keys, blockNo, data)
+       local pos = (math.floor( blockNo / 4 ) * 12)+1
+       local key = keys:sub(pos, pos + 11 )
+       return key..data:sub(13)
+end
+
+local function LoadEmulator(uid, blocks)
+       print('Sending dumpdata to emulator memory')
+       local keys = pre.GetAll(uid)
+       local cmd, blockdata

        for _,b in pairs(blocks) do 
                
                blockdata = b
        for _,b in pairs(blocks) do 
                
                blockdata = b


@@ -212,14 +228,16 @@ local function LoadEmulator(blocks)
                                local baseStr = utils.ConvertHexToAscii(base)
                                local key = md5.sumhexa(baseStr)
                                local enc = core.aes128_encrypt(key, blockdata)
                                local baseStr = utils.ConvertHexToAscii(base)
                                local key = md5.sumhexa(baseStr)
                                local enc = core.aes128_encrypt(key, blockdata)

-                               local hex = utils.ConvertAsciiToBytes(enc)
-                               hex = utils.ConvertBytesToHex(hex)
-                       
-                               blockdata = hex
+                               blockdata = utils.ConvertAsciiToHex(enc)

                                io.write( _..',')
                        end
                                io.write( _..',')
                        end

+               else            
+                       -- add keys if not existing..
+                       if ( blockdata:sub(1,12) == '000000000000' ) then
+                               blockdata = AddKey(keys, _, blockdata)
+                       end

                end
                end

-
+               core.clearCommandBuffer()

                cmd = Command:new{cmd = cmds.CMD_MIFARE_EML_MEMSET, arg1 = _ ,arg2 = 1,arg3 = 16, data = blockdata}
                local err = core.SendCommand(cmd:getBytes())
                if err then return err end
                cmd = Command:new{cmd = cmds.CMD_MIFARE_EML_MEMSET, arg1 = _ ,arg2 = 1,arg3 = 16, data = blockdata}
                local err = core.SendCommand(cmd:getBytes())
                if err then return err end


@@ -357,10 +375,7 @@ local function main(args)
                blockindex = blockindex + 1
        end
 
                blockindex = blockindex + 1
        end
 

-       if DEBUG then
-               print(' Validating checksums')
-               ValidateCheckSums(blocks)
-       end
+       if DEBUG then ValidateCheckSums(blocks) end

        
        --
        print( string.rep('--',20) )    
        
        --
        print( string.rep('--',20) )    


@@ -419,7 +434,7 @@ local function main(args)
 
        local level = blocks[13]:sub(27,28)
        print(('LEVEL : %d'):format( tonumber(level,16)))
 
        local level = blocks[13]:sub(27,28)
        print(('LEVEL : %d'):format( tonumber(level,16)))

-       --hälsa: 667 029b  
+

        --local health = blocks[]:sub();
        --print(('Health : %d'):format( tonumber(health,16))
        
        --local health = blocks[]:sub();
        --print(('Health : %d'):format( tonumber(health,16))
        


@@ -457,20 +472,15 @@ local function main(args)
                --print (blocks[13])
        
                -- Update Checksums
                --print (blocks[13])
        
                -- Update Checksums

-               print('Updating all checksums')
-               SetCheckSum(blocks, 3)
-               SetCheckSum(blocks, 2)
-               SetCheckSum(blocks, 1)
-               SetCheckSum(blocks, 0)
-       
-               print('Validating all checksums')       
+               SetAllCheckSum(blocks)
+
+               -- Validate Checksums

                ValidateCheckSums(blocks)
        end
                ValidateCheckSums(blocks)
        end

-       
+

        --Load dumpdata to emulator memory
        if DEBUG then
        --Load dumpdata to emulator memory
        if DEBUG then

-               print('Sending dumpdata to emulator memory')
-               err = LoadEmulator(blocks)
+               err = LoadEmulator(uid, blocks)

                if err then return oops(err) end        
                core.clearCommandBuffer()
                print('The simulation is now prepared.\n --> run \"hf mf sim u '..uid..'\" <--')
                if err then return oops(err) end        
                core.clearCommandBuffer()
                print('The simulation is now prepared.\n --> run \"hf mf sim u '..uid..'\" <--')