//------------------------------------------------------------------------------
/// Applet main entry. This function decodes received command and executes it.
/// \param argc always 1
/// \param argv Address of the argument area.
//------------------------------------------------------------------------------
int main(int argc, char **argv)
{
struct _Mailbox *pMailbox = (struct _Mailbox *) argv;
const At45Desc *pDesc = 0;
unsigned int bytesToWrite, bytesToRead, bufferAddr, memoryOffset, packetSize;
// index on read/write buffer
unsigned char *pBuffer;
// Temporary buffer used for non page aligned read/write
unsigned int tempBufferAddr;
// Offset in destination buffer during buffer copy
unsigned int bufferOffset;
// Configure the DBGU
TRACE_CONFIGURE_ISP(DBGU_STANDARD, 115200, BOARD_MCK);
// Configure pins (must be done each time because of some old ROM codes that reset PIO usage)
if (at45Select[at45Index].pSpiHw != 0) {
PIO_Configure(at45Select[at45Index].pPinsSpi, at45Select[at45Index].numPinsSpi);
PIO_Configure(at45Select[at45Index].pPinCs, 1);
}
// ----------------------------------------------------------
// INIT:
// ----------------------------------------------------------
if (pMailbox->command == APPLET_CMD_INIT) {
// Save info of communication link
comType = pMailbox->argument.inputInit.comType;
at45Index = pMailbox->argument.inputInit.at45Idx;
#if (DYN_TRACES == 1)
traceLevel = pMailbox->argument.inputInit.traceLevel;
#endif
TRACE_INFO("-- DataFlash AT45 Applet %s --\n\r", SAM_BA_APPLETS_VERSION);
TRACE_INFO("-- %s\n\r", BOARD_NAME);
if (at45Select[at45Index].pSpiHw == 0) {
pMailbox->status = APPLET_NO_DEV;
pMailbox->argument.outputInit.bufferSize = 0;
pMailbox->argument.outputInit.memorySize = 0;
pMailbox->argument.outputInit.bufferAddress = (unsigned int) &end;
TRACE_INFO("INIT command: No Dataflash %d defined for this board\n\r", \
pMailbox->argument.inputInit.at45Idx);
pMailbox->status = APPLET_NO_DEV;
goto exit;
}
TRACE_INFO("INIT command: Dataflash %d : SPI 0x%x SPI_NPCS 0x%x (0x%x)\n\r", \
pMailbox->argument.inputInit.at45Idx,
at45Select[at45Index].spiIndex,
at45Select[at45Index].cs,
(unsigned int) &(pMailbox->argument.inputInit.at45Idx));
// Initialize the SPI and serial flash
SPID_Configure(&spid, at45Select[at45Index].pSpiHw, at45Select[at45Index].spiId);
PIO_Configure(at45Select[at45Index].pPinsSpi, at45Select[at45Index].numPinsSpi);
PIO_Configure(at45Select[at45Index].pPinCs, 1);
TRACE_INFO("\tSPI NCSR 0x%x\n\r", (int)AT45_CSR(BOARD_MCK, SPCK));
SPID_ConfigureCS(&spid, at45Select[at45Index].cs, AT45_CSR(BOARD_MCK, SPCK));
AT45_Configure(&at45, &spid, at45Select[at45Index].cs);
TRACE_INFO("\tSPI and AT45 drivers initialized\n\r");
pMailbox->argument.outputInit.bufferAddress = (unsigned int) &end;
// Read the JEDEC ID of the device to identify it
pDesc = AT45_FindDevice(&at45, AT45D_GetStatus(&at45));
if (!pDesc) {
pMailbox->status = APPLET_DEV_UNKNOWN;
pMailbox->argument.outputInit.bufferSize = 0;
pMailbox->argument.outputInit.memorySize = 0;
TRACE_INFO("\tDevice Unknown\n\r");
goto exit;
}
// Get device parameters
pMailbox->status = APPLET_SUCCESS;
numPages = AT45_PageNumber(&at45);
pageSize = AT45_PageSize(&at45);
#if defined(sram) || defined(at91sam7se)
bufferSize = ((unsigned int) &_sstack) - ((unsigned int) &end) // user area
- STACK_SIZE // stack size (if same area of applet code)
- pageSize; // tempbuffer size to to make not aligned write operations
bufferSize -= bufferSize % pageSize; // integer number of pages can be contained in each buffer
//Buffer size can't be too big, otherwise COM will be timeout.
if ( bufferSize < pageSize) {
TRACE_INFO("\t No enought memory to load buffer.\n\r");
goto exit;
}
#else
bufferSize = BUFFER_NB_PAGE * pageSize;
#endif
// Limit buffer size for tranfsert via COM.
if (bufferSize > BUF_MAX_SIZE) {
bufferSize = BUF_MAX_SIZE;
bufferSize -= bufferSize % pageSize; // integer number of pages can be contained in each buffer
}
pMailbox->argument.outputInit.bufferSize = bufferSize;
pMailbox->argument.outputInit.memorySize = numPages * pageSize;
TRACE_INFO("\t%s numPages : 0x%x pageSize : 0x%x bufferAddr : 0x%x\n\r",
at45.pDesc->name, numPages, pageSize, pMailbox->argument.outputInit.bufferAddress);
}
// ----------------------------------------------------------
// WRITE:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_WRITE) {
memoryOffset = pMailbox->argument.inputWrite.memoryOffset;
bufferAddr = pMailbox->argument.inputWrite.bufferAddr;
bytesToWrite = pMailbox->argument.inputWrite.bufferSize;
TRACE_INFO("WRITE at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
memoryOffset, bufferAddr, bytesToWrite);
pBuffer = (unsigned char *) bufferAddr;
tempBufferAddr = bufferAddr + bufferSize;
if ((memoryOffset % pageSize) != 0) {
// We are not page aligned, retrieve first page content to update it
// Flush temp buffer
memset((unsigned int *)tempBufferAddr, 0xFF, pageSize);
bufferOffset = (memoryOffset % pageSize);
if( (bytesToWrite + bufferOffset) < pageSize) {
packetSize = bytesToWrite;
}
else {
packetSize = pageSize - bufferOffset;
}
memoryOffset -= bufferOffset;
// Read page to be updated
AT45D_Read(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
// Fill retrieved page with data to be programmed
memcpy((unsigned char *)(tempBufferAddr + bufferOffset), pBuffer, packetSize);
// Write the page contents
AT45D_Write(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
bytesToWrite -= packetSize;
pBuffer += packetSize;
memoryOffset += pageSize;
}
// If it remains more than one page to write
while (bytesToWrite >= pageSize) {
// Write the page contents
AT45D_Write(&at45, pBuffer, pageSize, memoryOffset);
pBuffer += pageSize;
memoryOffset += pageSize;
bytesToWrite -= pageSize;
}
// Write remaining data
if (bytesToWrite > 0) {
// Read previous content of page
AT45D_Read(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
// Fill retrieved block with data to be programmed
memcpy((unsigned char *)tempBufferAddr, pBuffer, bytesToWrite);
// Write the page contents
AT45D_Write(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
// No more bytes to write
bytesToWrite = 0;
}
TRACE_INFO("WRITE return byte written : 0x%x Bytes\n\r",
pMailbox->argument.inputWrite.bufferSize - bytesToWrite);
pMailbox->argument.outputWrite.bytesWritten = pMailbox->argument.inputWrite.bufferSize - bytesToWrite;
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// READ:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_READ) {
memoryOffset = pMailbox->argument.inputRead.memoryOffset;
bufferAddr = pMailbox->argument.inputRead.bufferAddr;
bytesToRead = pMailbox->argument.inputRead.bufferSize;
TRACE_INFO("READ at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
memoryOffset, bufferAddr, bytesToRead);
pBuffer = (unsigned char *) bufferAddr;
// Read packet after packets
while (((unsigned int)pBuffer < (bufferAddr + bufferSize)) && (bytesToRead > 0)) {
packetSize = min(PDC_MAX_COUNT, bytesToRead);
AT45D_Read(&at45, pBuffer, packetSize, memoryOffset);
pBuffer += packetSize;
bytesToRead -= packetSize;
memoryOffset += packetSize;
}
TRACE_INFO("READ return byte read : 0x%x Bytes\n\r",
pMailbox->argument.inputRead.bufferSize - bytesToRead);
pMailbox->argument.outputRead.bytesRead = pMailbox->argument.inputRead.bufferSize - bytesToRead;
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// FULL ERASE:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_FULL_ERASE) {
TRACE_INFO("FULL ERASE command\n\r");
memoryOffset = 0;
while (memoryOffset < (pageSize * numPages)) {
// Erase the page
AT45D_Erase(&at45, memoryOffset);
memoryOffset += pageSize;
}
TRACE_INFO("Full Erase achieved\n\r");
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// BUFFER ERASE:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_BUFFER_ERASE) {
TRACE_INFO("BUFFER ERASE command\n\r");
memoryOffset = pMailbox->argument.inputBufferErase.memoryOffset;
while (memoryOffset < (pMailbox->argument.inputBufferErase.memoryOffset + bufferSize)) {
// Erase the page
AT45D_Erase(&at45, memoryOffset);
memoryOffset += pageSize;
}
TRACE_INFO("Buffer Erase achieved\n\r");
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// CONFIGURE IN BINARY MODE (power of two page size):
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_BINARY_PAGE) {
TRACE_INFO("BINARY PAGE SET command\n\r");
// Configure power-of-2 binary page size.
AT45D_BinaryPage(&at45);
TRACE_INFO("Binary Page achieved\n\r");
pMailbox->status = APPLET_SUCCESS;
}
exit :
// Acknowledge the end of command
TRACE_INFO("\tEnd of applet (command : %x --- status : %x)\n\r", pMailbox->command, pMailbox->status);
// Notify the host application of the end of the command processing
pMailbox->command = ~(pMailbox->command);
// Send ACK character
if (comType == DBGU_COM_TYPE) {
DBGU_PutChar(0x6);
}
return 0;
}
int main(int argc, char **argv)
{
struct _Mailbox *pMailbox = (struct _Mailbox *) argv;
const At45Desc *pDesc = 0;
uint32_t bytesToWrite, bytesToRead, bufferAddr, memoryOffset, packetSize;
/* index on read/write buffer */
uint8_t *pBuffer;
/* Temporary buffer used for non block aligned read/write */
uint32_t tempBufferAddr;
/* Offset in destination buffer during buffer copy */
uint32_t bufferOffset;
/* Configure pins */
PIO_Configure(pins, PIO_LISTSIZE(pins));
if (pMailbox->command == APPLET_CMD_INIT) {
/* Save communication link type */
comType = pMailbox->argument.inputInit.comType;
#if (DYN_TRACES == 1)
dwTraceLevel = pMailbox->argument.inputInit.traceLevel;
#endif
TRACE_INFO("-- DataFlash AT45 Applet %s --\n\r", SAM_BA_APPLETS_VERSION);
TRACE_INFO("-- %s\n\r", BOARD_NAME);
TRACE_INFO("-- Compiled: %s %s --\n\r", __DATE__, __TIME__);
/* Initialize DMA driver instance with polling mode */
DMAD_Initialize( &dmad, 1 );
/* Initialize the SPI and serial flash */
SPID_Configure(&spid, SPI0, ID_SPI0, &dmad);
AT45_Configure(&at45, &spid, SPI_CS, 1);
TRACE_INFO("SPI and at45 drivers initialized\n\r");
pMailbox->argument.outputInit.bufferAddress = (uint32_t) &_end ;
/* Read the JEDEC ID of the device to identify it */
pDesc = AT45_FindDevice(&at45, AT45D_GetStatus(&at45));
if (!pDesc) {
pMailbox->status = APPLET_DEV_UNKNOWN;
pMailbox->argument.outputInit.bufferSize = 0;
pMailbox->argument.outputInit.memorySize = 0;
TRACE_INFO("Device Unknown\n\r");
goto exit;
}
else {
/* Get device parameters */
pMailbox->status = APPLET_SUCCESS;
pageSize = AT45_PageSize(&at45);
numPages = AT45_PageNumber(&at45);
/* Program page */
bufferSize = BUFFER_NB_PAGE * pageSize;
pMailbox->argument.outputInit.bufferSize = bufferSize;
pMailbox->argument.outputInit.memorySize = numPages * pageSize;
TRACE_INFO("%s numPages : 0x%x bufferAddr : 0x%x\n\r",
at45.pDesc->name, (unsigned int)numPages, (unsigned int)pMailbox->argument.outputInit.bufferAddress);
}
}
// ----------------------------------------------------------
// WRITE:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_WRITE) {
memoryOffset = pMailbox->argument.inputWrite.memoryOffset;
bufferAddr = pMailbox->argument.inputWrite.bufferAddr;
bytesToWrite = pMailbox->argument.inputWrite.bufferSize;
TRACE_INFO("WRITE at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
(unsigned int)memoryOffset, (unsigned int)bufferAddr,(unsigned int) bytesToWrite);
pBuffer = (unsigned char *) bufferAddr;
tempBufferAddr = bufferAddr + bufferSize;
if ((memoryOffset % pageSize) != 0) {
/* We are not page aligned, retrieve first page content to update it */
memset((unsigned int *)tempBufferAddr, 0xFF, pageSize);
bufferOffset = (memoryOffset % pageSize);
if( (bytesToWrite + bufferOffset) < pageSize) {
packetSize = bytesToWrite;
}
else {
packetSize = pageSize - bufferOffset;
}
memoryOffset -= bufferOffset;
/* Read page to be updated */
AT45D_Read(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
/* Fill retrieved page with data to be programmed */
memcpy((unsigned char *)(tempBufferAddr + bufferOffset), pBuffer, packetSize);
/* Write the page contents */
AT45D_Write(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
bytesToWrite -= packetSize;
pBuffer += packetSize;
memoryOffset += pageSize;
}
/* If it remains more than one page to write */
while (bytesToWrite >= pageSize) {
/* Write the page contents */
AT45D_Write(&at45, pBuffer, pageSize, memoryOffset);
pBuffer += pageSize;
memoryOffset += pageSize;
bytesToWrite -= pageSize;
}
/* Write remaining data */
if (bytesToWrite > 0) {
/* Read previous content of page */
AT45D_Read(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
/* Fill retrieved block with data to be programmed */
memcpy((unsigned char *)tempBufferAddr, pBuffer, bytesToWrite);
/* Write the page contents */
AT45D_Write(&at45, (unsigned char *) tempBufferAddr, pageSize, memoryOffset);
/* No more bytes to write */
bytesToWrite = 0;
}
TRACE_INFO("WRITE return byte written : 0x%x Bytes\n\r",
(unsigned int)(pMailbox->argument.inputWrite.bufferSize - bytesToWrite));
pMailbox->argument.outputWrite.bytesWritten = pMailbox->argument.inputWrite.bufferSize - bytesToWrite;
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// READ:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_READ) {
memoryOffset = pMailbox->argument.inputRead.memoryOffset;
bufferAddr = pMailbox->argument.inputRead.bufferAddr;
bytesToRead = pMailbox->argument.inputRead.bufferSize;
TRACE_INFO("READ at offset: 0x%x buffer at : 0x%x of: 0x%x Bytes\n\r",
(unsigned int)memoryOffset, (unsigned int)bufferAddr, (unsigned int)bytesToRead);
pBuffer = (unsigned char *) bufferAddr;
/* Read packet after packets */
while (((unsigned int)pBuffer < (bufferAddr + bufferSize)) && (bytesToRead > 0)) {
packetSize = min(MAX_COUNT, bytesToRead);
AT45D_Read(&at45, pBuffer, packetSize, memoryOffset);
pBuffer += packetSize;
bytesToRead -= packetSize;
memoryOffset += packetSize;
}
TRACE_INFO("READ return byte read : 0x%x Bytes\n\r",
(unsigned int)(pMailbox->argument.inputRead.bufferSize - bytesToRead));
pMailbox->argument.outputRead.bytesRead = pMailbox->argument.inputRead.bufferSize - bytesToRead;
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// FULL ERASE:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_FULL_ERASE) {
TRACE_INFO("FULL ERASE command\n\r");
memoryOffset = 0;
while (memoryOffset < (pageSize * numPages)) {
/* Erase the page */
AT45D_Erase(&at45, memoryOffset);
memoryOffset += pageSize;
}
TRACE_INFO("Full Erase achieved\n\r");
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// BUFFER ERASE:
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_BUFFER_ERASE) {
TRACE_INFO("BUFFER ERASE command\n\r");
memoryOffset = pMailbox->argument.inputBufferErase.memoryOffset;
while (memoryOffset < (pMailbox->argument.inputBufferErase.memoryOffset + bufferSize)) {
/* Erase the page */
AT45D_Erase(&at45, memoryOffset);
memoryOffset += pageSize;
}
TRACE_INFO("Buffer Erase achieved\n\r");
pMailbox->status = APPLET_SUCCESS;
}
// ----------------------------------------------------------
// CONFIGURE IN BINARY MODE (power of two page size):
// ----------------------------------------------------------
else if (pMailbox->command == APPLET_CMD_BINARY_PAGE) {
TRACE_INFO("BINARY PAGE SET command\n\r");
/* Configure power-of-2 binary page size. */
AT45D_BinaryPage(&at45);
TRACE_INFO("Binary Page achieved\n\r");
pMailbox->status = APPLET_SUCCESS;
}
exit:
/* Acknowledge the end of command */
TRACE_INFO("\tEnd of applet (command : %x --- status : %x)\n\r", (unsigned int)pMailbox->command, (unsigned int)pMailbox->status);
/* Notify the host application of the end of the command processing */
pMailbox->command = ~(pMailbox->command);
if (comType == DBGU_COM_TYPE) {
DBGU_PutChar(0x6);
}
return 0;
}