__interrupt void MainPowerFail(void)
{
  asm("cli");
  if ((!drv_pan.drv_on)&&(!drv_tilt.drv_on))   // если тока приводы не включены - значит можно сохранить, а иначе нет смысла
    {Wr_Ee_Int((int)&PanFailPos, drv_pan.pos_pan); //сохраняем данные
     Wr_Ee_Int((int)&TiltFailPos,drv_tilt.pos_tilt);
     Wr_Eeprom((int)&ErrorFlag, (SYSTEM_STATUS|POS_SAVED));
     while (bit_is_set(ACSR, ACO)){}  //ждемс пока питание не восстановится
    }
}

#include "crc.h"
#include "eeprom.h"

//******************************************************************************
// Функция сохраняет данные в еепром с добавлением 2 байт CRC
//******************************************************************************
bool SaveBlock(unsigned short Address, char* Data, unsigned short Size)
{
char Ch;
unsigned short Crc = 0xFFFF;

for (unsigned short Index = 0; Index < Size; Index++)
{
Ch = Data[Index];
__EEPUT(Address + Index, Ch);
Crc = AddCrc16(Ch, Crc);
}
__EEPUT(Address + Size, (unsigned char)Crc);
__EEPUT(Address + Size + 1, (unsigned char)(Crc >> 8));
return true;
}

//******************************************************************************
// Функция читает данные из еепром с контролем 2 байт CRC
//******************************************************************************
bool LoadBlock(unsigned short Address, char* Data, unsigned short Size)
{
char Ch;
unsigned short Crc = 0xFFFF;

for (unsigned short Index = 0; Index < Size; Index++)
{
__EEGET(Ch, Address + Index);
Data[Index] = Ch;
Crc = AddCrc16(Ch, Crc);
}
__EEGET(Ch, Address + Size);
Crc = AddCrc16(Ch, Crc);
__EEGET(Ch, Address + Size + 1);
Crc = AddCrc16(Ch, Crc);
return Crc ? false : true;
}

xSemaphoreHandle EepromLockMutex = NULL;

//******************************************************************************
// Заблокировать интерфейс
//******************************************************************************
void EepromLock()
{
portENTER_CRITICAL();
if(EepromLockMutex == NULL) EepromLockMutex = xSemaphoreCreateMutex();
portEXIT_CRITICAL();
xSemaphoreTake(EepromLockMutex, portMAX_DELAY);
}

//******************************************************************************
// Разблокировать интерфейс
//******************************************************************************
void EepromUnlock()
{
xSemaphoreGive(EepromLockMutex);
}

//******************************************************************************
// Функция загружает конфигурацию из EEPROM в случае успеха возвращает true
//******************************************************************************
bool EepromLoadConfig(USHORT Offset, void* Config, unsigned short Size)
{
bool Ret = true;

Offset = (Offset + 2) * 2;
EepromLock();
if (!LoadBlock(Offset + 0, Config, Size))
if (!LoadBlock(Offset + Size + 2, Config, Size))
Ret = false;
EepromUnlock();
return Ret;
}

//******************************************************************************
// Функция сохраняет конфигурацию в EEPROM в случае успеха возвращает true
//******************************************************************************
bool EepromSaveConfig(USHORT Offset, void* Config, unsigned short Size)
{
Offset = (Offset + 2) * 2;
EepromLock();
SaveBlock(Offset + 0, Config, Size);
SaveBlock(Offset + Size + 2, Config, Size);
EepromUnlock();
return true;
}