+}
+
+
+
+//! Peek some blocks.
+void spiflash_peek(unsigned char app,
+ unsigned char verb,
+ unsigned long len){
+ unsigned int i;
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x03);//Flash Read Command
+ len=3;//write 3 byte pointer
+ for(i=0;i<len;i++)
+ spitrans8(cmddata[i]);
+
+ //Send reply header
+ len=0x1000;
+ txhead(app,verb,len);
+
+ while(len--)
+ serial_tx(spitrans8(0));
+
+ SETSS; //Raise !SS to end transaction.
+}
+
+
+//! Erase a sector.
+void spiflash_erasesector(unsigned long adr){
+ //debugstr("Erasing a 4kB sector.");
+
+ //Write enable.
+ spiflash_wrten();
+
+ //Begin
+ CLRSS;
+
+ //Second command.
+ spitrans8(0x20);
+ //Send address
+ spitrans8((adr&0xFF0000)>>16);
+ spitrans8((adr&0xFF00)>>8);
+ spitrans8(adr&0xFF);
+
+ SETSS;
+ while(spiflash_status()&0x01);//while busy
+ //debugstr("Erased.");
+}
+
+
+//! Wake an EM260 Radio
+void em260_wake(){
+ //debugstr("Waking EM260.");
+ #define RST BIT6
+ P2DIR|=RST;
+ SETRST;
+ delay(1024);
+
+ CLRRST;//Wake chip.
+ while(P4IN&1);
+ SETRST;//Woken.
+ //debugstr("EM260 is now awake.");
+ delay(1024); //DO NOT REMOVE, fails without.
+}
+//! Handle an EM260 exchange.
+void spi_rw_em260(u8 app, u8 verb, u32 len){
+ unsigned long i;
+ u8 lastin;
+
+ P4DIR=0; //TODO ASAP remove P4 references.
+ P4OUT=0xFF;
+ //P4REN=0xFF;
+
+ //See GoodFETEM260.py for details.
+ //The EM260 requires that the host wait for the client.
+
+ /*
+ if((~P4IN)&1)
+ debugstr("Detected HOST_INT.");
+ */
+
+ em260_wake();
+
+
+ SETMOSI; //Autodetected SPI mode.
+ CLRSS; //Drop !SS to begin transaction.
+ //Host to slave. Ignore data.
+ for(i=0;i<len;i++){
+ lastin=spitrans8(cmddata[i]);
+ if(lastin!=0xFF){
+ //debugstr("EM260 transmission interrupted.");
+ cmddata[0]=lastin;
+ goto response;
+ }
+ }
+ //debugstr("Finished transmission to EM260.");
+
+ //Wait for nHOST_INT to drop.
+ i=0xffff;
+
+ /*
+ while(P4IN&1
+ && --i
+ )
+ spitrans8(0xFF);
+ */
+ while((cmddata[0]=spitrans8(0xFF))==0xFF
+ && --i);
+
+ if(!i)
+ debugstr("Gave up on host interrupt.");
+
+ response:
+ len=1;
+ while(
+ (cmddata[len++]=spitrans8(0xFF))!=0xA7
+ );
+ if(cmddata[0]==0xFE)
+ while(len<cmddata[1]+3)
+ cmddata[len++]=spitrans8(0xFF);
+ SETSS; //Raise !SS to end transaction.
+
+ txdata(app,verb,len);
+ return;
+}
+
+//! Handles a monitor command.
+void spi_handle_fn( uint8_t const app,
+ uint8_t const verb,
+ uint32_t const len)
+{
+ unsigned long i, l;
+
+ //Raise !SS to end transaction, just in case we forgot.
+ SETSS;
+ //spisetup();
+
+ switch(verb)
+ {
+ case READ:
+ case WRITE:
+ CLRSS; //Drop !SS to begin transaction.
+ for(i=0;i<len;i++)
+ cmddata[i]=spitrans8(cmddata[i]);
+ SETSS; //Raise !SS to end transaction.
+ txdata(app,verb,len);
+ break;
+
+ case SPI_RW_EM260: //SPI exchange with an EM260
+ spi_rw_em260(app,verb,len);
+ break;
+
+ case SPI_JEDEC://Grab 3-byte JEDEC ID.
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x9f);
+ l=3; //Length is variable in some chips, 3 minimum.
+ for(i = 0; i < l; i++)
+ cmddata[i]=spitrans8(cmddata[i]);
+ txdata(app,verb,len);
+ SETSS; //Raise !SS to end transaction.
+ break;
+
+ case PEEK://Grab 128 bytes from an SPI Flash ROM
+ spiflash_peek(app,verb,len);
+ break;
+
+ case POKE://Poke up bytes from an SPI Flash ROM.
+ spiflash_pokeblocks(cmddatalong[0],//adr
+ cmddata+4,//buf
+ len-4);//len
+ txdata(app,verb,0);
+ break;
+
+ case SPI_ERASE://Erase the SPI Flash ROM.
+ spiflash_wrten();
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0xC7);//Chip Erase
+ SETSS; //Raise !SS to end transaction.
+
+ while(spiflash_status()&0x01)//while busy
+ led_toggle();
+ led_off();
+
+ txdata(app,verb,0);
+ break;
+
+ case SETUP:
+ spisetup();
+ txdata(app,verb,0);
+ break;
+ }