+
+//! Enable SPI writing
+void spiflash_wrten(){
+ SETSS;
+ /*
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x04);//Write Disable
+ SETSS; //Raise !SS to end transaction.
+ */
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x06);//Write Enable
+ SETSS; //Raise !SS to end transaction.
+}
+
+
+//! Grab the SPI flash status byte.
+unsigned char spiflash_status(){
+ unsigned char c;
+ SETSS; //Raise !SS to end transaction.
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x05);//GET STATUS
+ c=spitrans8(0xFF);
+ SETSS; //Raise !SS to end transaction.
+ return c;
+}
+
+
+//! Grab the SPI flash status byte.
+void spiflash_setstatus(unsigned char c){
+ SETSS;
+ CLRSS; //Drop !SS to begin transaction.
+ spitrans8(0x01);//SET STATUS
+ spitrans8(c);
+ SETSS; //Raise !SS to end transaction.
+ //return c;
+}
+
+
+//! Read a block to a buffer.
+void spiflash_peekblock(unsigned long adr,
+ unsigned char *buf,
+ unsigned int len){
+ unsigned char i;
+
+ 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.");
+}
+
+