Add forgotten file

[proxmark3-svn] / armsrc / appmain.c

diff --git a/armsrc/appmain.c b/armsrc/appmain.c
index 74448fe508fb395b8fa6443e169342ea67c11574..72d8789e75af6a10637d82bbc2b401bb83a89371 100644 (file)
--- a/armsrc/appmain.c
+++ b/armsrc/appmain.c
@@ -13,7 +13,6 @@
 #include "LCD.h"
 #endif
 
 #include "LCD.h"
 #endif
 

-int usbattached = 0;

 
 //=============================================================================
 // A buffer where we can queue things up to be sent through the FPGA, for
 
 //=============================================================================
 // A buffer where we can queue things up to be sent through the FPGA, for


@@ -64,8 +63,8 @@ void ToSendStuffBit(int b)
 void DbpString(char *str)
 {
        /* this holds up stuff unless we're connected to usb */
 void DbpString(char *str)
 {
        /* this holds up stuff unless we're connected to usb */

-//     if (!usbattached)
-//             return;
+       if (!UsbConnected())
+               return;

 
        UsbCommand c;
        c.cmd = CMD_DEBUG_PRINT_STRING;
 
        UsbCommand c;
        c.cmd = CMD_DEBUG_PRINT_STRING;


@@ -80,8 +79,8 @@ void DbpString(char *str)
 void DbpIntegers(int x1, int x2, int x3)
 {
        /* this holds up stuff unless we're connected to usb */
 void DbpIntegers(int x1, int x2, int x3)
 {
        /* this holds up stuff unless we're connected to usb */

-//     if (!usbattached)
-//             return;
+       if (!UsbConnected())
+               return;

 
        UsbCommand c;
        c.cmd = CMD_DEBUG_PRINT_INTEGERS;
 
        UsbCommand c;
        c.cmd = CMD_DEBUG_PRINT_INTEGERS;


@@ -237,6 +236,34 @@ void ReadMem(int addr)
                DbpIntegers(0, data[i], data[i+1]);
 }
 
                DbpIntegers(0, data[i], data[i+1]);
 }
 

+/* osimage version information is linked in */
+extern struct version_information version_information;
+/* bootrom version information is pointed to from _bootphase1_version_pointer */
+extern char _bootphase1_version_pointer, _flash_start, _flash_end;
+void SendVersion(void)
+{
+       char temp[48]; /* Limited data payload in USB packets */
+       DbpString("Prox/RFID mark3 RFID instrument");
+       
+       /* Try to find the bootrom version information. Expect to find a pointer at 
+        * symbol _bootphase1_version_pointer, perform slight sanity checks on the
+        * pointer, then use it.
+        */
+       void *bootrom_version = *(void**)&_bootphase1_version_pointer;
+       if( bootrom_version < (void*)&_flash_start || bootrom_version >= (void*)&_flash_end ) {
+               DbpString("bootrom version information appears invalid");
+       } else {
+               FormatVersionInformation(temp, sizeof(temp), "bootrom: ", bootrom_version);
+               DbpString(temp);
+       }
+       
+       FormatVersionInformation(temp, sizeof(temp), "os: ", &version_information);
+       DbpString(temp);
+       
+       FpgaGatherVersion(temp, sizeof(temp));
+       DbpString(temp);
+}
+

 // samy's sniff and repeat routine
 void SamyRun()
 {
 // samy's sniff and repeat routine
 void SamyRun()
 {


@@ -266,7 +293,7 @@ void SamyRun()
 
        for (;;)
        {
 
        for (;;)
        {

-               usbattached = UsbPoll(FALSE);
+               UsbPoll(FALSE);

                WDT_HIT();
 
                // Was our button held down or pressed?
                WDT_HIT();
 
                // Was our button held down or pressed?


@@ -373,56 +400,47 @@ your antenna. You will probably not get some good results if there is a LF and a
 at the same place! :-)
 
 LIGHT SCHEME USED:
 at the same place! :-)
 
 LIGHT SCHEME USED:

-
-Light scheme | Descriptiong
-----------------------------------------------------
-    ----     | No field detected
-    X---     | 14% of maximum current detected
-    -X--     | 29% of maximum current detected
-    --X-     | 43% of maximum current detected
-    ---X     | 57% of maximum current detected
-    --XX     | 71% of maximum current detected
-    -XXX     | 86% of maximum current detected
-    XXXX     | 100% of maximum current detected
-
-TODO:
-Add the LF part for MODE 2
-

 */
 */

+static const char LIGHT_SCHEME[] = {
+               0x0, /* ----     | No field detected */
+               0x1, /* X---     | 14% of maximum current detected */
+               0x2, /* -X--     | 29% of maximum current detected */
+               0x4, /* --X-     | 43% of maximum current detected */
+               0x8, /* ---X     | 57% of maximum current detected */
+               0xC, /* --XX     | 71% of maximum current detected */
+               0xE, /* -XXX     | 86% of maximum current detected */
+               0xF, /* XXXX     | 100% of maximum current detected */
+};
+static const int LIGHT_LEN = sizeof(LIGHT_SCHEME)/sizeof(LIGHT_SCHEME[0]);
+

 void ListenReaderField(int limit)
 {
 void ListenReaderField(int limit)
 {

-       int lf_av, lf_av_new, lf_baseline= 0, lf_count= 0;
+       int lf_av, lf_av_new, lf_baseline= 0, lf_count= 0, lf_max;

        int hf_av, hf_av_new,  hf_baseline= 0, hf_count= 0, hf_max;
        int hf_av, hf_av_new,  hf_baseline= 0, hf_count= 0, hf_max;

-       int mode=1;
+       int mode=1, display_val, display_max, i;

 
 #define LF_ONLY                1
 #define HF_ONLY                2
 
 
 #define LF_ONLY                1
 #define HF_ONLY                2
 

-       LED_A_OFF();
-       LED_B_OFF();
-       LED_C_OFF();
-       LED_D_OFF();
+       LEDsoff();

 
 

-       lf_av= ReadAdc(ADC_CHAN_LF);
+       lf_av=lf_max=ReadAdc(ADC_CHAN_LF);

 
 

-       if(limit != HF_ONLY)
-               {
+       if(limit != HF_ONLY) {

                DbpString("LF 125/134 Baseline:");
                DbpIntegers(lf_av,0,0);
                lf_baseline= lf_av;
                DbpString("LF 125/134 Baseline:");
                DbpIntegers(lf_av,0,0);
                lf_baseline= lf_av;

-               }
+       }

 
        hf_av=hf_max=ReadAdc(ADC_CHAN_HF);
 
 
        hf_av=hf_max=ReadAdc(ADC_CHAN_HF);
 

-       if (limit != LF_ONLY)
-               {
+       if (limit != LF_ONLY) {

                DbpString("HF 13.56 Baseline:");
                DbpIntegers(hf_av,0,0);
                hf_baseline= hf_av;
                DbpString("HF 13.56 Baseline:");
                DbpIntegers(hf_av,0,0);
                hf_baseline= hf_av;

-               }
+       }

 
 

-       for(;;)
-               {
+       for(;;) {

                if (BUTTON_PRESS()) {
                        SpinDelay(500);
                        switch (mode) {
                if (BUTTON_PRESS()) {
                        SpinDelay(500);
                        switch (mode) {


@@ -433,85 +451,78 @@ void ListenReaderField(int limit)
                                case 2:
                                default:
                                        DbpString("Stopped");
                                case 2:
                                default:
                                        DbpString("Stopped");

-                                       LED_A_OFF();
-                                       LED_B_OFF();
-                                       LED_C_OFF();
-                                       LED_D_OFF();
+                                       LEDsoff();

                                        return;
                                        break;
                        }
                }
                WDT_HIT();
 
                                        return;
                                        break;
                        }
                }
                WDT_HIT();
 

-               if (limit != HF_ONLY)
-                       {
-                       if (abs(lf_av - lf_baseline) > 10)
-                               LED_D_ON();
-                       else
-                               LED_D_OFF();
+               if (limit != HF_ONLY) {
+                       if(mode==1) {
+                               if (abs(lf_av - lf_baseline) > 10) LED_D_ON();
+                               else                               LED_D_OFF();
+                       }
+                       

                        ++lf_count;
                        lf_av_new= ReadAdc(ADC_CHAN_LF);
                        // see if there's a significant change
                        ++lf_count;
                        lf_av_new= ReadAdc(ADC_CHAN_LF);
                        // see if there's a significant change

-                       if(abs(lf_av - lf_av_new) > 10)
-                               {
+                       if(abs(lf_av - lf_av_new) > 10) {

                                DbpString("LF 125/134 Field Change:");
                                DbpIntegers(lf_av,lf_av_new,lf_count);
                                lf_av= lf_av_new;
                                DbpString("LF 125/134 Field Change:");
                                DbpIntegers(lf_av,lf_av_new,lf_count);
                                lf_av= lf_av_new;

+                               if (lf_av > lf_max)
+                                       lf_max = lf_av;

                                lf_count= 0;
                                lf_count= 0;

-                               }

                        }
                        }

+               }

 
 

-               if (limit != LF_ONLY)
-                       {
-                       if (abs(hf_av - hf_baseline) > 10) {
-                               if (mode == 1)
-                                       LED_B_ON();
-                               if (mode == 2) {
-                                       if ( hf_av>(hf_max/7)*6) {
-                                               LED_A_ON();     LED_B_ON();     LED_C_ON();     LED_D_ON();
-                                       }
-                                       if ( (hf_av>(hf_max/7)*5) && (hf_av<=(hf_max/7)*6) ) {
-                                               LED_A_ON();     LED_B_ON();     LED_C_OFF(); LED_D_ON();
-                                       }
-                                       if ( (hf_av>(hf_max/7)*4) && (hf_av<=(hf_max/7)*5) ) {
-                                               LED_A_OFF(); LED_B_ON(); LED_C_OFF(); LED_D_ON();
-                                       }
-                                       if ( (hf_av>(hf_max/7)*3) && (hf_av<=(hf_max/7)*4) ) {
-                                               LED_A_OFF(); LED_B_OFF(); LED_C_OFF(); LED_D_ON();
-                                       }
-                                       if ( (hf_av>(hf_max/7)*2) && (hf_av<=(hf_max/7)*3) ) {
-                                               LED_A_OFF(); LED_B_ON(); LED_C_OFF(); LED_D_OFF();
-                                       }
-                                       if ( (hf_av>(hf_max/7)*1) && (hf_av<=(hf_max/7)*2) ) {
-                                               LED_A_ON();     LED_B_OFF(); LED_C_OFF(); LED_D_OFF();
-                                       }
-                                       if ( (hf_av>(hf_max/7)*0) && (hf_av<=(hf_max/7)*1) ) {
-                                               LED_A_OFF(); LED_B_OFF(); LED_C_ON(); LED_D_OFF();
-                                       }
-                               }
-                       } else {
-                               if (mode == 1) {
-                                       LED_B_OFF();
-                               }
-                               if (mode == 2) {
-                                       LED_A_OFF(); LED_B_OFF(); LED_C_OFF(); LED_D_OFF();
-                               }
+               if (limit != LF_ONLY) {
+                       if (mode == 1){
+                               if (abs(hf_av - hf_baseline) > 10) LED_B_ON();
+                               else                               LED_B_OFF();

                        }
                        }

-
+                       

                        ++hf_count;
                        hf_av_new= ReadAdc(ADC_CHAN_HF);
                        // see if there's a significant change
                        ++hf_count;
                        hf_av_new= ReadAdc(ADC_CHAN_HF);
                        // see if there's a significant change

-                       if(abs(hf_av - hf_av_new) > 10)
-                               {
+                       if(abs(hf_av - hf_av_new) > 10) {

                                DbpString("HF 13.56 Field Change:");
                                DbpIntegers(hf_av,hf_av_new,hf_count);
                                hf_av= hf_av_new;
                                if (hf_av > hf_max)
                                        hf_max = hf_av;
                                hf_count= 0;
                                DbpString("HF 13.56 Field Change:");
                                DbpIntegers(hf_av,hf_av_new,hf_count);
                                hf_av= hf_av_new;
                                if (hf_av > hf_max)
                                        hf_max = hf_av;
                                hf_count= 0;

+                       }
+               }
+               
+               if(mode == 2) {
+                       if (limit == LF_ONLY) {
+                               display_val = lf_av;
+                               display_max = lf_max;
+                       } else if (limit == HF_ONLY) {
+                               display_val = hf_av;
+                               display_max = hf_max;
+                       } else { /* Pick one at random */
+                               if( (hf_max - hf_baseline) > (lf_max - lf_baseline) ) {
+                                       display_val = hf_av;
+                                       display_max = hf_max;
+                               } else {
+                                       display_val = lf_av;
+                                       display_max = lf_max;
+                               }
+                       }
+                       for (i=0; i<LIGHT_LEN; i++) {
+                               if (display_val >= ((display_max/LIGHT_LEN)*i) && display_val <= ((display_max/LIGHT_LEN)*(i+1))) {
+                                       if (LIGHT_SCHEME[i] & 0x1) LED_C_ON(); else LED_C_OFF();
+                                       if (LIGHT_SCHEME[i] & 0x2) LED_A_ON(); else LED_A_OFF();
+                                       if (LIGHT_SCHEME[i] & 0x4) LED_B_ON(); else LED_B_OFF();
+                                       if (LIGHT_SCHEME[i] & 0x8) LED_D_ON(); else LED_D_OFF();
+                                       break;

                                }
                        }
                }
                                }
                        }
                }

+       }

 }
 
 void UsbPacketReceived(BYTE *packet, int len)
 }
 
 void UsbPacketReceived(BYTE *packet, int len)


@@ -633,6 +644,12 @@ void UsbPacketReceived(BYTE *packet, int len)
                case CMD_SET_LF_DIVISOR:
                        FpgaSendCommand(FPGA_CMD_SET_DIVISOR, c->ext1);
                        break;
                case CMD_SET_LF_DIVISOR:
                        FpgaSendCommand(FPGA_CMD_SET_DIVISOR, c->ext1);
                        break;

+               case CMD_VERSION:
+                       SendVersion();
+                       break;
+               case CMD_LF_SIMULATE_BIDIR:
+                       SimulateTagLowFrequencyBidir(c->ext1, c->ext2);
+                       break;

 #ifdef WITH_LCD
                case CMD_LCD_RESET:
                        LCDReset();
 #ifdef WITH_LCD
                case CMD_LCD_RESET:
                        LCDReset();


@@ -715,7 +732,7 @@ void AppMain(void)
 #endif
 
        for(;;) {
 #endif
 
        for(;;) {

-               usbattached = UsbPoll(FALSE);
+               UsbPoll(FALSE);

                WDT_HIT();
 
                if (BUTTON_HELD(1000) > 0)
                WDT_HIT();
 
                if (BUTTON_HELD(1000) > 0)