diff options
Diffstat (limited to 'openpcd/opcd_test/opcd_sh.c')
| -rw-r--r-- | openpcd/opcd_test/opcd_sh.c | 495 |
1 files changed, 0 insertions, 495 deletions
diff --git a/openpcd/opcd_test/opcd_sh.c b/openpcd/opcd_test/opcd_sh.c deleted file mode 100644 index c9b38b4..0000000 --- a/openpcd/opcd_test/opcd_sh.c +++ /dev/null @@ -1,495 +0,0 @@ -#include <stdio.h> -#include <stdlib.h> -#include <string.h> -#include <ctype.h> -#include <limits.h> - -#include "zebvty/vty.h" -#include "zebvty/command.h" - -#define MAX_BUFFER_SIZE 2048 -#define MAX_LENC MAX_BUFFER_SIZE -#define MAX_LENR MAX_LENC -#define MAX_COMMAND_SIZE 2048 - -static void strcompact(char *str) -{ - int i, j = 0; - - for (i = 0; i < strlen(str); i++) { - if (!isspace(str[i])) - str[j++] = tolower(str[i]); - } - str[j] = 0; -} - -static int strtobin(char *s, unsigned char *d, unsigned int *len) -{ - long l; - int i, ret; - - if (*s == ':') - s++; - - for (i = 0; i < (strlen(s) >> 1); i++) { - if (i >= MAX_LENC || i >> *len) - return 0; - ret = sscanf(s + (i << 1), "%2lx", &l); - if (ret != 1) - return 0; - d[i] = l & 0xff; - } - *len = i; - - return 1; -} - -DEFUN(rc632_reg_read, - rc632_reg_read_cmd, - "reg_read WORD", - "Read register of RC632\n") -{ -#if 0 - if (send_hex_command(vty, argv[0]) < 0) - return CMD_ERR_NO_MATCH; -#endif - return CMD_SUCCESS; -} - - -#if 0 -static int select_file(struct vty *v, int absolute, int path, - char *selector, unsigned int sellen, - unsigned char *rsp, unsigned int *rlen) -{ - unsigned char cmd[MAX_LENC]; - - cmd[0] = 0x00; - cmd[1] = 0xa4; - if (absolute) { - if (path) - cmd[2] = 0x08; - else - cmd[2] = 0x00; - } else { - if (path) - cmd[2] = 0x09; - else - cmd[2] = 0x02; - } - cmd[3] = 0x00; // FIXME: other templates - - cmd[4] = sellen & 0xff; - - memcpy(cmd[5], selector, sellen); - cmd[5+sellen] = 0x00; - - send_apdu(hCard, v, cmd, 5+cmd[4], rsp, rlen); - parse_selectfile_response(hCard, v, rsp, *rlen); - return CMD_SUCCESS; - -} - -DEFUN(send_7816_select_file_absolute_fid, - send_7816_select_file_absolute_fid_cmd, - "select file absolute fid WORD", - "Selects a file on the ICC\n") -{ - char *file = argv[0]; - unsigned char rsp[MAX_LENR]; - unsigned int lenr = MAX_LENR; - unsigned char selector[255]; - unsigned int sellen = 255; - - if (strtobin(file, selector, &sellen) < 0) - return CMD_ERR_NO_MATCH; - - return select_file(vty, 1, 0, selector, sellen, rsp, &lenr); -} - -DEFUN(send_7816_select_file_absolute_path, - send_7816_select_file_absolute_path_cmd, - "select file absolute path WORD", - "Selects a file on the ICC\n") -{ - char *file = argv[0]; - unsigned char rsp[MAX_LENR]; - unsigned int lenr = MAX_LENR; - unsigned char selector[255]; - unsigned int sellen = 255; - - if (strtobin(file, selector, &sellen) < 0) - return CMD_ERR_NO_MATCH; - - - return select_file(vty, 1, 1, selector, sellen, rsp, &lenr); -} - -DEFUN(send_7816_select_file_relative_fid, - send_7816_select_file_relative_fid_cmd, - "select file absolute fid WORD", - "Selects a file on the ICC\n") -{ - char *file = argv[0]; - unsigned char rsp[MAX_LENR]; - unsigned int lenr = MAX_LENR; - unsigned char selector[255]; - unsigned int sellen = 255; - - if (strtobin(file, selector, &sellen) < 0) - return CMD_ERR_NO_MATCH; - - - return select_file(vty, 0, 0, selector, sellen, rsp, &lenr); -} - - -DEFUN(send_7816_select_file_relative_path, - send_7816_select_file_relative_path_cmd, - "select file relative path WORD", - "Selects a file on the ICC\n") -{ - char *file = argv[0]; - unsigned char rsp[MAX_LENR]; - unsigned int lenr = MAX_LENR; - unsigned char selector[255]; - unsigned int sellen = 255; - - if (strtobin(file, selector, &sellen) < 0) - return CMD_ERR_NO_MATCH; - - - return select_file(vty, 0, 1, selector, sellen, rsp, &lenr); -} - -DEFUN(send_7816_select_dir, - send_7816_select_dir_cmd, - "select directory (MF|PARENT|CHILD) (FID|AID)", - "Selects a directory on the ICC\n") -{ - char *file = argv[1]; - char *type = argv[0]; - char cmd[22]; - char rsp[MAX_LENR]; - int len, lenr = MAX_LENR; - int empty = 0; - - if (!type) - return CMD_ERR_NO_MATCH; - - memset(cmd, 0, sizeof(cmd)); - cmd[1] = 0xa4; - - if (!strcmp(type, "MF")) { - cmd[2] = 0x00; - cmd[3] = 0x00; - cmd[4] = 2; /* length */ - cmd[5] = 0x3f; /* 3ff0 */ - cmd[6] = 0xf0; - empty = 1; - } else if (!strcmp(type, "PARENT")) { - cmd[2] = 0x03; - cmd[3] = 0x00; - cmd[4] = 0x00; - empty = 1; - } else if (!strcmp(file, "CHILD")) { - cmd[2] = 0x01; - cmd[3] = 0x00; - } else { - cmd[2] = 0x00; - cmd[3] = 0x00; - } - - if (!empty) { - len = 16; - /* convert hex string of identifier to bytecode */ - strtobin(file, &cmd[5], &len); - cmd[4] = len & 0xff; - } - send_apdu(hCard, vty, cmd, 5+cmd[4], rsp, &lenr); - parse_selectfile_response(hCard, vty, rsp, lenr); - return CMD_SUCCESS; -} - -DEFUN(send_7816_ls, - send_7816_ls_cmd, - "ls", - "Tries to list all files on a 7816-4 compliant ICC\n") -{ - return CMD_SUCCESS; -} - -DEFUN(send_7816_tree, - send_7816_tree_cmd, - "tree", - "Tries to list a full DF hiararchy tree on a 7816-4 compliant ICC\n") -{ - - return CMD_SUCCESS; -} - -DEFUN(send_7816_read_binary, - send_7816_read_binary_cmd, - "read binary OFFSET LENGTH", - "Read bytes form a previously selected EF\n") -{ - unsigned char cmd[] = { 0x00, 0xb0, 0x00, 0x00, 0x00 }; - unsigned char rsp[MAX_LENR]; // FIXME - unsigned int lenr = MAX_LENR; - - unsigned long datalen; - unsigned long offset; - - offset = strtoul(argv[0], NULL, 0); - if (offset == ULONG_MAX || offset > 0xffff) - return CMD_ERR_NO_MATCH; - - datalen = strtoul(argv[1], NULL, 0); - if (datalen == ULONG_MAX || datalen > 0xff) - return CMD_ERR_NO_MATCH; - - cmd[2] = (offset >> 8) & 0xff; - cmd[3] = offset & 0xff; - cmd[4] = datalen & 0xff; - - send_apdu(hCard, vty, cmd, 5+cmd[4], rsp, &lenr); - if (lenr < 2) - return CMD_SUCCESS; // FIXME - - parse_sw(vty, rsp[lenr-2], rsp[lenr-1]); - - return CMD_SUCCESS; -} - -DEFUN(send_7816_write_binary, - send_7816_write_binary_cmd, - "write binary OFFSET LENGTH DATA", - "Write bytes to a previously selected EF\n") -{ - unsigned char cmd[MAX_LENC]; - unsigned char rsp[MAX_LENR]; - unsigned int lenr; - - unsigned long datalen; - unsigned long offset; - - offset = strtoul(argv[0], NULL, 0); - if (offset == ULONG_MAX || offset > 0xffff) - return CMD_ERR_NO_MATCH; - - datalen = strtoul(argv[1], NULL, 0); - if (datalen == ULONG_MAX || datalen > 0xff) - return CMD_ERR_NO_MATCH; - - memset(cmd, 0, sizeof(cmd)); - - cmd[1] = 0xd0; - cmd[2] = (offset >> 8) & 0xff; - cmd[3] = offset & 0xff; - - if (!strtobin(argv[2], cmd+5, &datalen)) { - vty_out(vty, "command decoding error%s", vty_newline(vty)); - return -1; - } - - cmd[4] = datalen & 0xff; - - send_apdu(hCard, vty, cmd, 5+cmd[4], rsp, &lenr); - if (lenr < 2) - return CMD_SUCCESS; // FIXME - - parse_sw(vty, rsp[lenr-2], rsp[lenr-1]); - - return CMD_SUCCESS; - - return CMD_SUCCESS; -} - -DEFUN(send_7816_update_binary, - send_7816_update_binary_cmd, - "update binary OFFSET LENGTH DATA", - "Update bytes of a previously selected EF\n") -{ - unsigned char cmd[MAX_LENC]; - unsigned char rsp[MAX_LENR]; - unsigned int lenr; - - unsigned long datalen; - unsigned long offset; - - offset = strtoul(argv[0], NULL, 0); - if (offset == ULONG_MAX || offset > 0xffff) - return CMD_ERR_NO_MATCH; - - datalen = strtoul(argv[1], NULL, 0); - if (datalen == ULONG_MAX || datalen > 0xff) - return CMD_ERR_NO_MATCH; - - memset(cmd, 0, sizeof(cmd)); - - cmd[1] = 0xd6; - cmd[2] = (offset >> 8) & 0xff; - cmd[3] = offset & 0xff; - - if (!strtobin(argv[2], cmd+5, &datalen)) { - vty_out(vty, "command decoding error%s", vty_newline(vty)); - return -1; - } - - cmd[4] = datalen & 0xff; - - send_apdu(hCard, vty, cmd, 5+cmd[4], rsp, &lenr); - if (lenr < 2) - return CMD_SUCCESS; // FIXME - - parse_sw(vty, rsp[lenr-2], rsp[lenr-1]); - - return CMD_SUCCESS; -} - -DEFUN(send_7816_erase_binary, - send_7816_erase_binary_cmd, - "erase binary OFFSET LENGTH", - "Erase bytes of a previously selected EF\n") -{ - unsigned char cmd[8] = { 0x00, 0x0e, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00 }; - unsigned char rsp[MAX_LENR]; - unsigned int lenr; - - unsigned long datalen; - unsigned long offset; - - offset = strtoul(argv[0], NULL, 0); - if (offset == ULONG_MAX || offset > 0xffff) - return CMD_ERR_NO_MATCH; - - datalen = strtoul(argv[1], NULL, 0); - if (datalen == ULONG_MAX || (offset+datalen > 0xffff)) - return CMD_ERR_NO_MATCH; - - cmd[2] = (offset >> 8) & 0xff; - cmd[3] = offset & 0xff; - cmd[4] = 0x02; - cmd[5] = ((offset+datalen) >> 8) & 0xff; - cmd[6] = (offset+datalen) & 0xff; - - send_apdu(hCard, vty, cmd, 5+cmd[4], rsp, &lenr); - if (lenr < 2) - return CMD_SUCCESS; // FIXME - - parse_sw(vty, rsp[lenr-2], rsp[lenr-1]); - - return CMD_SUCCESS; -} - -DEFUN(send_7816_get_response, - send_7816_get_response_cmd, - "get response LENGTH", - "Get more data from the ICC\n") -{ - unsigned char cmd[6] = { 0x00, 0xc0, 0x00, 0x00, 0x00, 0x00 }; - unsigned char rsp[MAX_LENR]; - unsigned int lenr = MAX_LENR; - - unsigned long length; - - length = strtoul(argv[0], NULL, 0); - if (length == ULONG_MAX || length > 0xff) - return CMD_ERR_NO_MATCH; - - cmd[5] = length & 0xff; - - send_apdu(hCard, vty, cmd, 6, rsp, &lenr); - if (lenr < 2) - return CMD_SUCCESS; // FIXME - - parse_sw(vty, rsp[lenr-2], rsp[lenr-1]); - - return CMD_SUCCESS; - -} -#endif - -DEFUN(rc632, - rc632_cmd, - "rc632", "Commands related to low-level RC632 access\n") -{ - vty->node = RC632_NODE; - return CMD_SUCCESS; -} - -/* dummy */ -static int send_config_write(struct vty *v) -{ - return CMD_SUCCESS; -} - -struct cmd_node rc632_node = { - RC632_NODE, - "%s(rc632)# ", - 1, -}; - -static int opcdshell_init() -{ - cmd_init(1); - vty_init(); - - install_node(&rc632_node, send_config_write); - - install_element(RC632_NODE, &rc632_reg_read_cmd); - -#if 0 - install_element(RC632_NODE, &send_7816_select_file_absolute_fid_cmd); - install_element(RC632_NODE, &send_7816_select_file_absolute_path_cmd); - install_element(RC632_NODE, &send_7816_select_file_relative_fid_cmd); - install_element(RC632_NODE, &send_7816_select_file_relative_path_cmd); - - install_element(RC632_NODE, &send_7816_select_dir_cmd); - install_element(RC632_NODE, &send_7816_ls_cmd); - install_element(RC632_NODE, &send_7816_tree_cmd); - - install_element(RC632_NODE, &send_7816_read_binary_cmd); - install_element(RC632_NODE, &send_7816_write_binary_cmd); - install_element(RC632_NODE, &send_7816_update_binary_cmd); - install_element(RC632_NODE, &send_7816_erase_binary_cmd); - - install_element(RC632_NODE, &send_7816_get_response_cmd); -#endif - - install_default(RC632_NODE); - - install_element(VIEW_NODE, &rc632_cmd); - - return 0; -} - -static int opcdshell(void) -{ - struct vty *v; - - v = vty_create(0); - if (!v) - return -1; - while (1) { - vty_read(v); - } - return 0; -} - - -/*********************************************************************** - * main program, copied from pcsc-lite 'testpcsc.c' - ***********************************************************************/ - -int main(int argc, char **argv) -{ - opcdshell_init(); - - printf("\nopcd_shell (C) 2006 Harald Welte <hwelte@hmw-consulting.de>\n\n"); - - opcdshell(); - - return 0; -} |