X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=firmware%2Fapps%2Favr%2Favr.c;h=f1fe5b78eaa1b63c761b8c37bf7485a335edd620;hp=fdef1aa76ee52b3cca5535131f21ce618dd9fdf8;hb=eddb0eb08f187dc156a6cb51878104df67d97436;hpb=25e355b9e50cee54081024c581501757e7c33b5d

diff --git a/firmware/apps/avr/avr.c b/firmware/apps/avr/avr.c
index fdef1aa..f1fe5b7 100644
--- a/firmware/apps/avr/avr.c
+++ b/firmware/apps/avr/avr.c
@@ -11,10 +11,13 @@
 #include <iomacros.h>
 
 #include "avr.h"
+#include "glitch.h"
 
 //! Setup the AVR pins.
 void avrsetup(){
   spisetup();
+  
+  glitchsetup();
 }
 
 //! Initialized an attached AVR.
@@ -111,6 +114,14 @@ u8 avr_pokeeeprom(u16 adr, u8 val){
   return avrexchange(0xC0, adr>>8, adr&0xFF, val);
 }
 
+//! Read a byte of Flash
+u8 avr_peekflash(u16 adr){
+  u16 a=adr>>1;
+  if(adr&1) //high byte
+    return avrexchange(0x28,a>>8,a&0xff,0);
+  else      //low byte
+    return avrexchange(0x20,a>>8,a&0xff,0);
+}
 
 
 //! Handles an AVR command.
@@ -118,6 +129,7 @@ void avrhandle(unsigned char app,
 	       unsigned char verb,
 	       unsigned long len){
   unsigned long i;
+  unsigned int at;
   static u8 connected=0;
   
   if(!avr_isready() && connected)
@@ -159,6 +171,22 @@ void avrhandle(unsigned char app,
     txdata(app,verb,1);
     break;
   case PEEK:
+    //cmddata[0]=avr_peekflash(cmddataword[0]);
+    //txdata(app,verb,1);
+    at=cmddataword[0];
+    
+    //Fetch large blocks for bulk fetches,
+    //small blocks for individual peeks.
+    if(len>2){
+      len=(cmddataword[1]);//always even.
+    }else{
+      len=1;
+    }
+    txhead(app,verb,len);
+    for(i=0;i<len;i++){
+      serial_tx(avr_peekflash(at++));
+    }
+    break;
   case POKE:
   default:
     debugstr("Verb unimplemented in AVR application.");