#include "at25.h"

#define AT25_CS        3, 3, L            // at25 чипселект

// EEPROM commands
#define  EE_READ              3
#define  EE_WRITE             2
#define  EE_WREN              6
#define  EE_WRDI              4
#define  EE_RDSR              5
#define  EE_WRSR              1

// EEPROM status
#define SS_WRITING            0x01    // Write cycle in progress
#define SS_WRITE_ENABLE        0x02    // Write enabled

void at25_init(void)
{
    direct(AT25_CS,O);    // переключаем ногу чипселекта на выход
    off(AT25_CS);           // отключаем (высокий уровень)
}

void at25_command(char cmd)
{
    on(AT25_CS);
    spi_w(cmd);
}

uint8_t at25_read_status(void)
{
    int result;

    at25_command(EE_RDSR);
    result = spi_r8();
    off(AT25_CS);
    return result;
}

uint8_t at25_read_byte(uint16_t adr)
{
    uint8_t result;

    at25_command(EE_READ);
    spi_w(adr >> 8);
    spi_w(adr);
    result = spi_r8();
    off(AT25_CS);
    return result;
}

void at25_read(uint16_t adr, uint8_t *bf, uint16_t len)
{
    at25_command(EE_READ);
    spi_w(adr >> 8);
    spi_w(adr);
    while (len--)
        *bf++ = spi_r8();
    off(AT25_CS);
}

void at25_write_byte(uint16_t adr, uint8_t data)
{
    at25_command(EE_WREN);
    off(AT25_CS);            // toggle CS, necessary for WREN

    at25_command(EE_WRITE);
    spi_w(adr >> 8);
    spi_w(adr);
    spi_w(data);
    off(AT25_CS);
    while (at25_read_status()& SS_WRITING);
}

void at25_write(uint16_t adr, uint8_t *bf, uint16_t len)
{
    while (len--)
        at25_write_byte(adr++, *bf++);
}

DWORD SSP1Init( void )
{
  BYTE i, Dummy=Dummy;

  PCONP    |=  (1 << 10); // PCSSP1
  PCLKSEL0 |=  (1 << 20);  // Peripheral Clock Selection for SSP1 <3=> Pclk = Cclk
  PINSEL9  &= ~(3 << 10);            // Set SSEL to GPIO pin
  PINSEL9  |=  (3 << 8) | (3 << 12) | (3 << 14);     // P4.20 - SCK1, P4.22 - MISO1, P4.23 - MOSI1

  FPIN_AS_OUTPUT_(4,21);
  FPIN_SET_(4,21);
  
  SSP1CR0  = 0x0707;//(7 << 0) | (1 << 6) | (1 << 7) | (1 << 8);//0x0707; // Set DSS data to 8-bit, Frame format SPI, CPOL = 0, CPHA = 0, and SCR is 15
  
  SSP1CPSR = 0x02;

  for ( i = 0; i < FIFOSIZE; i++ )
  {Dummy = SSP1DR;}        // clear the RxFIFO

  SSP1CR1  = SSPCR1_SSE; // Device select as master, SSP Enabled

  return( TRUE );

}

volatile int Flash1_ManID,Flash1_MemType1,Flash1_MemType2,Flash1_MemSize = 0;

void Flash1_ReadType(void)
{
    FPIN_CLR_(4,21);
    SSP1DR = 0x9F;
    while ( !(SSP1SR & SSPSR_BSY) );   // SSPSR_TFE SSPSR_RNE
    Flash1_ManID     = SSP1DR;
    Flash1_MemType1     = SSP1DR;
    Flash1_MemType2     = SSP1DR;
    Flash1_MemSize     = SSP1DR;
    FPIN_SET_(4,21);
}

volatile unsigned int ManID,MemType,MemType1,MemType2,MemSize;

void Flash_ReadType(void)
{
    FPIN_CLR(4,21);
    SSP1DR = 0x9F;
    SSP1DR = 0;
    SSP1DR = 0;
    while ( !(SSP1SR & SSPSR_BSY) );
    ManID = SSP1DR;      // В SSP1DR 0xFF, но при чтении в переменную попадает 0x1F
    MemType = SSP1DR; // В SSP1DR 0x47, но при чтении в переменную попадает 0x01
    MemSize = SSP1DR;  // В SSP1DR 0x01, но при чтении в переменную попадает 0x00
    FPIN_SET(4,21);
}

volatile unsigned int ManID,MemType,MemType1,MemType2,MemSize;

void Flash_ReadType(void)
{
    BYTE Dummy = Dummy;

    FPIN_CLR(4,21);
    SSP1DR = 0x9F;
    SSP1DR = 0;
    SSP1DR = 0;
    SSP1DR = 0;
    while ( !(SSP1SR & SSPSR_BSY) );
    Dummy   = SSP1DR;  // Всегда 0xFF    
    ManID   = SSP1DR;    
    MemType = SSP1DR;    
    MemSize = SSP1DR;    
    FPIN_SET(4,21);
}

volatile unsigned int RegStat1,RegStat2;

void Flash_ReadStatus(void)
{
    BYTE Dummy = Dummy;

    FPIN_CLR(4,21);
    SSP1DR = 0x05;
    SSP1DR = 0;
    while ( !(SSP1SR & SSPSR_BSY) );
    Dummy    = SSP1DR; // Всегда 0xFF    
    RegStat1 = SSP1DR;    
    RegStat2 = SSP1DR;    
    FPIN_SET(4,21);
}

uint8_t spi_rw(uint8_t b)
{
    SSP1DR = b;   // передаём
    while ( !(SSP1SR & SSPSR_RNE) );  // ждём пока примется
    return SSP1DR;
}

...
    spi_rw(0x9F);
    ManID   = spi_rw(0);
    MemType = spi_rw(0);
    MemSize = spi_rw(0);
...

spi_rw(0x1B);
spi_rw(X >> 16);
spi_rw(X >> 8);
spi_rw(X);
spi_rw(0); //dummy 1
spi_rw(0); //dummy 2
for (...)
   {
   buf++ = spi_rw(0);
   }

uint8_t ssp_rw(uint8_t b)
{
    SSP1DR = b;   // передаём
    while ( !(SSP1SR & SSPSR_RNE) );  // ждём пока примется
    return SSP1DR;
}

void at25_command(char cmd)
{
    at25_SSEL_low(AT25_CS);
    ssp_rw(cmd);
}

void at25_write_byte(uint32_t adr, uint8_t data)
{
    at25_command(EE_WREN);
    at25_SSEL_high(AT25_CS);            // toggle CS, necessary for WREN

    at25_command(EE_WRITE);
    ssp_rw(adr >> 16);
    ssp_rw(adr >>  8);
    ssp_rw(adr);
    ssp_rw(data);
    at25_SSEL_high(AT25_CS);
    while (at25_read_status()& SS_WRITING);
}

uint8_t at25_read_byte(uint32_t adr)
{
    uint8_t result;

    at25_command(EE_READ);
    ssp_rw(adr >> 16);
    ssp_rw(adr >> 8);
    ssp_rw(adr);
    result = ssp_rw(0);
    at25_SSEL_high(AT25_CS);
    return result;
}

...
at25_erase_4kb(0);
at25_write_byte(0,22);
read_byte = at25_read_byte(0);

...

void at25_erase_4kb(uint32_t adr)
{
    at25_command(EE_WREN);
    at25_SSEL_high(AT25_CS);            // toggle CS, necessary for WREN

    at25_command(EE_ERASE4); // 0х20
    ssp_rw(adr >> 16);
    ssp_rw(adr >>  8);
    ssp_rw(adr);
    at25_SSEL_high(AT25_CS);
    while (at25_read_status()& SS_WRITING);
}

uint8_t at25_read_protect_register(uint32_t adr)
{
uint8_t result;
    at25_command(EE_RDPR);
    ssp_rw(adr >> 16);
    ssp_rw(adr >> 8);
    result = ssp_rw(adr);
    result = ssp_rw(0);
    at25_SSEL_high(AT25_CS);
    return result;
}

void at25_Unprotect_Sector(uint32_t adr)
{
    at25_command(EE_WREN);
    at25_SSEL_high(AT25_CS);            // toggle CS, necessary for WREN

    at25_command(EE_UNPROTECT);
    ssp_rw(adr >> 16);
    ssp_rw(adr >>  8);
    ssp_rw(adr);
    at25_SSEL_high(AT25_CS);
    while (at25_read_status()& SS_WRITING);
}