git.zerfleddert.de Git - proxmark3-svn/blame_incremental

... / ...

Commit	Line	Data
	1	//-----------------------------------------------------------------------------
	2	// Authored by Iceman
	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	// Low frequency COTAG commands
	9	//-----------------------------------------------------------------------------
	10	#include <stdio.h>
	11	#include <string.h>
	12	#include <stdint.h>
	13	#include "proxmark3.h"
	14	#include "ui.h"
	15	#include "cmddata.h"
	16	#include "data.h"
	17	#include "cmdlfcotag.h"
	18	#include "lfdemod.h"
	19	#include "usb_cmd.h"
	20	#include "cmdmain.h"
	21
	22	static int CmdHelp(const char *Cmd);
	23
	24	int usage_lf_cotag_read(void){
	25	PrintAndLog("Usage: lf COTAG read [h] <signaldata>");
	26	PrintAndLog("Options:");
	27	PrintAndLog(" h : This help");
	28	PrintAndLog(" <0\|1\|2> : 0 - HIGH/LOW signal; maxlength bigbuff");
	29	PrintAndLog(" : 1 - translation of HI/LO into bytes with manchester 0,1");
	30	PrintAndLog(" : 2 - raw signal; maxlength bigbuff");
	31	PrintAndLog("");
	32	PrintAndLog("Sample:");
	33	PrintAndLog(" lf cotag read 0");
	34	PrintAndLog(" lf cotag read 1");
	35	return 0;
	36	}
	37
	38	// COTAG demod should be able to use GraphBuffer,
	39	// when data load samples
	40	int CmdCOTAGDemod(const char *Cmd) {
	41
	42	uint8_t bits[COTAG_BITS] = {0};
	43	size_t bitlen = COTAG_BITS;
	44	memcpy(bits, DemodBuffer, COTAG_BITS);
	45
	46	uint8_t alignPos = 0;
	47	int err = manrawdecode(bits, &bitlen, 1, &alignPos);
	48	if (err){
	49	if (g_debugMode) PrintAndLog("DEBUG: Error - COTAG too many errors: %d", err);
	50	return -1;
	51	}
	52
	53	setDemodBuf(bits, bitlen, 0);
	54
	55	//got a good demod
	56	uint16_t cn = bytebits_to_byteLSBF(bits+1, 16);
	57	uint32_t fc = bytebits_to_byteLSBF(bits+1+16, 8);
	58
	59	uint32_t raw1 = bytebits_to_byteLSBF(bits, 32);
	60	uint32_t raw2 = bytebits_to_byteLSBF(bits+32, 32);
	61	uint32_t raw3 = bytebits_to_byteLSBF(bits+64, 32);
	62	uint32_t raw4 = bytebits_to_byteLSBF(bits+96, 32);
	63
	64	/*
	65	fc 161: 1010 0001 -> LSB 1000 0101
	66	cn 33593 1000 0011 0011 1001 -> LSB 1001 1100 1100 0001
	67	cccc cccc cccc cccc ffffffff
	68	0 1001 1100 1100 0001 1000 0101 0000 0000 100001010000000001111011100000011010000010000000000000000000000000000000000000000000000000000000100111001100000110000101000
	69	1001 1100 1100 0001 10000101
	70	*/
	71	PrintAndLog("COTAG Found: FC %u, CN: %u Raw: %08X%08X%08X%08X", fc, cn, raw1 ,raw2, raw3, raw4);
	72	return 1;
	73	}
	74
	75	// When reading a COTAG.
	76	// 0 = HIGH/LOW signal - maxlength bigbuff
	77	// 1 = translation for HI/LO into bytes with manchester 0,1 - length 300
	78	// 2 = raw signal - maxlength bigbuff
	79	int CmdCOTAGRead(const char *Cmd) {
	80
	81	if (Cmd[0] == 'h' \|\| Cmd[0] == 'H') return usage_lf_cotag_read();
	82
	83	uint32_t rawsignal = 1;
	84	sscanf(Cmd, "%u", &rawsignal);
	85
	86	UsbCommand c = {CMD_COTAG, {rawsignal, 0, 0}};
	87	clearCommandBuffer();
	88	SendCommand(&c);
	89	if ( !WaitForResponseTimeout(CMD_ACK, NULL, 7000) ) {
	90	PrintAndLog("command execution time out");
	91	return -1;
	92	}
	93
	94	switch ( rawsignal ){
	95	case 0:
	96	case 2: {
	97	CmdPlot("");
	98	CmdGrid("384");
	99	getSamples("", true); break;
	100	}
	101	case 1: {
	102	GetFromBigBuf(DemodBuffer, COTAG_BITS, 0);
	103	DemodBufferLen = COTAG_BITS;
	104	UsbCommand response;
	105	if ( !WaitForResponseTimeout(CMD_ACK, &response, 1000) ) {
	106	PrintAndLog("timeout while waiting for reply.");
	107	return -1;
	108	}
	109	return CmdCOTAGDemod("");
	110	}
	111	}
	112	return 0;
	113	}
	114
	115	static command_t CommandTable[] = {
	116	{"help", CmdHelp, 1, "This help"},
	117	{"demod", CmdCOTAGDemod, 1, "Tries to decode a COTAG signal"},
	118	{"read", CmdCOTAGRead, 0, "Attempt to read and extract tag data"},
	119	{NULL, NULL, 0, NULL}
	120	};
	121
	122	int CmdLFCOTAG(const char *Cmd) {
	123	clearCommandBuffer();
	124	CmdsParse(CommandTable, Cmd);
	125	return 0;
	126	}
	127
	128	int CmdHelp(const char *Cmd) {
	129	CmdsHelp(CommandTable);
	130	return 0;
	131	}