|
/******************************************************************************
* DESCRIPTION:
* wait eeprom internal write cicle
*****************************************************************************/
static void wait_EEPROM_wr(void)
{
Bool_t wrDone=FALSE;
MbusStart();
while(!wrDone)
{
if (MbusWr(cMBUS_EE_ADR)==STS_OK)
wrDone = TRUE;
else MbusRStart();
}
MbusStop();};
/******************************************************************************
* DESCRIPTION:
* write eeprom procedure
*****************************************************************************/
static Status_t WriteEEPROM(u16_t adr,void* source,u16_t size) {Status_t res = STS_OK;
u32_t i;
u8_t *src = (u8_t *)source;#ifdef EEPROM_32K
i = 64 - (adr & 0x3F);
#else
/* 64K */
i = 128 - (adr & 0x7F);
#endifwhile((res == STS_OK) && size) {
res = STS_ERROR;
MbusStart();
if ((MbusWr(cMBUS_EE_ADR) == STS_OK) &&
(MbusWr(adr >> 8) == STS_OK) &&
(MbusWr(adr & 0xFF) == STS_OK))
{
do {
if (MbusWr(*src++) != STS_OK) {
break;
}
adr++;
size--;
i--;
} while (size && i);
}
MbusStop();
if (!size || !i)
{
wait_EEPROM_wr();
res = STS_OK;
#ifdef EEPROM_32K
i = 64;
#else
i = 128; // 64K
#endif
}
else
TrmPrintf((pu8_t)"\n FUCK!");
}
return(res);
}
E-mail: info@telesys.ru