git.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfpcf7931.c

   1 //-----------------------------------------------------------------------------
   2 // Copyright (C) 2012 Chalk <chalk.secu at gmail.com>
   3 //               2015 Dake <thomas.cayrou at gmail.com>
   4
   5 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
   6 // at your option, any later version. See the LICENSE.txt file for the text of
   7 // the license.
   8 //-----------------------------------------------------------------------------
   9 // Low frequency PCF7931 commands
  10 //-----------------------------------------------------------------------------
  11 #include <stdio.h>
  12 #include <string.h>
  13 #include "proxmark3.h"
  14 #include "ui.h"
  15 #include "graph.h"
  16 #include "cmdparser.h"
  17 #include "cmddata.h"
  18 #include "cmdmain.h"
  19 #include "cmdlf.h"
  20 #include "cmdlfpcf7931.h"
  21
  22 static int CmdHelp(const char *Cmd);
  23
  24 #define PCF7931_DEFAULT_INITDELAY 17500
  25 #define PCF7931_DEFAULT_OFFSET_WIDTH 0
  26 #define PCF7931_DEFAULT_OFFSET_POSITION 0
  27
  28 // Default values - Configuration
  29 struct pcf7931_config configPcf = {
  30         {0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF},
  31         PCF7931_DEFAULT_INITDELAY,
  32                 {
  33                 PCF7931_DEFAULT_OFFSET_WIDTH,
  34                 PCF7931_DEFAULT_OFFSET_POSITION
  35                 }
  36         };
  37
  38 // Resets the configuration settings to default values.
  39 int pcf7931_resetConfig(){
  40         memset(configPcf.Pwd, 0xFF, sizeof(configPcf.Pwd) );
  41         configPcf.InitDelay = PCF7931_DEFAULT_INITDELAY;
  42         configPcf.Offset[0] = PCF7931_DEFAULT_OFFSET_WIDTH;
  43         configPcf.Offset[1] = PCF7931_DEFAULT_OFFSET_POSITION;
  44         return 0;
  45 }
  46
  47 int pcf7931_printConfig(){
  48         PrintAndLog("Password (LSB first on bytes) : %s", sprint_hex( configPcf.Pwd, sizeof(configPcf.Pwd)));
  49         PrintAndLog("Tag initialization delay      : %d us", configPcf.InitDelay);
  50         PrintAndLog("Offset low pulses width       : %d us", configPcf.Offset[0]);
  51         PrintAndLog("Offset low pulses position    : %d us", configPcf.Offset[1]);
  52         return 0;
  53 }
  54
  55 int usage_pcf7931_read(){
  56         PrintAndLog("Usage: lf pcf7931 read [h] ");
  57         PrintAndLog("This command tries to read a PCF7931 tag.");
  58         PrintAndLog("Options:");
  59         PrintAndLog("       h   This help");
  60         PrintAndLog("Examples:");
  61         PrintAndLog("      lf pcf7931 read");
  62         return 0;
  63 }
  64
  65 int usage_pcf7931_write(){
  66         PrintAndLog("Usage: lf pcf7931 write [h] <block address> <byte address> <data>");
  67         PrintAndLog("This command tries to write a PCF7931 tag.");
  68         PrintAndLog("Options:");
  69         PrintAndLog("       h                      This help");
  70         PrintAndLog("       blockaddress   Block to save");
  71         PrintAndLog("       byteaddress    Index of byte inside block to overwrite");
  72         PrintAndLog("       data           one byte of data");
  73         PrintAndLog("Examples:");
  74         PrintAndLog("      lf pcf7931 write 10 1 FF");
  75         return 0;
  76 }
  77
  78 int usage_pcf7931_config(){
  79         PrintAndLog("Usage: lf pcf7931 config [h] [r] <pwd> <delay> <offset width> <offset position>");
  80         PrintAndLog("This command tries to set the configuration used with PCF7931 commands");
  81         PrintAndLog("The time offsets could be useful to correct slew rate generated by the antenna");
  82         PrintAndLog("Caling without some parameter will print the current configuration.");
  83         PrintAndLog("Options:");
  84         PrintAndLog("       h       This help");
  85         PrintAndLog("       r       Reset configuration to default values");
  86         PrintAndLog("       pwd     Password, hex, 7bytes, LSB-order");
  87         PrintAndLog("       delay   Tag initialization delay (in us) decimal");
  88         PrintAndLog("       offset  Low pulses width (in us) decimal");
  89         PrintAndLog("       offset  Low pulses position (in us) decimal");
  90         PrintAndLog("Examples:");
  91         PrintAndLog("      lf pcf7931 config");
  92         PrintAndLog("      lf pcf7931 config r");
  93         PrintAndLog("      lf pcf7931 config 11223344556677 20000");
  94         PrintAndLog("      lf pcf7931 config 11223344556677 17500 -10 30");
  95         return 0;
  96 }
  97
  98 int CmdLFPCF7931Read(const char *Cmd){
  99
 100         uint8_t ctmp = param_getchar(Cmd, 0);
 101         if ( ctmp == 'H' || ctmp == 'h' ) return usage_pcf7931_read();
 102
 103         UsbCommand resp;
 104         UsbCommand c = {CMD_PCF7931_READ, {0, 0, 0}};
 105         clearCommandBuffer();
 106         SendCommand(&c);
 107         if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
 108                 PrintAndLog("command execution time out");
 109                 return 1;
 110         }
 111         return 0;
 112 }
 113
 114 int CmdLFPCF7931Config(const char *Cmd){
 115
 116         uint8_t ctmp = param_getchar(Cmd, 0);
 117         if ( ctmp == 0) return pcf7931_printConfig();
 118         if ( ctmp == 'H' || ctmp == 'h' ) return usage_pcf7931_config();
 119         if ( ctmp == 'R' || ctmp == 'r' ) return pcf7931_resetConfig();
 120
 121         if ( param_gethex(Cmd, 0, configPcf.Pwd, 14) ) return usage_pcf7931_config();
 122
 123         configPcf.InitDelay = (param_get32ex(Cmd,1,0,10) & 0xFFFF);
 124         configPcf.Offset[0] = (int)(param_get32ex(Cmd,2,0,10) & 0xFFFF);
 125         configPcf.Offset[1] = (int)(param_get32ex(Cmd,3,0,10) & 0xFFFF);
 126
 127         pcf7931_printConfig();
 128         return 0;
 129 }
 130
 131 int CmdLFPCF7931Write(const char *Cmd){
 132
 133         uint8_t ctmp = param_getchar(Cmd, 0);
 134         if (strlen(Cmd) < 1 || ctmp == 'h' || ctmp == 'H') return usage_pcf7931_write();
 135
 136         uint64_t blockaddress = param_get64ex(Cmd, 0, 0, 16);
 137         uint64_t byteaddress =  param_get64ex(Cmd, 1, 0, 16);
 138         uint8_t data = param_get8ex(Cmd,2,0,16);
 139
 140         PrintAndLog("Please specify the block address in hex");
 141         PrintAndLog("Please specify the byte address in hex");
 142         PrintAndLog("Please specify the data in hex (1 byte)");
 143
 144         PrintAndLog("", blockaddress, byteaddress, data);
 145         return 3;
 146
 147         UsbCommand c = {CMD_PCF7931_WRITE, { blockaddress, byteaddress, data} };
 148         memcpy(c.d.asDwords, configPcf.Pwd, 7);
 149     c.d.asDwords[7] = (configPcf.Offset[0]+128);
 150     c.d.asDwords[8] = (configPcf.Offset[1]+128);
 151     c.d.asDwords[9] = configPcf.InitDelay;
 152
 153         clearCommandBuffer();
 154         SendCommand(&c);
 155         //no ack?
 156         return 0;
 157 }
 158
 159 static command_t CommandTable[] =
 160 {
 161         {"help",        CmdHelp,                        1, "This help"},
 162         {"read",        CmdLFPCF7931Read,       1, "Read content of a PCF7931 transponder"},
 163         {"write",       CmdLFPCF7931Write,      1, "Write data on a PCF7931 transponder."},
 164         {"config",      CmdLFPCF7931Config, 1, "Configure the password, the tags initialization delay and time offsets (optional)"},
 165         {NULL, NULL, 0, NULL}
 166 };
 167
 168 int CmdLFPCF7931(const char *Cmd)
 169 {
 170         CmdsParse(CommandTable, Cmd);
 171         return 0;
 172 }
 173
 174 int CmdHelp(const char *Cmd)
 175 {
 176         CmdsHelp(CommandTable);
 177         return 0;
 178 }