X-Git-Url: http://cvs.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/b13fa4448f517b46e917c5145050f434d6df24d5..a75d63f19b93f22faeff886f9f2568f3d7531d55:/client/ui.c diff --git a/client/ui.c b/client/ui.c index 5fe58dc2..48a55b1f 100644 --- a/client/ui.c +++ b/client/ui.c @@ -9,19 +9,11 @@ // UI utilities //----------------------------------------------------------------------------- -#include <stdarg.h> -#include <stdlib.h> -#include <stdio.h> -#include <time.h> -#include <readline/readline.h> -#include <pthread.h> - #include "ui.h" - double CursorScaleFactor; int PlotGridX, PlotGridY, PlotGridXdefault= 64, PlotGridYdefault= 64; int offline; - +int flushAfterWrite = 0; extern pthread_mutex_t print_lock; static char *logfilename = "proxmark3.log"; @@ -32,13 +24,13 @@ void PrintAndLog(char *fmt, ...) int saved_point; va_list argptr, argptr2; static FILE *logfile = NULL; - static int logging=1; + static int logging = 1; // lock this section to avoid interlacing prints from different threats pthread_mutex_lock(&print_lock); if (logging && !logfile) { - logfile=fopen(logfilename, "a"); + logfile = fopen(logfilename, "a"); if (!logfile) { fprintf(stderr, "Can't open logfile, logging disabled!\n"); logging=0; @@ -77,12 +69,127 @@ void PrintAndLog(char *fmt, ...) } va_end(argptr2); + if (flushAfterWrite == 1) { + fflush(NULL); + } //release lock pthread_mutex_unlock(&print_lock); } +void SetLogFilename(char *fn) { + logfilename = fn; +} + +void iceFsk3(int * data, const size_t len){ + + int i,j; + + int * output = (int* ) malloc(sizeof(int) * len); + memset(output, 0x00, len); + float fc = 0.1125f; // center frequency + size_t adjustedLen = len; + + // create very simple low-pass filter to remove images (2nd-order Butterworth) + float complex iir_buf[3] = {0,0,0}; + float b[3] = {0.003621681514929, 0.007243363029857, 0.003621681514929}; + float a[3] = {1.000000000000000, -1.822694925196308, 0.837181651256023}; + + float sample = 0; // input sample read from file + float complex x_prime = 1.0f; // save sample for estimating frequency + float complex x; + + for (i=0; i<adjustedLen; ++i) { + + sample = data[i]+128; + + // remove DC offset and mix to complex baseband + x = (sample - 127.5f) * cexpf( _Complex_I * 2 * M_PI * fc * i ); + + // apply low-pass filter, removing spectral image (IIR using direct-form II) + iir_buf[2] = iir_buf[1]; + iir_buf[1] = iir_buf[0]; + iir_buf[0] = x - a[1]*iir_buf[1] - a[2]*iir_buf[2]; + x = b[0]*iir_buf[0] + + b[1]*iir_buf[1] + + b[2]*iir_buf[2]; + + // compute instantaneous frequency by looking at phase difference + // between adjacent samples + float freq = cargf(x*conjf(x_prime)); + x_prime = x; // retain this sample for next iteration + + output[i] =(freq > 0)? 10 : -10; + } + + // show data + for (j=0; j<adjustedLen; ++j) + data[j] = output[j]; + + CmdLtrim("30"); + adjustedLen -= 30; + + // zero crossings. + for (j=0; j<adjustedLen; ++j){ + if ( data[j] == 10) break; + } + int startOne =j; + + for (;j<adjustedLen; ++j){ + if ( data[j] == -10 ) break; + } + int stopOne = j-1; + + int fieldlen = stopOne-startOne; + + fieldlen = (fieldlen == 39 || fieldlen == 41)? 40 : fieldlen; + fieldlen = (fieldlen == 59 || fieldlen == 51)? 50 : fieldlen; + if ( fieldlen != 40 && fieldlen != 50){ + printf("Detected field Length: %d \n", fieldlen); + printf("Can only handle 40 or 50. Aborting...\n"); + free(output); + return; + } + + // FSK sequence start == 000111 + int startPos = 0; + for (i =0; i<adjustedLen; ++i){ + int dec = 0; + for ( j = 0; j < 6*fieldlen; ++j){ + dec += data[i + j]; + } + if (dec == 0) { + startPos = i; + break; + } + } + + printf("000111 position: %d \n", startPos); + + startPos += 6*fieldlen+5; + + int bit =0; + printf("BINARY\n"); + printf("R/40 : "); + for (i =startPos ; i < adjustedLen; i += 40){ + bit = data[i]>0 ? 1:0; + printf("%d", bit ); + } + printf("\n"); + + printf("R/50 : "); + for (i =startPos ; i < adjustedLen; i += 50){ + bit = data[i]>0 ? 1:0; + printf("%d", bit ); } + printf("\n"); + + free(output); +} -void SetLogFilename(char *fn) +float complex cexpf (float complex Z) { - logfilename = fn; + float complex Res; + double rho = exp (__real__ Z); + __real__ Res = rho * cosf(__imag__ Z); + __imag__ Res = rho * sinf(__imag__ Z); + return Res; }