cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfawid26.c

   1 //-----------------------------------------------------------------------------
   2 //
   3 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
   4 // at your option, any later version. See the LICENSE.txt file for the text of
   5 // the license.
   6 //-----------------------------------------------------------------------------
   7 // Low frequency AWID26 commands
   8 //-----------------------------------------------------------------------------
   9
  10 #include <stdio.h>
  11 #include <string.h>
  12 #include <inttypes.h>
  13 #include <stdbool.h>
  14 #include "proxmark3.h"
  15 #include "ui.h"
  16 //#include "graph.h"
  17 #include "cmdmain.h"
  18 #include "cmdparser.h"
  19 //#include "cmddata.h"
  20 #include "cmdlf.h"
  21 #include "cmdlfawid26.h"
  22 #include "util.h"
  23 //#include "data.h"
  24
  25
  26 static int CmdHelp(const char *Cmd);
  27
  28 int CmdClone(const char *Cmd)
  29 {
  30         char cmdp = param_getchar(Cmd, 0);
  31
  32         if (strlen(Cmd) < 1 || cmdp == 'h' || cmdp == 'H') {
  33                 PrintAndLog("Usage:  lf awid26 clone  <facility> <id>");
  34                 PrintAndLog("     [], ");
  35                 PrintAndLog("");
  36                 PrintAndLog("     sample: lf awid26 clone 15 2233");
  37                 return 0;
  38         }
  39
  40         //sscanf(Cmd, "%d %d", &facilitycode, &cardno);
  41
  42         // char block0 = "00107060";
  43         // char block1 = "00107060";
  44         // char block2 = "00107060";
  45         // char block3 = "00107060";
  46
  47         unsigned char buf[10] = {0x00};
  48         unsigned char *resp = buf;
  49
  50
  51         awid26_hex_to_uid(resp, "");
  52         // PrintAndLog("Writing block %d with data %08X", Block, Data);
  53         return 0;
  54 }
  55
  56
  57 // convert 96 bit AWID FSK data to 8 digit BCD UID
  58 bool awid26_hex_to_uid(unsigned char *response, char *awid26)
  59 {
  60         uint8_t i, tmp[96], tmp1[7];
  61     int site;
  62     int id;
  63
  64     if(!hextobinarray(tmp, awid26))
  65         return false;
  66
  67     // // data is in blocks of 4 bits - every 4th bit is parity, except the first
  68     // // block which is all zeros
  69     // for(i= 0 ; i < 4 ; ++i)
  70         // if(tmp[i] != 0x00)
  71             // return false;
  72
  73     // // discard 1st block
  74     // memcpy(tmp, tmp + 4, 92);
  75
  76     // // check and strip parity on the rest
  77     // for(i= 1 ; i < 23 ; ++i)
  78         // if(tmp[(i * 4) - 1] != GetParity(tmp + (i - 1) * 4, ODD, 3))
  79             // return false;
  80         // else
  81             // memcpy((tmp + (i - 1) * 3), tmp + (i - 1) * 4, 3);
  82
  83     // // discard the rest of the header - 1 more 3 bit block
  84     // memcpy(tmp, tmp + 3, 66);
  85
  86     // // next 8 bits is data length - should be 26: 0x1A
  87     // binarraytohex(tmp1, tmp, 8);
  88     // if(strcmp(tmp1, "1A") != 0)
  89         // return false;
  90     // memcpy(tmp, tmp +8, 58);
  91
  92     // // standard wiegand parity check - even for 1st 12 bits, odd for 2nd 12
  93     // if(tmp[0] != GetParity(tmp + 1, EVEN, 12))
  94         // return false;
  95     // if(tmp[25] != GetParity(tmp + 13, ODD, 12))
  96         // return false;
  97
  98     // // convert to hex, ignoring parity bits
  99     // if(!binarraytohex(tmp1, tmp + 1, 24))
 100         // return false;
 101
 102     // // convert hex to site/id
 103     // sscanf(tmp1,"%2X%4X", &site, &id);
 104
 105     // // final output 8 byte BCD
 106     // sprintf(response,"%03d%05d", site, id);
 107
 108     return true;
 109 }
 110
 111 // convert null-terminated BCD UID (8 digits) to 96 bit awid26 encoded binary array
 112 bool bcd_to_awid26_bin(unsigned char *awid26, unsigned char *bcd)
 113 {
 114     // char i, p, tmp1[8], tmp2[26];
 115     // int tmpint;
 116
 117     // if(strlen(bcd) != 8)
 118         // return false;
 119
 120     // // convert BCD site code to HEX
 121     // sscanf(bcd, "%03d", &tmpint);
 122     // sprintf(tmp2, "%02x", tmpint);
 123     // memcpy(tmp1, tmp2, 2);
 124
 125     // // convert BCD ID to HEX
 126     // sscanf(bcd + 3, "%05d", &tmpint);;
 127     // sprintf(tmp2, "%04x", tmpint);
 128
 129     // // copy with trailing NULL
 130     // memcpy(tmp1 + 2, tmp2, 5);
 131
 132     // // convert full HEX to binary, leaving room for parity prefix
 133     // hextobinarray(tmp2 + 1, tmp1);
 134
 135     // wiegand_add_parity(tmp2, tmp2 + 1, 24);
 136
 137     // memset(awid26, '\x0', 96);
 138
 139     // // magic 18 bit awid26 header (we will overwrite the last two bits)
 140     // hextobinarray(awid26, "011D8");
 141
 142     // // copy to target leaving space for parity bits
 143     // for(i= 0, p= 18 ; i < 26 ; ++i, ++p)
 144     // {
 145         // // skip target bit if this is a parity location
 146         // if(!((p + 1) % 4))
 147             // p += 1;
 148         // awid26[p]= tmp2[i];
 149     // }
 150
 151     // // add parity bits
 152     // for(i= 1 ; i < 24 ; ++i)
 153         // awid26[((i + 1) * 4) - 1]= GetParity(&awid26[i * 4], ODD, 3);
 154
 155     return false;
 156 }
 157
 158 // int CmdReadTrace(const char *Cmd)
 159 // {
 160
 161         // uint8_t bits[LF_BITSSTREAM_LEN] = {0x00};
 162         // uint8_t * bitstream = bits;
 163
 164         // uint8_t si = 5;
 165         // uint32_t bl0     = PackBits(si, 32, bitstream);
 166         // uint32_t bl1     = PackBits(si+32, 32, bitstream);
 167
 168         // uint32_t acl     = PackBits(si,  8, bitstream); si += 8;
 169         // uint32_t mfc     = PackBits(si, 8, bitstream); si += 8;
 170         // uint32_t cid     = PackBits(si, 5, bitstream); si += 5;
 171         // uint32_t icr     = PackBits(si, 3, bitstream); si += 3;
 172         // uint32_t year    = PackBits(si, 4, bitstream); si += 4;
 173         // uint32_t quarter = PackBits(si, 2, bitstream); si += 2;
 174         // uint32_t lotid    = PackBits(si, 12, bitstream); si += 12;
 175         // uint32_t wafer   = PackBits(si, 5, bitstream); si += 5;
 176         // uint32_t dw      = PackBits(si, 15, bitstream);
 177
 178         // PrintAndLog("");
 179         // PrintAndLog("-- T55xx Trace Information ----------------------------------");
 180         // PrintAndLog("-------------------------------------------------------------");
 181         // PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1)  : 0x%02X (%d)", acl, acl);
 182         // PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6)    : 0x%02X (%d)", mfc, mfc);
 183         // PrintAndLog(" CID                                     : 0x%02X (%d)", cid, cid);
 184         // PrintAndLog(" ICR IC Revision                         : %d",icr );
 185
 186
 187   // return 0;
 188 // }
 189
 190 static command_t CommandTable[] =
 191 {
 192   {"help",   CmdHelp,     1, "This help"},
 193   {"clone",  CmdClone,    1, "<facility> <id> -- clone AWID26 to t55xx tag"},
 194   {NULL, NULL, 0, NULL}
 195 };
 196
 197 int CmdLFAWID26(const char *Cmd)
 198 {
 199   CmdsParse(CommandTable, Cmd);
 200   return 0;
 201 }
 202
 203 int CmdHelp(const char *Cmd)
 204 {
 205   CmdsHelp(CommandTable);
 206   return 0;
 207 }