]> git.zerfleddert.de Git - proxmark3-svn/blame - client/cmdlfpyramid.c
Merge pull request #13 from k02a/patch-1
[proxmark3-svn] / client / cmdlfpyramid.c
CommitLineData
71cb7328 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 Farpoint / Pyramid tag commands
8//-----------------------------------------------------------------------------
9#include <string.h>
10#include <inttypes.h>
11#include "cmdlfpyramid.h"
12static int CmdHelp(const char *Cmd);
13
14int usage_lf_pyramid_clone(void){
4b3655e7 15 PrintAndLog("clone a Farpointe/Pyramid tag to a T55x7 tag.");
69c4516d 16 PrintAndLog("The facility-code is 8-bit and the card number is 16-bit. Larger values are truncated. ");
17 PrintAndLog("Currently work only on 26bit");
71cb7328 18 PrintAndLog("");
19 PrintAndLog("Usage: lf pyramid clone <Facility-Code> <Card-Number>");
20 PrintAndLog("Options :");
21 PrintAndLog(" <Facility-Code> : 8-bit value facility code");
22 PrintAndLog(" <Card Number> : 16-bit value card number");
6c68b84a 23 PrintAndLog(" Q5 : optional - clone to Q5 (T5555) instead of T55x7 chip");
71cb7328 24 PrintAndLog("");
25 PrintAndLog("Sample : lf pyramid clone 123 11223");
26 return 0;
27}
28
29int usage_lf_pyramid_sim(void) {
4b3655e7 30 PrintAndLog("Enables simulation of Farpointe/Pyramid card with specified card number.");
71cb7328 31 PrintAndLog("Simulation runs until the button is pressed or another USB command is issued.");
69c4516d 32 PrintAndLog("The facility-code is 8-bit and the card number is 16-bit. Larger values are truncated.");
33 PrintAndLog("Currently work only on 26bit");
71cb7328 34 PrintAndLog("");
35 PrintAndLog("Usage: lf pyramid sim <Card-Number>");
36 PrintAndLog("Options :");
37 PrintAndLog(" <Facility-Code> : 8-bit value facility code");
38 PrintAndLog(" <Card Number> : 16-bit value card number");
39 PrintAndLog("");
40 PrintAndLog("Sample : lf pyramid sim 123 11223");
41 return 0;
42}
43
69c4516d 44// Works for 26bits.
71cb7328 45int GetPyramidBits(uint32_t fc, uint32_t cn, uint8_t *pyramidBits) {
46
47 uint8_t pre[128];
48 memset(pre, 0x00, sizeof(pre));
49
f087591d 50 // format start bit
581b31fb 51 pre[79] = 1;
f087591d 52
53 // Get 26 wiegand from FacilityCode, CardNumber
581b31fb 54 uint8_t wiegand[24];
55 memset(wiegand, 0x00, sizeof(wiegand));
71cb7328 56 num_to_bytebits(fc, 8, wiegand);
57 num_to_bytebits(cn, 16, wiegand+8);
58
f087591d 59 // add wiegand parity bits (dest, source, len)
581b31fb 60 wiegand_add_parity(pre+80, wiegand, 24);
61
f087591d 62 // add paritybits (bitsource, dest, sourcelen, paritylen, parityType (odd, even,)
50564be0 63 addParity(pre+8, pyramidBits+8, 102, 8, 1);
64
71cb7328 65 // add checksum
f087591d 66 uint8_t csBuff[13];
67 for (uint8_t i = 0; i < 13; i++)
68 csBuff[i] = bytebits_to_byte(pyramidBits + 16 + (i*8), 8);
69
70 uint32_t crc = CRC8Maxim(csBuff, 13);
71 num_to_bytebits(crc, 8, pyramidBits+120);
71cb7328 72 return 1;
73}
74
75int CmdPyramidRead(const char *Cmd) {
71cb7328 76 CmdLFRead("s");
71cb7328 77 getSamples("30000",false);
71cb7328 78 return CmdFSKdemodPyramid("");
79}
80
81int CmdPyramidClone(const char *Cmd) {
82
83 char cmdp = param_getchar(Cmd, 0);
84 if (strlen(Cmd) == 0 || cmdp == 'h' || cmdp == 'H') return usage_lf_pyramid_clone();
85
f087591d 86 uint32_t facilitycode=0, cardnumber=0, fc = 0, cn = 0;
90639dd1 87 uint32_t blocks[5];
4b3655e7 88 uint8_t i;
ce9a7cbf 89 uint8_t bs[128];
581b31fb 90 memset(bs, 0x00, sizeof(bs));
71cb7328 91
f087591d 92 if (sscanf(Cmd, "%u %u", &fc, &cn ) != 2) return usage_lf_pyramid_clone();
71cb7328 93
f087591d 94 facilitycode = (fc & 0x000000FF);
95 cardnumber = (cn & 0x0000FFFF);
96
71cb7328 97 if ( !GetPyramidBits(facilitycode, cardnumber, bs)) {
98 PrintAndLog("Error with tag bitstream generation.");
99 return 1;
100 }
101
90639dd1 102 //Pyramid - compat mode, FSK2a, data rate 50, 4 data blocks
103 blocks[0] = T55x7_MODULATION_FSK2a | T55x7_BITRATE_RF_50 | 4<<T55x7_MAXBLOCK_SHIFT;
6c68b84a 104
105 if (param_getchar(Cmd, 3) == 'Q' || param_getchar(Cmd, 3) == 'q')
890ae3dd 106 //t5555 (Q5) BITRATE = (RF-2)/2 (iceman)
6c68b84a 107 blocks[0] = T5555_MODULATION_FSK2 | T5555_INVERT_OUTPUT | 50<<T5555_BITRATE_SHIFT | 4<<T5555_MAXBLOCK_SHIFT;
108
71cb7328 109 blocks[1] = bytebits_to_byte(bs,32);
110 blocks[2] = bytebits_to_byte(bs+32,32);
111 blocks[3] = bytebits_to_byte(bs+64,32);
112 blocks[4] = bytebits_to_byte(bs+96,32);
113
4b3655e7 114 PrintAndLog("Preparing to clone Farpointe/Pyramid to T55x7 with Facility Code: %u, Card Number: %u", facilitycode, cardnumber);
71cb7328 115 PrintAndLog("Blk | Data ");
116 PrintAndLog("----+------------");
4b3655e7 117 for ( i = 0; i<5; ++i )
90639dd1 118 PrintAndLog(" %02d | %08" PRIx32, i, blocks[i]);
f087591d 119
71cb7328 120 UsbCommand resp;
f087591d 121 UsbCommand c = {CMD_T55XX_WRITE_BLOCK, {0,0,0}};
71cb7328 122
4b3655e7 123 for ( i = 0; i<5; ++i ) {
f087591d 124 c.arg[0] = blocks[i];
125 c.arg[1] = i;
71cb7328 126 clearCommandBuffer();
f087591d 127 SendCommand(&c);
71cb7328 128 if (!WaitForResponseTimeout(CMD_ACK, &resp, 1000)){
129 PrintAndLog("Error occurred, device did not respond during write operation.");
130 return -1;
131 }
132 }
133 return 0;
134}
135
136int CmdPyramidSim(const char *Cmd) {
71cb7328 137
138 char cmdp = param_getchar(Cmd, 0);
139 if (strlen(Cmd) == 0 || cmdp == 'h' || cmdp == 'H') return usage_lf_pyramid_sim();
140
ce9a7cbf 141 uint32_t facilitycode = 0, cardnumber = 0, fc = 0, cn = 0;
142
143 uint8_t bs[128];
144 size_t size = sizeof(bs);
145 memset(bs, 0x00, size);
146
147 // Pyramid uses: fcHigh: 10, fcLow: 8, clk: 50, invert: 0
148 uint64_t arg1, arg2;
149 arg1 = (10 << 8) + 8;
150 arg2 = 50 | 0;
71cb7328 151
ce9a7cbf 152 if (sscanf(Cmd, "%u %u", &fc, &cn ) != 2) return usage_lf_pyramid_sim();
71cb7328 153
ce9a7cbf 154 facilitycode = (fc & 0x000000FF);
155 cardnumber = (cn & 0x0000FFFF);
156
157 if ( !GetPyramidBits(facilitycode, cardnumber, bs)) {
158 PrintAndLog("Error with tag bitstream generation.");
159 return 1;
160 }
71cb7328 161
4b3655e7 162 PrintAndLog("Simulating Farpointe/Pyramid - Facility Code: %u, CardNumber: %u", facilitycode, cardnumber );
71cb7328 163
ce9a7cbf 164 UsbCommand c = {CMD_FSK_SIM_TAG, {arg1, arg2, size}};
165 memcpy(c.d.asBytes, bs, size);
166 clearCommandBuffer();
167 SendCommand(&c);
71cb7328 168 return 0;
169}
170
171static command_t CommandTable[] = {
172 {"help", CmdHelp, 1, "This help"},
173 {"read", CmdPyramidRead, 0, "Attempt to read and extract tag data"},
174 {"clone", CmdPyramidClone, 0, "<Facility-Code> <Card Number> clone pyramid tag"},
175 {"sim", CmdPyramidSim, 0, "<Facility-Code> <Card Number> simulate pyramid tag"},
176 {NULL, NULL, 0, NULL}
177};
178
179int CmdLFPyramid(const char *Cmd) {
180 clearCommandBuffer();
181 CmdsParse(CommandTable, Cmd);
182 return 0;
183}
184
185int CmdHelp(const char *Cmd) {
186 CmdsHelp(CommandTable);
187 return 0;
188}
Impressum, Datenschutz