// Функция вычисления Фурье-преобразования последовательности {X1, X2,...,Xn} через заранее известное // Фурье последовательности {X0,X1,...,Xn-1}
// Re_prev, Im_prev   ---  действительная и мнимая части  Фурье предыдущего такта
// delta1 = (Re(Xn)-Re(X0)), delta2 = (Im(Xn)-Im(X0)), где Xn - следующий за последним, а X0 - начальный отсчеты предыдущего такта

void fourierShiftReduced( double *Re, double *Im, double delta ) {
        // вычитание спектра дельта-импульса
        for( int k = 0; k < fourierLength/2; k++ )
          Re[k] += delta1;
      Im[k] += delta2;

        // сдвиг спектра на 1/N
        double shift = 2 * PI / fourierLength;

        for( int k = 0; k < fourierLength/2; k++ )
        {
          phaseShift( Re[k], Im[k], shift * k );
        }
}

void phaseShift( double &re, double &im, double shift) {
        double a = cos( shift );
        double b = sin( shift );
        double x = a * re - b * im;
        im = b * re + a * im;
        re = x;
}

INFO : Low Level Init : OK
INFO : DDRam init : OK
Init Nand flash
Load CE-BOOT from Flash to DDRAM
D_DirectRead lasted 5 ms for 0x62 bytes (timer granularity is 400)
WARNING : LoadEBootCFG: No valid Eboot configuration found.
INFO : Loading default bootloader settings

Press [ENTER] to download now or [SPACE] to cancel.
Initiating image download in   0 seconds
System ready!
Preparing for download...

INFO: Trying to initialize the internal NIC (EMACB)...
pEmac->EMAC_SA1L=  4090202
pEmac->EMAC_SA1H= 505
Init Emac Ethernet controler
Enter in AT91F_EmacEntry  base = 0xbffbc000
EMACB revision 0x1010c
->Enter in AT91F_EMACInit
Found Phy (DM9161A) at address 0
CONTROL REG : 0x3100
STATUS REG : 0x7849
Autonegociation failed
ERROR: Failed to initialize EMACB Ethernet controller.
WARNING : No Ethernet link detected... Check the connection !
INFO : Retrying in few seconds. (press <SPACE> or <ENTER> to cancel)
Initiating image download in   0 seconds

//----------------------------------------------------------------------------------------------------
/*! \brief Задача RTX для работы с радиомодемом 1, подключенным к порту uart 0 */
//----------------------------------------------------------------------------------------------------
__task void modem1(void)
{
while(1)
{
RadiomModemSubsystem(RADIO_MODEM_1);
}
}
//----------------------------------------------------------------------------------------------------

//----------------------------------------------------------------------------------------------------
/*! \brief Задача RTX для работы с радиомодемом 2, подключенным к порту uart 2*/
//----------------------------------------------------------------------------------------------------
__task void modem2(void)
{
while(1)
{
RadiomModemSubsystem(RADIO_MODEM_2);
}
}
//----------------------------------------------------------------------------------------------------

static unsigned char Modem1Buffer[BUF_MAX_SIZE] = {0x00};
static unsigned char Modem2Buffer[BUF_MAX_SIZE] = {0x00};

void RadiomModemSubsystem(unsigned char numModem)
{
unsigned char queue = UNKNOWN_QUEUE;
unsigned char *dataBuf = 0;

switch(numModem)
{
case RADIO_MODEM_1:
queue = MODEM_1_QUEUE;
dataBuf = &Modem1Buffer[0];
break;
case RADIO_MODEM_2:
queue = MODEM_2_QUEUE;
dataBuf = &Modem2Buffer[0];
break;
default:
return;
}
// здесь управление и обмен с модемом
}