[proxmark3-svn] / client / scripting.c

//-----------------------------------------------------------------------------
// Copyright (C) 2013 m h swende <martin at swende.se>
//
// This code is licensed to you under the terms of the GNU GPL, version 2 or,
// at your option, any later version. See the LICENSE.txt file for the text of
// the license.
//-----------------------------------------------------------------------------
// Some lua scripting glue to proxmark core.
//-----------------------------------------------------------------------------

#include <lua.h>
#include <lualib.h>
#include <lauxlib.h>
#include "proxmark3.h"
#include "usb_cmd.h"
#include "cmdmain.h"
#include "scripting.h"
#include "util.h"
#include "nonce2key/nonce2key.h"
#include "../common/iso15693tools.h"
#include "iso14443crc.h"
#include "../common/crc16.h"
#include "../common/crc64.h"
#include "../common/sha1.h"
#include "aes.h"
#include "cmdcrc.h"
/**
 * The following params expected:
 *  UsbCommand c
 *@brief l_SendCommand
 * @param L
 * @return
 */
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" , size, sizeof(UsbCommand));
        lua_pushstring(L,"Wrong data size");
        return 1;
    }

    SendCommand((UsbCommand* )data);
    return 0; // no return values
}
/**
 * @brief The following params expected:
 * uint32_t cmd
 * size_t ms_timeout
 * @param L
 * @return
 */
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 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_nonce2key(lua_State *L){

    size_t size;
    const char *p_uid = luaL_checklstring(L, 1, &size);
    if(size != 4)  return returnToLuaWithError(L,"Wrong size of uid, got %d bytes, expected 4", (int) size);

    const char *p_nt = luaL_checklstring(L, 2, &size);
    if(size != 4)  return returnToLuaWithError(L,"Wrong size of nt, got %d bytes, expected 4", (int) size);

    const char *p_nr = luaL_checklstring(L, 3, &size);
    if(size != 4)  return returnToLuaWithError(L,"Wrong size of nr, got %d bytes, expected 4", (int) size);

    const char *p_par_info = luaL_checklstring(L, 4, &size);
    if(size != 8)  return returnToLuaWithError(L,"Wrong size of par_info, got %d bytes, expected 8", (int) size);

    const char *p_pks_info = luaL_checklstring(L, 5, &size);
    if(size != 8)  return returnToLuaWithError(L,"Wrong size of ks_info, got %d bytes, expected 8", (int) size);


    uint32_t uid = bytes_to_num(( uint8_t *)p_uid,4);
    uint32_t nt = bytes_to_num(( uint8_t *)p_nt,4);

    uint32_t nr = bytes_to_num(( uint8_t*)p_nr,4);
    uint64_t par_info = bytes_to_num(( uint8_t *)p_par_info,8);
    uint64_t ks_info = bytes_to_num(( uint8_t *)p_pks_info,8);

    uint64_t key = 0;

    int retval = nonce2key(uid,nt, nr, par_info,ks_info, &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"llx"\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_clearCommandBuffer(lua_State *L){
    clearCommandBuffer();
    return 0;
}
/**
 * @brief l_foobar is a dummy function to test lua-integration with
 * @param L
 * @return
 */
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));

    // 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
 * @return boolean, true if kbhit, false otherwise.
 */
static int l_ukbhit(lua_State *L)
{
    lua_pushboolean(L,ukbhit() ? true : false);
    return 1;
}
/**
 * @brief Calls the command line parser to deal with the command. This enables
 * lua-scripts to do stuff like "core.console('hf mf mifare')"
 * @param L
 * @return
 */
static int l_CmdConsole(lua_State *L)
{
    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 (USB_CMD_DATA_SIZE < len)
		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]);
	}

    aes_context ctx;
    aes_init(&ctx);
	aes_setkey_dec(&ctx, aes_key, 128);
	aes_crypt_cbc(&ctx, 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]);
	}
    aes_context ctx;
    aes_init(&ctx);
	aes_setkey_dec(&ctx, aes_key, 128);
	aes_crypt_ecb(&ctx, 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]);
	}

    aes_context ctx;
    aes_init(&ctx);
	aes_setkey_enc(&ctx, aes_key, 128);
	aes_crypt_cbc(&ctx, 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]);
	}	
    aes_context ctx;
    aes_init(&ctx);
	aes_setkey_enc(&ctx, aes_key, 128);
	aes_crypt_ecb(&ctx, 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};                                                                                                                                                                     
    sha1( (uint8_t*) p_str, size, outdata);                                                                                                                                                                 
    lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
    return 1;	
}

static int l_reveng_models(lua_State *L){

	char *models[80];
	int count = 0;
	int in_width = luaL_checkinteger(L, 1);
	
	if( in_width > 89 ) return returnToLuaWithError(L,"Width cannot exceed 89, got %d", in_width);

	uint8_t width[80];
	width[0] = (uint8_t)in_width;
	int ans = GetModels(models, &count, width);
	if (!ans) return 0;
	
	lua_newtable(L);
	
	for (int i = 0; i < count; i++){
		lua_pushstring(L,  (const char*)models[i]);
		lua_rawseti(L,-2,i+1);
		free(models[i]);
	}

	return 1;
}

//Called with 4 parameters.
// inModel   ,string containing the crc model name: 'CRC-8'
// inHexStr  ,string containing the hex representation of the data that will be used for CRC calculations.
// reverse   ,int 0/1  (bool) if 1, calculate the reverse CRC
// endian    ,char,  'B','b','L','l','t','r' describing if Big-Endian or Little-Endian should be used in different combinations.
//
// outputs:  string with hex representation of the CRC result
static int l_reveng_RunModel(lua_State *L){
	//-c || -v
	//inModel = valid model name string - CRC-8
	//inHexStr = input hex string to calculate crc on
	//reverse = reverse calc option if true
	//endian = {0 = calc default endian input and output, b = big endian input and output, B = big endian output, r = right justified
	//          l = little endian input and output, L = little endian output only, t = left justified}
	//result = calculated crc hex string	
	char result[50];
	
	const char *inModel = luaL_checkstring(L, 1);
	const char *inHexStr = luaL_checkstring(L, 2);
    bool reverse =  lua_toboolean(L, 3);
	const char endian = luaL_checkstring(L, 4)[0];

	//PrintAndLog("mod: %s, hex: %s, rev %d", inModel, inHexStr, reverse);
	//    int RunModel(char *inModel, char *inHexStr, bool reverse, char endian, char *result)
	int ans = RunModel( (char *)inModel, (char *)inHexStr, reverse, endian, result);
	if (!ans) 	
		return returnToLuaWithError(L,"Reveng failed");

	lua_pushstring(L, (const char*)result); 
	return 1;
}

/**
 * @brief Sets the lua path to include "./lualibs/?.lua", in order for a script to be
 * able to do "require('foobar')" if foobar.lua is within lualibs folder.
 * Taken from http://stackoverflow.com/questions/4125971/setting-the-global-lua-path-variable-from-c-c
 * @param L
 * @param path
 * @return
 */
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
	free(buf);
	return 0; // all done!
}


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},
		{"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},
		{"reveng_models",				l_reveng_models},
		{"reveng_runmodel",				l_reveng_RunModel},
        {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;
}
Commit	Line	Data
5b760b6c	1	//-----------------------------------------------------------------------------
	2	// Copyright (C) 2013 m h swende <martin at swende.se>
	3	//
	4	// This code is licensed to you under the terms of the GNU GPL, version 2 or,
	5	// at your option, any later version. See the LICENSE.txt file for the text of
	6	// the license.
	7	//-----------------------------------------------------------------------------
	8	// Some lua scripting glue to proxmark core.
	9	//-----------------------------------------------------------------------------
	10
	11	#include <lua.h>
	12	#include <lualib.h>
	13	#include <lauxlib.h>
	14	#include "proxmark3.h"
	15	#include "usb_cmd.h"
	16	#include "cmdmain.h"
	17	#include "scripting.h"
44fffc54	18	#include "util.h"
2dcdf1a6	19	#include "nonce2key/nonce2key.h"
77cd612f	20	#include "../common/iso15693tools.h"
5de79e20	21	#include "iso14443crc.h"
47cbb2d4	22	#include "../common/crc16.h"
3ee8c808	23	#include "../common/crc64.h"
ea75b30c	24	#include "../common/sha1.h"
1f6417a9	25	#include "aes.h"
60e86577	26	#include "cmdcrc.h"
5b760b6c	27	/**
	28	* The following params expected:
	29	* UsbCommand c
	30	*@brief l_SendCommand
	31	* @param L
	32	* @return
	33	*/
	34	static int l_SendCommand(lua_State *L){
	35
	36	/*
	37	*
	38	The SendCommand (native) expects the following structure:
	39
	40	typedef struct {
	41	uint64_t cmd; //8 bytes
	42	uint64_t arg[3]; // 8*3 bytes = 24 bytes
	43	union {
	44	uint8_t asBytes[USB_CMD_DATA_SIZE]; // 1 byte * 512 = 512 bytes (OR)
	45	uint32_t asDwords[USB_CMD_DATA_SIZE/4]; // 4 byte * 128 = 512 bytes
	46	} d;
	47	} PACKED UsbCommand;
	48
	49	==> A 544 byte buffer will do.
	50	**/
	51	//Pop cmd
96e7a3a5	52	size_t size;
	53	const char *data = luaL_checklstring(L, 1, &size);
	54	if(size != sizeof(UsbCommand))
	55	{
5de79e20	56	printf("Got data size %d, expected %d" , size, sizeof(UsbCommand));
96e7a3a5	57	lua_pushstring(L,"Wrong data size");
	58	return 1;
	59	}
	60
42daa759	61	SendCommand((UsbCommand* )data);
44fffc54	62	return 0; // no return values
5b760b6c	63	}
	64	/**
	65	* @brief The following params expected:
	66	* uint32_t cmd
	67	* size_t ms_timeout
	68	* @param L
	69	* @return
	70	*/
	71	static int l_WaitForResponseTimeout(lua_State *L){
	72
44fffc54	73	uint32_t cmd = 0;
44fffc54	74	size_t ms_timeout = -1;
5b760b6c	75
44fffc54	76	//Check number of arguments
	77	int n = lua_gettop(L);
	78	if(n == 0)
5b760b6c	79	{
44fffc54	80	//signal error by returning Nil, errorstring
	81	lua_pushnil(L);
	82	lua_pushstring(L,"You need to supply at least command to wait for");
	83	return 2; // two return values
	84	}
	85	if(n >= 1)
	86	{
	87	//pop cmd
	88	cmd = luaL_checkunsigned(L,1);
	89	}
	90	if(n >= 2)
	91	{
	92	//Did the user send a timeout ?
	93	//Check if the current top of stack is an integer
5b760b6c	94	ms_timeout = luaL_checkunsigned(L,2);
44fffc54	95	//printf("Timeout set to %dms\n" , (int) ms_timeout);
5b760b6c	96	}
5b760b6c	97
44fffc54	98	UsbCommand response;
	99
	100	if(WaitForResponseTimeout(cmd, &response, ms_timeout))
5b760b6c	101	{
44fffc54	102	//Push it as a string
5de79e20	103	lua_pushlstring(L,(const char *)&response, sizeof(UsbCommand));
44fffc54	104
	105	return 1;// return 1 to signal one return value
	106	}else{
5b760b6c	107	//Push a Nil instead
5b760b6c	108	lua_pushnil(L);
44fffc54	109	return 1;// one return value
5b760b6c	110	}
5b760b6c	111	}
2dcdf1a6	112
	113	static int returnToLuaWithError(lua_State L, const char fmt, ...)
	114	{
	115	char buffer[200];
	116	va_list args;
	117	va_start(args,fmt);
	118	vsnprintf(buffer, sizeof(buffer), fmt,args);
	119	va_end(args);
	120
	121	lua_pushnil(L);
	122	lua_pushstring(L,buffer);
	123	return 2;
	124	}
	125
	126	static int l_nonce2key(lua_State *L){
	127
	128	size_t size;
	129	const char *p_uid = luaL_checklstring(L, 1, &size);
	130	if(size != 4) return returnToLuaWithError(L,"Wrong size of uid, got %d bytes, expected 4", (int) size);
	131
	132	const char *p_nt = luaL_checklstring(L, 2, &size);
	133	if(size != 4) return returnToLuaWithError(L,"Wrong size of nt, got %d bytes, expected 4", (int) size);
	134
	135	const char *p_nr = luaL_checklstring(L, 3, &size);
	136	if(size != 4) return returnToLuaWithError(L,"Wrong size of nr, got %d bytes, expected 4", (int) size);
	137
	138	const char *p_par_info = luaL_checklstring(L, 4, &size);
	139	if(size != 8) return returnToLuaWithError(L,"Wrong size of par_info, got %d bytes, expected 8", (int) size);
	140
	141	const char *p_pks_info = luaL_checklstring(L, 5, &size);
	142	if(size != 8) return returnToLuaWithError(L,"Wrong size of ks_info, got %d bytes, expected 8", (int) size);
	143
	144
	145	uint32_t uid = bytes_to_num(( uint8_t *)p_uid,4);
	146	uint32_t nt = bytes_to_num(( uint8_t *)p_nt,4);
	147
	148	uint32_t nr = bytes_to_num(( uint8_t*)p_nr,4);
	149	uint64_t par_info = bytes_to_num(( uint8_t *)p_par_info,8);
	150	uint64_t ks_info = bytes_to_num(( uint8_t *)p_pks_info,8);
	151
	152	uint64_t key = 0;
	153
	154	int retval = nonce2key(uid,nt, nr, par_info,ks_info, &key);
	155
	156	//Push the retval on the stack
	157	lua_pushinteger(L,retval);
2dcdf1a6	158
2dcdf1a6	159	//Push the key onto the stack
05f23c59	160	uint8_t dest_key[8];
05f23c59	161	num_to_bytes(key,sizeof(dest_key),dest_key);
b9697139	162
05f23c59	163	//printf("Pushing to lua stack: %012"llx"\n",key);
05f23c59	164	lua_pushlstring(L,(const char *) dest_key,sizeof(dest_key));
2dcdf1a6	165
	166	return 2; //Two return values
	167	}
42daa759	168	//static int l_PrintAndLog(lua_State *L){ return CmdHF14AMfDump(luaL_checkstring(L, 1));}
44fffc54	169	static int l_clearCommandBuffer(lua_State *L){
44fffc54	170	clearCommandBuffer();
42daa759	171	return 0;
44fffc54	172	}
	173	/**
	174	* @brief l_foobar is a dummy function to test lua-integration with
	175	* @param L
	176	* @return
	177	*/
	178	static int l_foobar(lua_State *L)
	179	{
	180	//Check number of arguments
	181	int n = lua_gettop(L);
	182	printf("foobar called with %d arguments" , n);
	183	lua_settop(L, 0);
	184	printf("Arguments discarded, stack now contains %d elements", lua_gettop(L));
bcf61bd3	185
05f23c59	186	// todo: this is not used, where was it intended for?
05f23c59	187	// UsbCommand response = {CMD_MIFARE_READBL, {1337, 1338, 1339}};
bcf61bd3	188
05f23c59	189	printf("Now returning a uint64_t as a string");
	190	uint64_t x = 0xDEADBEEF;
	191	uint8_t destination[8];
	192	num_to_bytes(x,sizeof(x),destination);
	193	lua_pushlstring(L,(const char *)&x,sizeof(x));
	194	lua_pushlstring(L,(const char *)destination,sizeof(destination));
	195
	196	return 2;
44fffc54	197	}
44fffc54	198
2dcdf1a6	199
44fffc54	200	/**
	201	* @brief Utility to check if a key has been pressed by the user. This method does not block.
	202	* @param L
	203	* @return boolean, true if kbhit, false otherwise.
	204	*/
	205	static int l_ukbhit(lua_State *L)
	206	{
	207	lua_pushboolean(L,ukbhit() ? true : false);
	208	return 1;
	209	}
0a85b725	210	/**
	211	* @brief Calls the command line parser to deal with the command. This enables
	212	* lua-scripts to do stuff like "core.console('hf mf mifare')"
	213	* @param L
	214	* @return
	215	*/
	216	static int l_CmdConsole(lua_State *L)
	217	{
	218	CommandReceived((char *)luaL_checkstring(L, 1));
	219	return 0;
	220	}
	221
77cd612f	222	static int l_iso15693_crc(lua_State *L)
	223	{
	224	// uint16_t Iso15693Crc(uint8_t *v, int n);
	225	size_t size;
	226	const char *v = luaL_checklstring(L, 1, &size);
	227	uint16_t retval = Iso15693Crc((uint8_t *) v, size);
	228	lua_pushinteger(L, (int) retval);
	229	return 1;
	230	}
5b760b6c	231
5de79e20	232	static int l_iso14443b_crc(lua_State *L)
	233	{
	234	/* void ComputeCrc14443(int CrcType,
	235	const unsigned char *Data, int Length,
	236	unsigned char *TransmitFirst,
	237	unsigned char *TransmitSecond)
	238	*/
	239	unsigned char buf[USB_CMD_DATA_SIZE];
	240	size_t len = 0;
	241	const char *data = luaL_checklstring(L, 1, &len);
	242	if (USB_CMD_DATA_SIZE < len)
	243	len = USB_CMD_DATA_SIZE-2;
	244
	245	for (int i = 0; i < len; i += 2) {
	246	sscanf(&data[i], "%02x", (unsigned int *)&buf[i / 2]);
	247	}
	248	ComputeCrc14443(CRC_14443_B, buf, len, &buf[len], &buf[len+1]);
	249
	250	lua_pushlstring(L, (const char *)&buf, len+2);
	251	return 1;
	252	}
	253
c15d2bdc	254	/*
	255	Simple AES 128 cbc hook up to OpenSSL.
	256	params: key, input
	257	*/
b18948fd	258	static int l_aes128decrypt_cbc(lua_State *L)
c15d2bdc	259	{
	260	//Check number of arguments
	261	int i;
	262	size_t size;
	263	const char *p_key = luaL_checklstring(L, 1, &size);
	264	if(size != 32) return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
	265
	266	const char *p_encTxt = luaL_checklstring(L, 2, &size);
b915fda3	267
1f6417a9 MHS	268	unsigned char indata[16] = {0x00};
	269	unsigned char outdata[16] = {0x00};
	270	unsigned char aes_key[16] = {0x00};
	271	unsigned char iv[16] = {0x00};
d87779d6	272
d730878d	273	// convert key to bytearray and convert input to bytearray
c15d2bdc	274	for (i = 0; i < 32; i += 2) {
c15d2bdc	275	sscanf(&p_encTxt[i], "%02x", (unsigned int *)&indata[i / 2]);
d87779d6	276	sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
c15d2bdc	277	}
d87779d6	278
	279	aes_context ctx;
	280	aes_init(&ctx);
d87779d6	281	aes_setkey_dec(&ctx, aes_key, 128);
	282	aes_crypt_cbc(&ctx, AES_DECRYPT, sizeof(indata), iv, indata, outdata );
	283	//Push decrypted array as a string
	284	lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
	285	return 1;// return 1 to signal one return value
	286	}
b18948fd	287	static int l_aes128decrypt_ecb(lua_State *L)
	288	{
	289	//Check number of arguments
	290	int i;
	291	size_t size;
	292	const char *p_key = luaL_checklstring(L, 1, &size);
	293	if(size != 32) return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
	294
	295	const char *p_encTxt = luaL_checklstring(L, 2, &size);
	296
	297	unsigned char indata[16] = {0x00};
	298	unsigned char outdata[16] = {0x00};
	299	unsigned char aes_key[16] = {0x00};
	300
	301	// convert key to bytearray and convert input to bytearray
	302	for (i = 0; i < 32; i += 2) {
	303	sscanf(&p_encTxt[i], "%02x", (unsigned int *)&indata[i / 2]);
	304	sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
	305	}
	306	aes_context ctx;
	307	aes_init(&ctx);
	308	aes_setkey_dec(&ctx, aes_key, 128);
	309	aes_crypt_ecb(&ctx, AES_DECRYPT, indata, outdata );
	310
	311	//Push decrypted array as a string
	312	lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
	313	return 1;// return 1 to signal one return value
	314	}
	315
	316	static int l_aes128encrypt_cbc(lua_State *L)
d87779d6	317	{
	318	//Check number of arguments
	319	int i;
	320	size_t size;
	321	const char *p_key = luaL_checklstring(L, 1, &size);
	322	if(size != 32) return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
	323
	324	const char *p_txt = luaL_checklstring(L, 2, &size);
	325
	326	unsigned char indata[16] = {0x00};
	327	unsigned char outdata[16] = {0x00};
	328	unsigned char aes_key[16] = {0x00};
	329	unsigned char iv[16] = {0x00};
c15d2bdc	330
c15d2bdc	331	for (i = 0; i < 32; i += 2) {
d87779d6	332	sscanf(&p_txt[i], "%02x", (unsigned int *)&indata[i / 2]);
c15d2bdc	333	sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
c15d2bdc	334	}
1f6417a9 MHS	335
	336	aes_context ctx;
	337	aes_init(&ctx);
d730878d	338	aes_setkey_enc(&ctx, aes_key, 128);
d87779d6	339	aes_crypt_cbc(&ctx, AES_ENCRYPT, sizeof(indata), iv, indata, outdata );
d730878d	340	//Push encrypted array as a string
c15d2bdc	341	lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
	342	return 1;// return 1 to signal one return value
	343	}
	344
b18948fd	345	static int l_aes128encrypt_ecb(lua_State *L)
	346	{
	347	//Check number of arguments
	348	int i;
	349	size_t size;
	350	const char *p_key = luaL_checklstring(L, 1, &size);
	351	if(size != 32) return returnToLuaWithError(L,"Wrong size of key, got %d bytes, expected 32", (int) size);
	352
	353	const char *p_txt = luaL_checklstring(L, 2, &size);
	354
	355	unsigned char indata[16] = {0x00};
	356	unsigned char outdata[16] = {0x00};
	357	unsigned char aes_key[16] = {0x00};
	358
	359	for (i = 0; i < 32; i += 2) {
	360	sscanf(&p_txt[i], "%02x", (unsigned int *)&indata[i / 2]);
	361	sscanf(&p_key[i], "%02x", (unsigned int *)&aes_key[i / 2]);
	362	}
	363	aes_context ctx;
	364	aes_init(&ctx);
	365	aes_setkey_enc(&ctx, aes_key, 128);
	366	aes_crypt_ecb(&ctx, AES_ENCRYPT, indata, outdata );
	367	//Push encrypted array as a string
	368	lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
	369	return 1;// return 1 to signal one return value
	370	}
	371
47cbb2d4	372	static int l_crc16(lua_State *L)
	373	{
	374	size_t size;
	375	const char *p_str = luaL_checklstring(L, 1, &size);
d730878d	376
06b58a94	377	uint16_t retval = crc16_ccitt( (uint8_t*) p_str, size);
47cbb2d4	378	lua_pushinteger(L, (int) retval);
	379	return 1;
	380	}
	381
3ee8c808	382	static int l_crc64(lua_State *L)
	383	{
	384	size_t size;
	385	uint64_t crc = 0;
	386	unsigned char outdata[8] = {0x00};
	387
	388	const char *p_str = luaL_checklstring(L, 1, &size);
d730878d	389
3ee8c808	390	crc64( (uint8_t*) p_str, size, &crc);
	391
	392	outdata[0] = (uint8_t)(crc >> 56) & 0xff;
	393	outdata[1] = (uint8_t)(crc >> 48) & 0xff;
	394	outdata[2] = (uint8_t)(crc >> 40) & 0xff;
	395	outdata[3] = (uint8_t)(crc >> 32) & 0xff;
	396	outdata[4] = (uint8_t)(crc >> 24) & 0xff;
	397	outdata[5] = (uint8_t)(crc >> 16) & 0xff;
	398	outdata[6] = (uint8_t)(crc >> 8) & 0xff;
	399	outdata[7] = crc & 0xff;
	400	lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
d730878d	401	return 1;
3ee8c808	402	}
3ee8c808	403
2d2f7d19	404	static int l_sha1(lua_State *L)
2d2f7d19	405	{
ea75b30c	406	size_t size;
	407	const char *p_str = luaL_checklstring(L, 1, &size);
	408	unsigned char outdata[20] = {0x00};
	409	sha1( (uint8_t*) p_str, size, outdata);
	410	lua_pushlstring(L,(const char *)&outdata, sizeof(outdata));
	411	return 1;
	412	}
	413
60e86577	414	static int l_reveng_models(lua_State *L){
	415
	416	char *models[80];
	417	int count = 0;
dd1df490	418	int in_width = luaL_checkinteger(L, 1);
60e86577	419
	420	if( in_width > 89 ) return returnToLuaWithError(L,"Width cannot exceed 89, got %d", in_width);
	421
99789601	422	uint8_t width[80];
	423	width[0] = (uint8_t)in_width;
	424	int ans = GetModels(models, &count, width);
	425	if (!ans) return 0;
60e86577	426
	427	lua_newtable(L);
	428
	429	for (int i = 0; i < count; i++){
	430	lua_pushstring(L, (const char*)models[i]);
	431	lua_rawseti(L,-2,i+1);
	432	free(models[i]);
	433	}
	434
	435	return 1;
	436	}
	437
dd1df490	438	//Called with 4 parameters.
	439	// inModel ,string containing the crc model name: 'CRC-8'
	440	// inHexStr ,string containing the hex representation of the data that will be used for CRC calculations.
	441	// reverse ,int 0/1 (bool) if 1, calculate the reverse CRC
	442	// endian ,char, 'B','b','L','l','t','r' describing if Big-Endian or Little-Endian should be used in different combinations.
	443	//
	444	// outputs: string with hex representation of the CRC result
60e86577	445	static int l_reveng_RunModel(lua_State *L){
	446	//-c \|\| -v
	447	//inModel = valid model name string - CRC-8
	448	//inHexStr = input hex string to calculate crc on
	449	//reverse = reverse calc option if true
	450	//endian = {0 = calc default endian input and output, b = big endian input and output, B = big endian output, r = right justified
	451	// l = little endian input and output, L = little endian output only, t = left justified}
	452	//result = calculated crc hex string
	453	char result[50];
	454
dd1df490	455	const char *inModel = luaL_checkstring(L, 1);
	456	const char *inHexStr = luaL_checkstring(L, 2);
	457	bool reverse = lua_toboolean(L, 3);
	458	const char endian = luaL_checkstring(L, 4)[0];
60e86577	459
60e86577	460	//PrintAndLog("mod: %s, hex: %s, rev %d", inModel, inHexStr, reverse);
dd1df490	461	// int RunModel(char inModel, char inHexStr, bool reverse, char endian, char *result)
dd1df490	462	int ans = RunModel( (char )inModel, (char )inHexStr, reverse, endian, result);
60e86577	463	if (!ans)
	464	return returnToLuaWithError(L,"Reveng failed");
	465
	466	lua_pushstring(L, (const char*)result);
	467	return 1;
	468	}
	469
686f0a17	470	/**
	471	* @brief Sets the lua path to include "./lualibs/?.lua", in order for a script to be
	472	* able to do "require('foobar')" if foobar.lua is within lualibs folder.
	473	* Taken from http://stackoverflow.com/questions/4125971/setting-the-global-lua-path-variable-from-c-c
	474	* @param L
	475	* @param path
	476	* @return
	477	*/
	478	int setLuaPath( lua_State* L, const char* path )
	479	{
	480	lua_getglobal( L, "package" );
	481	lua_getfield( L, -1, "path" ); // get field "path" from table at top of stack (-1)
	482	const char* cur_path = lua_tostring( L, -1 ); // grab path string from top of stack
	483	int requiredLength = strlen(cur_path)+ strlen(path)+10; //A few bytes too many, whatever we can afford it
	484	char * buf = malloc(requiredLength);
	485	snprintf(buf, requiredLength, "%s;%s", cur_path, path);
	486	lua_pop( L, 1 ); // get rid of the string on the stack we just pushed on line 5
	487	lua_pushstring( L, buf ); // push the new one
	488	lua_setfield( L, -2, "path" ); // set the field "path" in table at -2 with value at top of stack
	489	lua_pop( L, 1 ); // get rid of package table from top of stack
d730878d	490	free(buf);
664bb5ae	491	return 0; // all done!
686f0a17	492	}
	493
	494
f057bddb	495	int set_pm3_libraries(lua_State *L)
5b760b6c	496	{
686f0a17	497
5b760b6c	498	static const luaL_Reg libs[] = {
	499	{"SendCommand", l_SendCommand},
	500	{"WaitForResponseTimeout", l_WaitForResponseTimeout},
2dcdf1a6	501	{"nonce2key", l_nonce2key},
42daa759	502	//{"PrintAndLog", l_PrintAndLog},
44fffc54	503	{"foobar", l_foobar},
	504	{"ukbhit", l_ukbhit},
	505	{"clearCommandBuffer", l_clearCommandBuffer},
d730878d	506	{"console", l_CmdConsole},
d730878d	507	{"iso15693_crc", l_iso15693_crc},
5de79e20	508	{"iso14443b_crc", l_iso14443b_crc},
b18948fd	509	{"aes128_decrypt", l_aes128decrypt_cbc},
	510	{"aes128_decrypt_ecb", l_aes128decrypt_ecb},
	511	{"aes128_encrypt", l_aes128encrypt_cbc},
	512	{"aes128_encrypt_ecb", l_aes128encrypt_ecb},
47cbb2d4	513	{"crc16", l_crc16},
d730878d	514	{"crc64", l_crc64},
ea75b30c	515	{"sha1", l_sha1},
60e86577	516	{"reveng_models", l_reveng_models},
60e86577	517	{"reveng_runmodel", l_reveng_RunModel},
5b760b6c	518	{NULL, NULL}
	519	};
	520
	521	lua_pushglobaltable(L);
	522	// Core library is in this table. Contains '
	523	//this is 'pm3' table
	524	lua_newtable(L);
	525
	526	//Put the function into the hash table.
	527	for (int i = 0; libs[i].name; i++) {
	528	lua_pushcfunction(L, libs[i].func);
	529	lua_setfield(L, -2, libs[i].name);//set the name, pop stack
	530	}
	531	//Name of 'core'
	532	lua_setfield(L, -2, "core");
	533
	534	//-- remove the global environment table from the stack
	535	lua_pop(L, 1);
686f0a17	536
	537	//-- Last but not least, add to the LUA_PATH (package.path in lua)
	538	// so we can load libraries from the ./lualib/ - directory
	539	setLuaPath(L,"./lualibs/?.lua");
	540
5b760b6c	541	return 1;
5b760b6c	542	}