]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfpyramid.c
2494f2655529b72aee15378caee412e3c5349435
1 //-----------------------------------------------------------------------------
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
6 //-----------------------------------------------------------------------------
7 // Low frequency Farpoint / Pyramid tag commands
8 //-----------------------------------------------------------------------------
12 #include "cmdlfpyramid.h"
13 #include "proxmark3.h"
17 #include "cmdparser.h"
21 #include "protocols.h" // for T55xx config register definitions
22 #include "lfdemod.h" // parityTest
25 static int CmdHelp(const char *Cmd
);
27 int usage_lf_pyramid_clone(void){
28 PrintAndLog("clone a Farpointe/Pyramid tag to a T55x7 tag.");
29 PrintAndLog("The facility-code is 8-bit and the card number is 16-bit. Larger values are truncated. ");
30 PrintAndLog("Currently work only on 26bit");
32 PrintAndLog("Usage: lf pyramid clone <Facility-Code> <Card-Number>");
33 PrintAndLog("Options :");
34 PrintAndLog(" <Facility-Code> : 8-bit value facility code");
35 PrintAndLog(" <Card Number> : 16-bit value card number");
36 PrintAndLog(" Q5 : optional - clone to Q5 (T5555) instead of T55x7 chip");
38 PrintAndLog("Sample : lf pyramid clone 123 11223");
42 int usage_lf_pyramid_sim(void) {
43 PrintAndLog("Enables simulation of Farpointe/Pyramid card with specified card number.");
44 PrintAndLog("Simulation runs until the button is pressed or another USB command is issued.");
45 PrintAndLog("The facility-code is 8-bit and the card number is 16-bit. Larger values are truncated.");
46 PrintAndLog("Currently work only on 26bit");
48 PrintAndLog("Usage: lf pyramid sim <Card-Number>");
49 PrintAndLog("Options :");
50 PrintAndLog(" <Facility-Code> : 8-bit value facility code");
51 PrintAndLog(" <Card Number> : 16-bit value card number");
53 PrintAndLog("Sample : lf pyramid sim 123 11223");
58 int GetPyramidBits(uint32_t fc
, uint32_t cn
, uint8_t *pyramidBits
) {
61 memset(pre
, 0x00, sizeof(pre
));
66 // Get 26 wiegand from FacilityCode, CardNumber
68 memset(wiegand
, 0x00, sizeof(wiegand
));
69 num_to_bytebits(fc
, 8, wiegand
);
70 num_to_bytebits(cn
, 16, wiegand
+8);
72 // add wiegand parity bits (dest, source, len)
73 wiegand_add_parity(pre
+80, wiegand
, 24);
75 // add paritybits (bitsource, dest, sourcelen, paritylen, parityType (odd, even,)
76 addParity(pre
+8, pyramidBits
+8, 102, 8, 1);
80 for (uint8_t i
= 0; i
< 13; i
++)
81 csBuff
[i
] = bytebits_to_byte(pyramidBits
+ 16 + (i
*8), 8);
83 uint32_t crc
= CRC8Maxim(csBuff
, 13);
84 num_to_bytebits(crc
, 8, pyramidBits
+120);
88 int CmdPyramidRead(const char *Cmd
) {
90 getSamples("30000",false);
91 return CmdFSKdemodPyramid("");
94 int CmdPyramidClone(const char *Cmd
) {
96 char cmdp
= param_getchar(Cmd
, 0);
97 if (strlen(Cmd
) == 0 || cmdp
== 'h' || cmdp
== 'H') return usage_lf_pyramid_clone();
99 uint32_t facilitycode
=0, cardnumber
=0, fc
= 0, cn
= 0;
103 memset(bs
, 0x00, sizeof(bs
));
105 if (sscanf(Cmd
, "%u %u", &fc
, &cn
) != 2) return usage_lf_pyramid_clone();
107 facilitycode
= (fc
& 0x000000FF);
108 cardnumber
= (cn
& 0x0000FFFF);
110 if ( !GetPyramidBits(facilitycode
, cardnumber
, bs
)) {
111 PrintAndLog("Error with tag bitstream generation.");
115 //Pyramid - compat mode, FSK2a, data rate 50, 4 data blocks
116 blocks
[0] = T55x7_MODULATION_FSK2a
| T55x7_BITRATE_RF_50
| 4<<T55x7_MAXBLOCK_SHIFT
;
118 if (param_getchar(Cmd
, 3) == 'Q' || param_getchar(Cmd
, 3) == 'q')
119 blocks
[0] = T5555_MODULATION_FSK2
| T5555_INVERT_OUTPUT
| 50<<T5555_BITRATE_SHIFT
| 4<<T5555_MAXBLOCK_SHIFT
;
121 blocks
[1] = bytebits_to_byte(bs
,32);
122 blocks
[2] = bytebits_to_byte(bs
+32,32);
123 blocks
[3] = bytebits_to_byte(bs
+64,32);
124 blocks
[4] = bytebits_to_byte(bs
+96,32);
126 PrintAndLog("Preparing to clone Farpointe/Pyramid to T55x7 with Facility Code: %u, Card Number: %u", facilitycode
, cardnumber
);
127 PrintAndLog("Blk | Data ");
128 PrintAndLog("----+------------");
129 for ( i
= 0; i
<5; ++i
)
130 PrintAndLog(" %02d | %08" PRIx32
, i
, blocks
[i
]);
133 UsbCommand c
= {CMD_T55XX_WRITE_BLOCK
, {0,0,0}};
135 for ( i
= 0; i
<5; ++i
) {
136 c
.arg
[0] = blocks
[i
];
138 clearCommandBuffer();
140 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
141 PrintAndLog("Error occurred, device did not respond during write operation.");
148 int CmdPyramidSim(const char *Cmd
) {
150 char cmdp
= param_getchar(Cmd
, 0);
151 if (strlen(Cmd
) == 0 || cmdp
== 'h' || cmdp
== 'H') return usage_lf_pyramid_sim();
153 uint32_t facilitycode
= 0, cardnumber
= 0, fc
= 0, cn
= 0;
156 size_t size
= sizeof(bs
);
157 memset(bs
, 0x00, size
);
159 // Pyramid uses: fcHigh: 10, fcLow: 8, clk: 50, invert: 0
161 arg1
= (10 << 8) + 8;
164 if (sscanf(Cmd
, "%u %u", &fc
, &cn
) != 2) return usage_lf_pyramid_sim();
166 facilitycode
= (fc
& 0x000000FF);
167 cardnumber
= (cn
& 0x0000FFFF);
169 if ( !GetPyramidBits(facilitycode
, cardnumber
, bs
)) {
170 PrintAndLog("Error with tag bitstream generation.");
174 PrintAndLog("Simulating Farpointe/Pyramid - Facility Code: %u, CardNumber: %u", facilitycode
, cardnumber
);
176 UsbCommand c
= {CMD_FSK_SIM_TAG
, {arg1
, arg2
, size
}};
177 memcpy(c
.d
.asBytes
, bs
, size
);
178 clearCommandBuffer();
183 static command_t CommandTable
[] = {
184 {"help", CmdHelp
, 1, "This help"},
185 {"read", CmdPyramidRead
, 0, "Attempt to read and extract tag data"},
186 {"clone", CmdPyramidClone
, 0, "<Facility-Code> <Card Number> clone pyramid tag"},
187 {"sim", CmdPyramidSim
, 0, "<Facility-Code> <Card Number> simulate pyramid tag"},
188 {NULL
, NULL
, 0, NULL
}
191 int CmdLFPyramid(const char *Cmd
) {
192 clearCommandBuffer();
193 CmdsParse(CommandTable
, Cmd
);
197 int CmdHelp(const char *Cmd
) {
198 CmdsHelp(CommandTable
);