- }
-
- continue;
- }
- else
- {
- reset_count = 0;
- }
-
- verb = serial_rx();
- len = rxword();
-
- //Read data, looking for buffer overflow.
- 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);
- }
- }
+
+ init();
+
+ txstring(MONITOR,OK,"http://goodfet.sf.net/");
+ //txstring(0xab,0xcd,"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)();
+ debugstr("Rebooting not supported on this platform.");
+ }
+
+ continue;
+ }else {
+ reset_count = 0;
+ }
+
+ verb = serial_rx();
+ len = rxword();
+
+ //Read data, looking for buffer overflow.
+ 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);
+ }
+ }