fix LED signalling in hf 15 snoop and hf 14a snoop (#797)

[proxmark3-svn] / client / scripting.c

diff --git a/client/scripting.c b/client/scripting.c
index 9e3ff4e35306c72c5805517d37ef618aa3e8733c..ed7ae007c63a854ceceb4cee8908d33780336ec5 100644 (file)
--- a/client/scripting.c
+++ b/client/scripting.c
@@ -8,14 +8,25 @@
 // Some lua scripting glue to proxmark core.
 //-----------------------------------------------------------------------------
 
 // Some lua scripting glue to proxmark core.
 //-----------------------------------------------------------------------------
 

+#include "scripting.h"
+
+#include <stdlib.h>

 #include <lua.h>
 #include <lualib.h>
 #include <lauxlib.h>
 #include "proxmark3.h"
 #include <lua.h>
 #include <lualib.h>
 #include <lauxlib.h>
 #include "proxmark3.h"

+#include "comms.h"

 #include "usb_cmd.h"
 #include "cmdmain.h"
 #include "usb_cmd.h"
 #include "cmdmain.h"

-#include "scripting.h"

 #include "util.h"
 #include "util.h"

+#include "mifarehost.h"
+#include "../common/iso15693tools.h"
+#include "iso14443crc.h"
+#include "../common/crc16.h"
+#include "../common/crc64.h"
+#include <mbedtls/sha1.h>
+#include <mbedtls/aes.h>
+

 /**
  * The following params expected:
  *  UsbCommand c
 /**
  * The following params expected:
  *  UsbCommand c


@@ -25,34 +36,34 @@
  */
 static int l_SendCommand(lua_State *L){
 
  */
 static int l_SendCommand(lua_State *L){
 

-    /*
-     *
-     The SendCommand (native) expects the following structure:
-
-     typedef struct {
-      uint64_t cmd; //8 bytes
-      uint64_t arg[3]; // 8*3 bytes = 24 bytes
-      union {
-        uint8_t  asBytes[USB_CMD_DATA_SIZE]; // 1 byte * 512 = 512 bytes (OR)
-        uint32_t asDwords[USB_CMD_DATA_SIZE/4]; // 4 byte * 128 = 512 bytes
-      } d;
-    } PACKED UsbCommand;
-
-    ==> A 544 byte buffer will do.
-    **/
-    //Pop cmd
-    size_t size;
-    const char *data = luaL_checklstring(L, 1, &size);
-    if(size != sizeof(UsbCommand))
-    {
-        printf("Got data size %d, expected %d" , (int) size,(int) sizeof(UsbCommand));
-        lua_pushstring(L,"Wrong data size");
-        return 1;
-    }
+       /*
+        *
+        The SendCommand (native) expects the following structure:
+
+        typedef struct {
+         uint64_t cmd; //8 bytes
+         uint64_t arg[3]; // 8*3 bytes = 24 bytes
+         union {
+               uint8_t  asBytes[USB_CMD_DATA_SIZE]; // 1 byte * 512 = 512 bytes (OR)
+               uint32_t asDwords[USB_CMD_DATA_SIZE/4]; // 4 byte * 128 = 512 bytes
+         } d;
+       } PACKED UsbCommand;
+
+       ==> A 544 byte buffer will do.
+       **/
+       //Pop cmd
+       size_t size;
+       const char *data = luaL_checklstring(L, 1, &size);
+       if(size != sizeof(UsbCommand))
+       {
+               printf("Got data size %d, expected %d" , (int) size,(int) sizeof(UsbCommand));
+               lua_pushstring(L,"Wrong data size");
+               return 1;
+       }

 
 //    UsbCommand c = (*data);
 
 //    UsbCommand c = (*data);

-    SendCommand((UsbCommand* )data);
-    return 0; // no return values
+       SendCommand((UsbCommand* )data);
+       return 0; // no return values

 }
 /**
  * @brief The following params expected:
 }
 /**
  * @brief The following params expected:


@@ -63,50 +74,83 @@ static int l_SendCommand(lua_State *L){
  */
 static int l_WaitForResponseTimeout(lua_State *L){
 
  */
 static int l_WaitForResponseTimeout(lua_State *L){
 

-    uint32_t cmd = 0;
-    size_t ms_timeout = -1;
-
-    //Check number of arguments
-    int n = lua_gettop(L);
-    if(n == 0)
-    {
-        //signal error by returning Nil, errorstring
-        lua_pushnil(L);
-        lua_pushstring(L,"You need to supply at least command to wait for");
-        return 2; // two return values
-    }
-    if(n >= 1)
-    {
-        //pop cmd
-        cmd = luaL_checkunsigned(L,1);
-    }
-    if(n >= 2)
-    {
-        //Did the user send a timeout ?
-        //Check if the current top of stack is an integer
-        ms_timeout = luaL_checkunsigned(L,2);
-        //printf("Timeout set to %dms\n" , (int) ms_timeout);
-    }
-
-    UsbCommand response;
-
-    if(WaitForResponseTimeout(cmd, &response, ms_timeout))
-    {
-        //Push it as a string
-         lua_pushlstring(L,(const char *)&response,sizeof(UsbCommand));
-
-        return 1;// return 1 to signal one return value
-    }else{
-        //Push a Nil instead
-        lua_pushnil(L);
-        return 1;// one return value
-    }
-}
-//static int l_nonce2key(lua_State *L){ return CmdHF14AMfRdSc(luaL_checkstring(L, 1));}
+       uint32_t cmd = 0;
+       size_t ms_timeout = -1;
+
+       //Check number of arguments
+       int n = lua_gettop(L);
+       if(n == 0)
+       {
+               //signal error by returning Nil, errorstring
+               lua_pushnil(L);
+               lua_pushstring(L,"You need to supply at least command to wait for");
+               return 2; // two return values
+       }
+       if(n >= 1)
+       {
+               //pop cmd
+               cmd = luaL_checkunsigned(L,1);
+       }
+       if(n >= 2)
+       {
+               //Did the user send a timeout ?
+               //Check if the current top of stack is an integer
+               ms_timeout = luaL_checkunsigned(L,2);
+               //printf("Timeout set to %dms\n" , (int) ms_timeout);
+       }
+
+       UsbCommand response;
+
+       if(WaitForResponseTimeout(cmd, &response, ms_timeout))
+       {
+               //Push it as a string
+               lua_pushlstring(L,(const char *)&response,sizeof(UsbCommand));
+
+               return 1;// return 1 to signal one return value
+       }else{
+               //Push a Nil instead
+               lua_pushnil(L);
+               return 1;// one return value
+       }
+}
+
+static int returnToLuaWithError(lua_State *L, const char* fmt, ...)
+{
+       char buffer[200];
+       va_list args;
+       va_start(args,fmt);
+       vsnprintf(buffer, sizeof(buffer), fmt,args);
+       va_end(args);
+
+       lua_pushnil(L);
+       lua_pushstring(L,buffer);
+       return 2;
+}
+
+static int l_mfDarkside(lua_State *L){
+
+       uint64_t key;
+       
+       int retval = mfDarkside(&key);
+       
+       //Push the retval on the stack
+       lua_pushinteger(L, retval);
+
+       //Push the key onto the stack
+       uint8_t dest_key[8];
+       num_to_bytes(key, sizeof(dest_key), dest_key);
+
+       //printf("Pushing to lua stack: %012" PRIx64 "\n",key);
+       lua_pushlstring(L,(const char *)dest_key, sizeof(dest_key));
+
+       return 2; //Two return values
+}
+

 //static int l_PrintAndLog(lua_State *L){ return CmdHF14AMfDump(luaL_checkstring(L, 1));}
 //static int l_PrintAndLog(lua_State *L){ return CmdHF14AMfDump(luaL_checkstring(L, 1));}

+

 static int l_clearCommandBuffer(lua_State *L){
 static int l_clearCommandBuffer(lua_State *L){

-    clearCommandBuffer();
-    return 0;
+       clearCommandBuffer();
+       return 0;

 }
 /**
  * @brief l_foobar is a dummy function to test lua-integration with
 }
 /**
  * @brief l_foobar is a dummy function to test lua-integration with


@@ -115,17 +159,26 @@ static int l_clearCommandBuffer(lua_State *L){
  */
 static int l_foobar(lua_State *L)
 {
  */
 static int l_foobar(lua_State *L)
 {

-    //Check number of arguments
-    int n = lua_gettop(L);
-    printf("foobar called with %d arguments" , n);
-    lua_settop(L, 0);
-    printf("Arguments discarded, stack now contains %d elements", lua_gettop(L));
-    UsbCommand response =  {CMD_MIFARE_READBL, {1337, 1338, 1339}};
-    printf("Now returning a UsbCommand as a string");
-    lua_pushlstring(L,(const char *)&response,sizeof(UsbCommand));
-    return 1;
+       //Check number of arguments
+       int n = lua_gettop(L);
+       printf("foobar called with %d arguments" , n);
+       lua_settop(L, 0);
+       printf("Arguments discarded, stack now contains %d elements", lua_gettop(L));
+
+       // todo: this is not used, where was it intended for?
+       // UsbCommand response =  {CMD_MIFARE_READBL, {1337, 1338, 1339}};
+
+       printf("Now returning a uint64_t as a string");
+       uint64_t x = 0xDEADBEEF;
+       uint8_t destination[8];
+       num_to_bytes(x,sizeof(x),destination);
+       lua_pushlstring(L,(const char *)&x,sizeof(x));
+       lua_pushlstring(L,(const char *)destination,sizeof(destination));
+
+       return 2;

 }
 
 }
 

+

 /**
  * @brief Utility to check if a key has been pressed by the user. This method does not block.
  * @param L
 /**
  * @brief Utility to check if a key has been pressed by the user. This method does not block.
  * @param L


@@ -133,8 +186,8 @@ static int l_foobar(lua_State *L)
  */
 static int l_ukbhit(lua_State *L)
 {
  */
 static int l_ukbhit(lua_State *L)
 {

-    lua_pushboolean(L,ukbhit() ? true : false);
-    return 1;
+       lua_pushboolean(L,ukbhit() ? true : false);
+       return 1;

 }
 /**
  * @brief Calls the command line parser to deal with the command. This enables
 }
 /**
  * @brief Calls the command line parser to deal with the command. This enables


@@ -144,10 +197,200 @@ static int l_ukbhit(lua_State *L)
  */
 static int l_CmdConsole(lua_State *L)
 {
  */
 static int l_CmdConsole(lua_State *L)
 {

-    CommandReceived((char *)luaL_checkstring(L, 1));
-    return 0;
+       CommandReceived((char *)luaL_checkstring(L, 1));
+       return 0;
+}
+
+static int l_iso15693_crc(lua_State *L)
+{
+       //    uint16_t Iso15693Crc(uint8_t *v, int n);
+       size_t size;
+       const char *v = luaL_checklstring(L, 1, &size);
+       uint16_t retval = Iso15693Crc((uint8_t *) v, size);
+       lua_pushinteger(L, (int) retval);
+       return 1;
+}
+
+static int l_iso14443b_crc(lua_State *L)
+{
+       /* void ComputeCrc14443(int CrcType,
+                     const unsigned char *Data, int Length,
+                     unsigned char *TransmitFirst,
+                     unsigned char *TransmitSecond)
+       */
+       unsigned char buf[USB_CMD_DATA_SIZE];
+       size_t len = 0;
+       const char *data = luaL_checklstring(L, 1, &len);
+       if (len > USB_CMD_DATA_SIZE-2)
+               len =  USB_CMD_DATA_SIZE-2;
+
+       for (int i = 0; i < len; i += 2) {
+               sscanf(&data[i], "%02x", (unsigned int *)&buf[i / 2]);
+       }
+       ComputeCrc14443(CRC_14443_B, buf, len, &buf[len], &buf[len+1]);
+
+       lua_pushlstring(L, (const char *)&buf, len+2);
+       return 1;
+}
+/*
+ Simple AES 128 cbc hook up to OpenSSL.
+ params:  key, input
+*/
+static int l_aes128decrypt_cbc(lua_State *L)
+{
+       //Check number of arguments
+       int i;
+       size_t size;
+       const char *p_key = luaL_checklstring(L, 1, &size);
+       if(size != 32)  return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
+
+       const char *p_encTxt = luaL_checklstring(L, 2, &size);
+
+       unsigned char indata[16] = {0x00};
+       unsigned char outdata[16] = {0x00};
+       unsigned char aes_key[16] = {0x00};
+       unsigned char iv[16] = {0x00};
+
+       // convert key to bytearray and convert input to bytearray
+       for (i = 0; i < 32; i += 2) {
+               sscanf(&p_encTxt[i], "%02x", (unsigned int *)&indata[i / 2]);
+               sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
+       }
+
+       mbedtls_aes_context ctx;
+       mbedtls_aes_init(&ctx);
+       mbedtls_aes_setkey_dec(&ctx, aes_key, 128);
+       mbedtls_aes_crypt_cbc(&ctx, MBEDTLS_AES_DECRYPT, sizeof(indata), iv, indata,outdata );
+       //Push decrypted array as a string
+       lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
+       return 1;// return 1 to signal one return value
+}
+static int l_aes128decrypt_ecb(lua_State *L)
+{
+       //Check number of arguments
+       int i;
+       size_t size;
+       const char *p_key = luaL_checklstring(L, 1, &size);
+       if(size != 32)  return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
+
+       const char *p_encTxt = luaL_checklstring(L, 2, &size);
+
+       unsigned char indata[16] = {0x00};
+       unsigned char outdata[16] = {0x00};
+       unsigned char aes_key[16] = {0x00};
+
+       // convert key to bytearray and convert input to bytearray
+       for (i = 0; i < 32; i += 2) {
+               sscanf(&p_encTxt[i], "%02x", (unsigned int *)&indata[i / 2]);
+               sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
+       }
+       mbedtls_aes_context ctx;
+       mbedtls_aes_init(&ctx);
+       mbedtls_aes_setkey_dec(&ctx, aes_key, 128);
+       mbedtls_aes_crypt_ecb(&ctx, MBEDTLS_AES_DECRYPT, indata, outdata );
+
+       //Push decrypted array as a string
+       lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
+       return 1;// return 1 to signal one return value
+}
+
+static int l_aes128encrypt_cbc(lua_State *L)
+{
+       //Check number of arguments
+       int i;
+       size_t size;
+       const char *p_key = luaL_checklstring(L, 1, &size);
+       if(size != 32)  return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
+
+       const char *p_txt = luaL_checklstring(L, 2, &size);
+
+       unsigned char indata[16] = {0x00};
+       unsigned char outdata[16] = {0x00};
+       unsigned char aes_key[16] = {0x00};
+       unsigned char iv[16] = {0x00};
+       
+       for (i = 0; i < 32; i += 2) {
+               sscanf(&p_txt[i], "%02x", (unsigned int *)&indata[i / 2]);
+               sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
+       }
+
+       mbedtls_aes_context ctx;
+       mbedtls_aes_init(&ctx);
+       mbedtls_aes_setkey_enc(&ctx, aes_key, 128);
+       mbedtls_aes_crypt_cbc(&ctx, MBEDTLS_AES_ENCRYPT, sizeof(indata), iv, indata, outdata );
+       //Push encrypted array as a string
+       lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
+       return 1;// return 1 to signal one return value
+}
+
+static int l_aes128encrypt_ecb(lua_State *L)
+{
+       //Check number of arguments
+       int i;
+       size_t size;
+       const char *p_key = luaL_checklstring(L, 1, &size);
+       if(size != 32)  return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
+
+       const char *p_txt = luaL_checklstring(L, 2, &size);
+
+       unsigned char indata[16] = {0x00};
+       unsigned char outdata[16] = {0x00};
+       unsigned char aes_key[16] = {0x00};
+
+       for (i = 0; i < 32; i += 2) {
+               sscanf(&p_txt[i], "%02x", (unsigned int *)&indata[i / 2]);
+               sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
+       }
+       mbedtls_aes_context ctx;
+       mbedtls_aes_init(&ctx);
+       mbedtls_aes_setkey_enc(&ctx, aes_key, 128);
+       mbedtls_aes_crypt_ecb(&ctx, MBEDTLS_AES_ENCRYPT, indata, outdata );
+       //Push encrypted array as a string
+       lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
+       return 1;// return 1 to signal one return value
+}
+
+static int l_crc16(lua_State *L)
+{
+       size_t size;
+       const char *p_str = luaL_checklstring(L, 1, &size);
+
+       uint16_t retval = crc16_ccitt( (uint8_t*) p_str, size);
+       lua_pushinteger(L, (int) retval);
+       return 1;

 }
 
 }
 

+static int l_crc64(lua_State *L)
+{
+       size_t size;
+       uint64_t crc = 0; 
+       unsigned char outdata[8] = {0x00};
+
+       const char *p_str = luaL_checklstring(L, 1, &size);
+
+       crc64( (uint8_t*) p_str, size, &crc);
+
+       outdata[0] = (uint8_t)(crc >> 56) & 0xff;
+       outdata[1] = (uint8_t)(crc >> 48) & 0xff;
+       outdata[2] = (uint8_t)(crc >> 40) & 0xff;
+       outdata[3] = (uint8_t)(crc >> 32) & 0xff;
+       outdata[4] = (uint8_t)(crc >> 24) & 0xff;
+       outdata[5] = (uint8_t)(crc >> 16) & 0xff;
+       outdata[6] = (uint8_t)(crc >> 8) & 0xff;
+       outdata[7] = crc & 0xff;
+       lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
+       return 1;
+}
+
+static int l_sha1(lua_State *L)
+{
+       size_t size;
+       const char *p_str = luaL_checklstring(L, 1, &size);
+       unsigned char outdata[20] = {0x00};
+       mbedtls_sha1( (uint8_t*) p_str, size, outdata);
+       lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
+       return 1;
+}

 
 /**
  * @brief Sets the lua path to include "./lualibs/?.lua", in order for a script to be
 
 /**
  * @brief Sets the lua path to include "./lualibs/?.lua", in order for a script to be


@@ -159,54 +402,68 @@ static int l_CmdConsole(lua_State *L)
  */
 int setLuaPath( lua_State* L, const char* path )
 {
  */
 int setLuaPath( lua_State* L, const char* path )
 {

-    lua_getglobal( L, "package" );
-    lua_getfield( L, -1, "path" ); // get field "path" from table at top of stack (-1)
-    const char* cur_path = lua_tostring( L, -1 ); // grab path string from top of stack
-    int requiredLength = strlen(cur_path)+ strlen(path)+10; //A few bytes too many, whatever we can afford it
-    char * buf = malloc(requiredLength);
-    snprintf(buf, requiredLength, "%s;%s", cur_path, path);
-    lua_pop( L, 1 ); // get rid of the string on the stack we just pushed on line 5
-    lua_pushstring( L, buf ); // push the new one
-    lua_setfield( L, -2, "path" ); // set the field "path" in table at -2 with value at top of stack
-    lua_pop( L, 1 ); // get rid of package table from top of stack
-    return 0; // all done!
+       lua_getglobal( L, "package" );
+       lua_getfield( L, -1, "path" ); // get field "path" from table at top of stack (-1)
+       const char* cur_path = lua_tostring( L, -1 ); // grab path string from top of stack
+       int requiredLength = strlen(cur_path)+ strlen(path)+10; //A few bytes too many, whatever we can afford it
+       char * buf = malloc(requiredLength);
+       snprintf(buf, requiredLength, "%s;%s", cur_path, path);
+       lua_pop( L, 1 ); // get rid of the string on the stack we just pushed on line 5
+       lua_pushstring( L, buf ); // push the new one
+       lua_setfield( L, -2, "path" ); // set the field "path" in table at -2 with value at top of stack
+       lua_pop( L, 1 ); // get rid of package table from top of stack
+       free(buf);
+       return 0; // all done!

 }
 
 
 int set_pm3_libraries(lua_State *L)
 {
 
 }
 
 
 int set_pm3_libraries(lua_State *L)
 {
 

-    static const luaL_Reg libs[] = {
-        {"SendCommand",                 l_SendCommand},
-        {"WaitForResponseTimeout",      l_WaitForResponseTimeout},
-        //{"nonce2key",                   l_nonce2key},
-        //{"PrintAndLog",                 l_PrintAndLog},
-        {"foobar",                      l_foobar},
-        {"ukbhit",                      l_ukbhit},
-        {"clearCommandBuffer",          l_clearCommandBuffer},
-        {"console",                      l_CmdConsole},
-        {NULL, NULL}
-    };
-
-    lua_pushglobaltable(L);
-    // Core library is in this table. Contains '
-    //this is 'pm3' table
-    lua_newtable(L);
-
-    //Put the function into the hash table.
-    for (int i = 0; libs[i].name; i++) {
-        lua_pushcfunction(L, libs[i].func);
-        lua_setfield(L, -2, libs[i].name);//set the name, pop stack
-    }
-    //Name of 'core'
-    lua_setfield(L, -2, "core");
-
-    //-- remove the global environment table from the stack
-    lua_pop(L, 1);
-
-    //-- Last but not least, add to the LUA_PATH (package.path in lua)
-    // so we can load libraries from the ./lualib/ - directory
-    setLuaPath(L,"./lualibs/?.lua");
-
-    return 1;
+       static const luaL_Reg libs[] = {
+               {"SendCommand",                 l_SendCommand},
+               {"WaitForResponseTimeout",      l_WaitForResponseTimeout},
+               {"mfDarkside",                  l_mfDarkside},
+               //{"PrintAndLog",                 l_PrintAndLog},
+               {"foobar",                      l_foobar},
+               {"ukbhit",                      l_ukbhit},
+               {"clearCommandBuffer",          l_clearCommandBuffer},
+               {"console",                     l_CmdConsole},
+               {"iso15693_crc",                l_iso15693_crc},
+               {"iso14443b_crc",               l_iso14443b_crc},
+               {"aes128_decrypt",              l_aes128decrypt_cbc},
+               {"aes128_decrypt_ecb",          l_aes128decrypt_ecb},
+               {"aes128_encrypt",              l_aes128encrypt_cbc},
+               {"aes128_encrypt_ecb",          l_aes128encrypt_ecb},
+               {"crc16",                       l_crc16},
+               {"crc64",                       l_crc64},
+               {"sha1",                        l_sha1},
+               {NULL, NULL}
+       };
+
+       lua_pushglobaltable(L);
+       // Core library is in this table. Contains '
+       //this is 'pm3' table
+       lua_newtable(L);
+
+       //Put the function into the hash table.
+       for (int i = 0; libs[i].name; i++) {
+               lua_pushcfunction(L, libs[i].func);
+               lua_setfield(L, -2, libs[i].name);//set the name, pop stack
+       }
+       //Name of 'core'
+       lua_setfield(L, -2, "core");
+
+       //-- remove the global environment table from the stack
+       lua_pop(L, 1);
+
+       //-- Last but not least, add to the LUA_PATH (package.path in lua)
+       // so we can load libraries from the ./lualib/ - directory
+       char libraries_path[strlen(get_my_executable_directory()) + strlen(LUA_LIBRARIES_DIRECTORY) + strlen(LUA_LIBRARIES_WILDCARD) + 1];
+       strcpy(libraries_path, get_my_executable_directory());
+       strcat(libraries_path, LUA_LIBRARIES_DIRECTORY);
+       strcat(libraries_path, LUA_LIBRARIES_WILDCARD);
+       setLuaPath(L, libraries_path);
+
+       return 1;

 }
 }