+
+ SETSS;
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x03);//Flash Read Command
+
+ //Send address
+ spitrans8((adr&0xFF0000)>>16);
+ spitrans8((adr&0xFF00)>>8);
+ spitrans8(adr&0xFF);
+
+ for(i=0;i<len;i++)
+ buf[i]=spitrans8(0);
+ SETSS; //Raise !SS to end transaction.
+}
+
+//! Read a block to a buffer.
+void spiflash_pokeblock(unsigned long adr,
+ unsigned char *buf,
+ unsigned int len){
+ unsigned int i;
+
+ SETSS;
+
+ //if(len!=0x100)
+ // debugstr("Non-standard block size.");
+
+ while(spiflash_status()&0x01);//minor performance impact
+
+ spiflash_setstatus(0x02);
+ spiflash_wrten();
+
+ //Are these necessary?
+ //spiflash_setstatus(0x02);
+ //spiflash_wrten();
+
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x02); //Poke command.
+
+ //Send address
+ spitrans8((adr&0xFF0000)>>16);
+ spitrans8((adr&0xFF00)>>8);
+ spitrans8(adr&0xFF);
+
+ for(i=0;i<len;i++)
+ spitrans8(buf[i]);
+ SETSS; //Raise !SS to end transaction.
+
+ while(spiflash_status()&0x01);//minor performance impact
+ return;
+}
+
+
+//! Write many blocks to the SPI Flash.
+void spiflash_pokeblocks(unsigned long adr,
+ unsigned char *buf,
+ unsigned int len){
+ long off=0;//offset of this block
+ int blen;//length of this block
+ SETSS;
+
+ while(off<len){
+ //calculate block length
+ blen=(len-off>0x100?0x100:len-off);
+ //write the block
+ spiflash_pokeblock(adr+off,
+ buf+off,
+ blen);
+ //add offset
+ off+=blen;
+ }
+}
+
+
+
+//! 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;
+ }