-//GOODFET Main File\r
-//Includes several applications.\r
-\r
-#include "platform.h"\r
-#include "command.h"\r
-#include "apps.h"\r
-\r
-#include <signal.h>\r
-#include <io.h>\r
-#include <iomacros.h>\r
-\r
-\r
-//LED on P1.0\r
-//IO on P5\r
-\r
-//! Initialize registers and all that jazz.\r
-void init(){\r
- volatile unsigned int i;\r
- WDTCTL = WDTPW + WDTHOLD; // Stop watchdog timer\r
- \r
- //LED and TX OUT\r
- PLEDDIR |= PLEDPIN;\r
- \r
- msp430_init_dco();\r
- msp430_init_uart();\r
- \r
- //Enable Interrupts.\r
- //eint();\r
-}\r
-\r
-//! Handle a command.\r
-void handle(unsigned char app,\r
- unsigned char verb,\r
- unsigned char len){\r
- switch(app){\r
- case MONITOR:\r
- monitorhandle(app,verb,len);\r
- break;\r
- case SPI:\r
- spihandle(app,verb,len);\r
- break;\r
- case I2C:\r
- i2chandle(app,verb,len);\r
- break;\r
- case CHIPCON:\r
- cchandle(app,verb,len);\r
- break;\r
- case JTAG:\r
- jtaghandle(app,verb,len);\r
- break;\r
- case JTAG430:\r
- jtag430handle(app,verb,len);\r
- break;\r
- default:\r
- txdata(app,NOK,0);\r
- break;\r
- }\r
-}\r
-\r
-//! Main loop.\r
-int main(void)\r
-{\r
- volatile unsigned int i;\r
- unsigned char app, verb, len;\r
- \r
- init();\r
- \r
- \r
- //Ready\r
- //txdata(MONITOR,OK,0);\r
- txstring(MONITOR,OK,"http://goodfet.sf.net/");\r
- \r
- //Command loop. There's no end!\r
- while(1){\r
- //Magic 3\r
- app=serial_rx();\r
- verb=serial_rx();\r
- len=serial_rx();\r
- \r
- //Read data, if any\r
- for(i=0;i<len;i++){\r
- cmddata[i]=serial_rx();\r
- }\r
- handle(app,verb,len);\r
- }\r
-}\r
-\r
+/*! \file goodfet.c
+ \author Travis Goodspeed
+ \brief Main module.
+
+ This is the main module of the GoodFET, which calls the initialization
+ routines and delegates commands to the various applications.
+*/
+
+
+#include "platform.h"
+#include "command.h"
+#include "apps.h"
+#include "glitch.h"
+
+
+//! Initialize registers and all that jazz.
+void init(){
+ #ifdef DAC12IR
+ int i;
+ #endif
+
+ WDTCTL = WDTPW + WDTHOLD; // Stop watchdog timer
+
+ //LED out and on.
+ PLEDDIR |= PLEDPIN;
+ PLEDOUT &= ~PLEDPIN;
+
+ //Setup clocks, unique to each '430.
+ msp430_init_dco();
+ msp430_init_uart();
+
+ //DAC should be at full voltage if it exists.
+#ifdef DAC12IR
+ //glitchvoltages(0xfff,0xfff);
+ ADC12CTL0 = REF2_5V + REFON; // Internal 2.5V ref on
+ for(i=0;i!=0xFFFF;i++) asm("nop");
+ DAC12_0CTL = DAC12IR + DAC12AMP_5 + DAC12ENC; // Int ref gain 1
+ DAC12_0DAT = 0xFFF; //Max voltage 0xfff
+ DAC12_1CTL = DAC12IR + DAC12AMP_5 + DAC12ENC; // Int ref gain 1
+ DAC12_1DAT = 0x000; //Min voltage 0x000
+#endif
+
+ /** FIXME
+
+ This part is really ugly. GSEL (P5.7) must be high to select
+ normal voltage, but a lot of applications light to swing it low
+ to be a nuissance. To get around this, we assume that anyone
+ with a glitching FET will also have a DAC, then we set that DAC
+ to a high voltage.
+
+ At some point, each target must be sanitized to show that it
+ doesn't clear P5OUT or P5DIR.
+ */
+ P5DIR|=BIT7; P5OUT=BIT7; //Normal Supply
+ //P5DIR&=~BIT7; //Glitch Supply
+
+ //Enable Interrupts.
+ //eint();
+}
+
+
+//! Handle a command.
+void handle(unsigned char app,
+ unsigned char verb,
+ unsigned long len){
+ //debugstr("GoodFET");
+ P1OUT&=~1;
+ switch(app){
+ case GLITCH:
+ glitchhandle(app,verb,len);
+ break;
+ case MONITOR:
+ monitorhandle(app,verb,len);
+ break;
+ case SPI:
+ spihandle(app,verb,len);
+ break;
+ case NRF:
+ nrfhandle(app,verb,len);
+ break;
+ case AVR:
+ avrhandle(app,verb,len);
+ break;
+ case PIC:
+ pichandle(app,verb,len);
+ break;
+
+ case I2CAPP:
+ i2chandle(app,verb,len);
+ break;
+ case CHIPCON:
+ cchandle(app,verb,len);
+ break;
+ case JTAG:
+ jtaghandle(app,verb,len);
+ break;
+ case EJTAG:
+ ejtaghandle(app,verb,len);
+ break;
+ case JTAG430: //Also JTAG430X, JTAG430X2
+ //Revert this when X2 support returns.
+ jtag430x2handle(app,verb,len);
+ //jtag430handle(app,verb,len);
+ break;
+ case SMARTCARD:
+ smartcardhandle(app,verb,len);
+ break;
+ case JTAGARM7TDMI:
+ jtagarm7tdmihandle(app,verb,len);
+ break;
+ default:
+ if(pluginhandle){
+ pluginhandle(app,verb,len);
+ }else{
+ debugstr("Plugin missing.");
+ debughex(app);
+ txdata(app,NOK,0);
+ }
+ break;
+ }
+}
+
+//! Main loop.
+int main(void)
+{
+ volatile unsigned int i;
+ unsigned char app, verb;
+ unsigned long len;
+ // MSP reboot count for reset input & reboot function located at 0xFFFE
+ volatile unsigned int reset_count = 0;
+ void (*reboot_function)(void) = (void *) 0xFFFE;
+
+ init();
+
+ txstring(MONITOR,OK,"http://goodfet.sf.net/");
+
+
+ //Command loop. There's no end!
+ while(1){
+ //Magic 3
+ app=serial_rx();
+
+ // If the app is the reset byte (0x80) increment and loop
+ if (app == RESET) {
+ reset_count++;
+
+ if (reset_count > 4) {
+ // We could trigger the WDT with either:
+ // WDTCTL = 0;
+ // or
+ // WDTCTL = WDTPW + WDTCNTCL + WDTSSEL + 0x00;
+ // but instead we'll jump to our reboot function pointer
+ (*reboot_function)();
+ }
+
+ continue;
+ } else {
+ reset_count = 0;
+ }
+
+ verb=serial_rx();
+ //len=serial_rx();
+ len=rxword();
+
+ //Read data, looking for buffer overflow.y
+ if(len<=CMDDATALEN){
+ for(i=0;i<len;i++){
+ cmddata[i]=serial_rx();
+ }
+ handle(app,verb,len);
+ }else{
+ //Listen to the blaberring.
+ for(i=0;i<len;i++)
+ serial_rx();
+ //Reply with an error.
+ debugstr("Buffer length exceeded.");
+ txdata(MONITOR,NOK,0);
+ }
+ }
+}
+
projects / goodfet / blobdiff