Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
SPI.c
- Committer:
- Kovalev_D
- Date:
- 2016-11-18
- Revision:
- 202:c03b7b128e11
- Parent:
- 201:76f4123bf22a
File content as of revision 202:c03b7b128e11:
#include "Global.h" struct SPI Spi; //unsigned int Temp_AMP; unsigned int Temp_AMP64P; int TempShift=1; unsigned int Count_AMP, ADD_AMP, Cur_Amp; int AD_Regul = 0; int temp9,tempADC5; int AD_MAX=0; int k=0,l=0,r=0;//счетчики для регулировки периметра int flagmod=0,Bdelta; int start=1; int flagPLC=0,templm=0; unsigned int Temp_ADC_2; unsigned int Temp_ADC_3; unsigned int Temp_ADC_4; unsigned int Temp_ADC_5; unsigned int TempA; unsigned int TempTermLM; int ADC5Old,ADCDIF=0,ADCDIFconsol=0; int DACModReg; int SinPls=0,SinMns=0; unsigned int ADC5New; unsigned int Buff_ADC_1 [32]; unsigned int Buff_ADC_2 [32]; unsigned int Buff_ADC_3 [32]; unsigned int Buff_ADC_4 [32]; unsigned int Buff_ADC_5 [512]; unsigned int BuffADC_16Point [64]; unsigned int BuffADC_32Point [64]; unsigned int BuffADC_64Point [64]; unsigned int BuffADC_32PointD [64]; unsigned int Buff_Restored_Mod [64]; unsigned int PulseADC_16Point; unsigned int PulseADC_32Point; unsigned int PulseADC_64Point; unsigned int PulseADC_32PointD; unsigned int Buff_AMP [256]; unsigned int Buff_AMP64P [256]; unsigned int TypeMod=0; unsigned int ModArraySin [64] = {50,55,59,64,68,73,77,81,85,88,91,94,96,98,99,99,100,99,99,98,96,94,91,88,85,81,77,73,68,64,59,55,50,45,41,36,32,27,23,19,16,12,9,7,4,2,1,1,0,1,1,2,4,7,9,12,16,19,23,27,32,36,41,45}; unsigned int ModArrayTriangle [64]; unsigned int Mod=0; void InitMOD(void) { for (int i = 0; i < 64; i++ ) { if(i<32) { ModArrayTriangle[i]=Mod; Mod+=3;} else { ModArrayTriangle[i]=Mod; Mod-=3;} } } void Modulator(void) { switch(TypeMod) { case 0: LPC_DAC->DACR = (ModArraySin [CountV64]*Gyro.ModAmp); break; case 2: LPC_DAC->DACR = (ModArrayTriangle [CountV64]*Gyro.ModAmp); break; } } void PLCRegul(void) { if(Gyro.Start==200) {// +25 С° if(flagPLC==0) { //Spi.DAC_B=32767; templm = (Gyro.TermoNKU-Gyro.Termo); //дельта температуры от нку Spi.DAC_B+=templm; //сдвиг начальной точки цап flagPLC=1;//выставка флага для начала регулирования } } if(Gyro.LogPLC)//Gyro.LogPLC=1-без выдачи, 2 - с выдачей, 0 - дисперсионка. { if(flagPLC) { if (CountV64 == 63) //прошло 2 такта виброподвеса 200Hz { for (int i = 0; i < 31; i++ )//считаем сумму амплитуд по положительной полуволне { SinPls+= BuffADC_64Point[i]; } for (int i = 32; i < 63; i++ ) { SinMns+= BuffADC_64Point[i];//по отрицательной полуволне } ADCDIF = SinPls - SinMns; // разница между полуволнами /* if(ADCDIF>0) Spi.DAC_B-=3; else Spi.DAC_B+=3;*/ Spi.DAC_B -= ADCDIF>>9;// регулировка периметра в зависимости от величины разници двух полуволн. ADCDIFconsol+=ADCDIF>>9; if ( Spi.DAC_B < 15300 ) Spi.DAC_B = 32000; //проверка на переваливание за границу. else if ( Spi.DAC_B > 53000 ) Spi.DAC_B = 32000; SinPls=0; SinMns=0; } } } } void ADS_Acum(void) { Spi.ADC_NewData = 0; Gyro.Termo = Spi.ADC1; Gyro.In1 = Spi.ADC2; Gyro.In2 = Spi.ADC3; Gyro.DeltaT = Spi.ADC4; TempA = (0xffff - Spi.ADC5); // перевернем знак и умножим на два (было 32000...0 стало 0 ...32000 /*сдвиг(<<1) стало 0 ...64000*/) TempTermLM = Spi.ADC1; Gyro.ADF_Accum += TempA; Gyro.ADS_Accum += TempA; Gyro.ADS_AccumTermLM+=TempTermLM; Gyro.ADF_Count ++; Gyro.ADS_Count ++; if (Gyro.ADF_Count > 15) { // если прошло 16 тактов виброподвеса Gyro.AD_Fast = Gyro.ADF_Accum << 11; //обновляем данные и приводим в один масштаб Gyro.ADF_Count = 0;// Gyro.ADF_Accum = 0; Gyro.ADF_NewData = 1; } if (Gyro.ADS_Count > 255) { // если прошло 256 тактов виброподвеса Gyro.AD_Slow = Gyro.ADS_Accum << 7; //обновляем данные и приводим в один масштаб Gyro.TermLM = Gyro.ADS_AccumTermLM << 3; Gyro.ADS_Count = 0; Gyro.ADS_Accum = 0; Gyro.ADS_AccumTermLM=0; Gyro.ADS_NewData = 1; } } void SPI_Exchange(void) // новая функция чтения, в нецй не должно быть ничего лишнего { unsigned int DummySPI; // BackLightON ADC5New = LPC_SSP0->DR;// Чтение АЦП //Spi.ADC5_Accum += LPC_SSP0->DR; Spi.ADC4_Accum += LPC_SSP0->DR; Spi.ADC3_Accum += LPC_SSP0->DR; Spi.ADC2_Accum += LPC_SSP0->DR; Spi.ADC1_Accum += LPC_SSP0->DR; Spi.ADC5_Accum += ADC5New; while (LPC_SSP0->SR & RX_SSP_notEMPT) { DummySPI = LPC_SSP0->DR; //если буфер SPI не пуст.//очистить буфер. } DAC_OutPut(); if (CountV31 == 0) { // просто фильтруем по 32 точкам. // выставояем бит, что есть новы данные Spi.ADC1 = Spi.ADC1_Accum >> 5; // подгоотавливаем данные (в той эе сетке) те ADC1 0..65535 Spi.ADC2 = Spi.ADC2_Accum >> 5; Spi.ADC3 = Spi.ADC3_Accum >> 5; Spi.ADC4 = Spi.ADC4_Accum >> 5; Spi.ADC5 = Spi.ADC5_Accum >> 5; Spi.ADC1_Accum = 0; // сбрасывкем аккамулятор Spi.ADC2_Accum = 0; Spi.ADC3_Accum = 0; Spi.ADC4_Accum = 0; Spi.ADC5_Accum = 0; Spi.ADC_NewData = 1; } BuffADC_64Point[CountV64]=ADC5New; Buff_ADC_5[CountV255] = (0x7fff-ADC5New)<<2; PLCRegul(); // BackLightOFF } void ShowMod(void)//технологическая функция для просмотра в ориджине мод на всем диапазпне цап { ////////////////////////////////////////////////////////////////////////////////////////////////// //////////////////////////////////смотрим все моды///////////////////////////////////////////////// /////////////////////////////////////////////////////////////////////////////////////////////////// if( (Gyro.PLC_Lern<60000)&&(Gyro.PLC_Error2Mode >1))//пробигаем по нескольким значениям цап(60*0х3с=0хВВ8) для определения максимальной амплитуды. { Gyro.PLC_Error2Mode--; Gyro.PLC_Lern++; Spi.DAC_B += 40; } else {Gyro.LogPLC=1;} sprintf((Time),"%d %d %d %d \r\n", Gyro.CuruAngle, Spi.DAC_B, Gyro.AD_Slow, Gyro.Termo); Gyro.CuruAngle=0; WriteCon(Time); } /* void ShowMod(void)//технологическая функция для просмотра в ориджине мод на всем диапазпне цап { ////////////////////////////////////////////////////////////////////////////////////////////////// //////////////////////////////////смотрим все моды///////////////////////////////////////////////// /////////////////////////////////////////////////////////////////////////////////////////////////// if(dispersion>5) { if( (Gyro.PLC_Lern<60000)&&(Gyro.PLC_Error2Mode >1))//пробигаем по нескольким значениям цап(60*0х3с=0хВВ8) для определения максимальной амплитуды. { Gyro.PLC_Error2Mode--; Gyro.PLC_Lern++; Spi.DAC_B += tempstrafe*side; if(side>0)side=(-1); else side = 1; tempstrafe-=40; dispersion=0; } else {Gyro.LogPLC=0;} } else dispersion++; sprintf((Time),"%d %d %d %d \r\n", Gyro.CuruAngle, Spi.DAC_B, Gyro.AD_Slow, Gyro.Termo); Gyro.CuruAngle=0; WriteCon(Time); } */ void PlcRegul(void) //Программа расчет напряжения для модулятора(//выполняется 1.25 микросек.) { int templm=0; int PLC_In; int tempDac; if(start<=5) { if(TempShift) {// +25 С° templm = (Gyro.TermoNKU-Gyro.Termo); //дельта if(templm>0) Gyro.Ktermo=1; else Gyro.Ktermo=0; Spi.DAC_B+=templm; TempShift=0; } } if(!(Gyro.PinReg & PinRegBitL) && (start>0)) start--; else if((start==0)) { PLC_In = Gyro.AD_Slow; //выбираем даные для фильтрации Gyro.PLC_Delta = PLC_In - Gyro.PLC_Old; //узнаем приращение Gyro.PLC_DeltaADD = Gyro.PLC_Delta * Gyro.PLC_ADC_DOld; //приращение с учетом знака (и количества) прошлого приращения Gyro.PLC_Old = PLC_In; //запоминание значения if(Gyro.flagGph_W) { AD_MAX=0; Gyro.flagGph_W--; Gyro.PLC_Error2Mode=3; } //если изменился коэфициент усиления ФД //3600 (размер моды порядка 3000) if((Gyro.PLC_Lern < 150) && (Gyro.PLC_Error2Mode != 0)) { //пробигаем по нескольким значениям цап(60*0х3с=0хВВ8) для определения максимальной амплитуды. if(Gyro.Ktermo)Spi.DAC_B += 0x3c; //добовляем в значение цапа 60 else Spi.DAC_B -= 0x3c; if(AD_MAX < PLC_In){AD_MAX = PLC_In;} //если максимальная амплитуда меньше текущей записываем новую максимальную амплитуду. else if ((AD_MAX>PLC_In)&&(AD_MAX>1550800000)) r++; //если текущая амплитуда меньше максимально найденной то инкрементируем счетчик. if (r>10) { Gyro.PLC_Lern=151; Gyro.PLC_Error2Mode=3; } //если текущая амплитуда меньше максимально найденной в течении 5 тактов то выходим из поиска Gyro.CuruAngle = 0; //не считаем угол пока ищем максивальную амплитуду. } //работает только первые ~30-40 секунд (37 сек). if (Gyro.PLC_Lern<160) Gyro.PLC_Lern++; if(AD_MAX < PLC_In) {AD_MAX = PLC_In; l=0;} //обновление максимального значения амплитуды обнуление счетчика малого понижения амплитуды. else l++; //инкрементируем счетчик малого понижения желаемой амплитуды (максимальной замеченной) if((l > 300)&&(Gyro.PLC_Error2Mode == 0)) {AD_MAX -= 2107200;k=15;l=0;} //если счетчик малого понижения амплитуды больше 100(аммплитуда не обновлялась 100 раз). m if ((k == 15)&&(Gyro.PLC_Lern > 150)) Spi.DAC_B += 75; //после уменьшения максимальной амплитуды двигаем шевелем цап else if((k == 1)&&(Gyro.PLC_Lern > 150)) {Spi.DAC_B -= 75; k=0;l=0;} //для быстрог поиска новог максимума. if(k>0)k--; Gyro.PlC_MaxD=(unsigned int)(AD_MAX-PLC_In); //ищем разницу между желаемой и действительной амплитудами. if(Gyro.ModJump==1) { ///прыжок с моды на моду. (-->) Gyro.OldCuruAngle = Gyro.CuruAngle; Gyro.ModJump=0; Spi.DAC_B += 4300; Gyro.PLC_Error2Mode=1; Gyro.StopCuruAngle=2; } if(Gyro.ModJump==2) { ///прыжок с моды на моду. (<--) Gyro.OldCuruAngle = Gyro.CuruAngle; Gyro.ModJump=0; Spi.DAC_B -= 5250; Gyro.PLC_Error2Mode=1; Gyro.StopCuruAngle=2; } if(Gyro.RgConA&0x8) { // если контур регулирования замкнут if ( Gyro.PLC_Error2Mode > 0) { Gyro.PLC_Error2Mode --; Gyro.PLC_ADC_DOld = 0;} // если ошибка(нахожление в двух модовом) else if ( Gyro.PLC_DeltaADD > 0) { Gyro.PLC_ADC_DOld = 1;} else if ( Gyro.PLC_DeltaADD < 0) { Gyro.PLC_ADC_DOld = -1;} else { Gyro.PLC_ADC_DOld = 1;} } else {Gyro.PLC_Error2Mode = 1; Gyro.PLC_DeltaADD = 0;} ///прыжок с моды на моду. tempADC5=0x7fff-Spi.ADC5; // контур замкнут включен лазер if((Gyro.RgConA&0x8) && (tempADC5>1000)) { if(Gyro.PlC_MaxD>(50<<17)) { // 3 режим регулирования tempDac=(unsigned int)(Gyro.PlC_MaxD>>19); if(tempDac>600) tempDac=600; //ограничение на регулирование если очень большая разница амплитуд Spi.DAC_B += Gyro.PLC_ADC_DOld * tempDac; //новое значение в цап (±1 * значение регулировки) tempDac = Gyro.PLC_ADC_DOld * tempDac; //используется только для выдачи flagmod=3; } else if(Gyro.PlC_MaxD>(12<<17)) { // 2 режим регулирования tempDac=(unsigned int)(Gyro.PlC_MaxD>>19); Spi.DAC_B += Gyro.PLC_ADC_DOld * (tempDac); tempDac = Gyro.PLC_ADC_DOld * (tempDac); //используется только для выдачи flagmod=2; } /* else if(Gyro.PlC_MaxD<(2<<17)) { //режим если дельта равна 0;Gyro.ModJump tempDac=2; Spi.DAC_B += Gyro.PLC_ADC_DOld * tempDac; flagmod=0; } */ else { tempDac=2; // 1 режим регулирования Spi.DAC_B += Gyro.PLC_ADC_DOld *tempDac; tempDac = Gyro.PLC_ADC_DOld * tempDac; flagmod=1; } } if ( Spi.DAC_B < 15300 ) {Spi.DAC_B = 32000; Gyro.PLC_Error2Mode = 5; Gyro.PLC_DeltaADD = 0;} //проверка на переваливание за границу. else if ( Spi.DAC_B > 53000) {Spi.DAC_B = 32000; Gyro.PLC_Error2Mode = 5; Gyro.PLC_DeltaADD = 0;} } if(Gyro.StopCuruAngle) {Gyro.CuruAngle = Gyro.OldCuruAngle; Gyro.StopCuruAngle--;} /////////////////////// //////////лог////////// /////////////////////// if(Gyro.LogPLC==1) { sprintf((Time),"%d %d %d %d %d %d %d %d %d \r\n",Gyro.CuruAngle, Gyro.Frq, Gyro.MaxAmp, Spi.DAC_B, tempDac, flagmod, AD_MAX, PLC_In, Gyro.Termo);//выдаем в терминал для постройки граффика регулировки периметра. Gyro.CuruAngle=0; Gyro.tempdelta=0; Gyro.tempdelta2=0; WriteCon(Time); // } } /* void PlcRegul(void) //Программа расчет напряжения для модулятора { int PLC_In; PLC_In = Gyro.AD_Slow; //выбираем даные для фильтрации // PLC_In = Gyro.AD_Fast; //или+,или-(знак) Gyro.PLC_Delta = PLC_In - Gyro.PLC_Old; // узнаем приращение // (знак) * (то на что инкрементировали цап) Gyro.PLC_DeltaADD = Gyro.PLC_Delta * Gyro.PLC_ADC_DOld; //приращение с учетом знака (и количества) прошлого приращения Gyro.PLC_Old = PLC_In; // запоминание значения if(Gyro.RgConA&0x2) // если включон контур регулирования { if (Gyro.PLC_Error2Mode > 0) {Gyro.PLC_Error2Mode --; Gyro.PLC_ADC_DOld = 0; } // если ошибка(нахожление в двух модовом) else if ( Gyro.PLC_Delta > (3000 * 65536)) {Spi.DAC_B += 2500; Gyro.PLC_Error2Mode = 5; Gyro.PLC_ADC_DOld = 0;} // проверка на двух модовость else if ( Gyro.PLC_Delta < (-3000 * 65536)) {Spi.DAC_B += 2500; Gyro.PLC_Error2Mode = 5; Gyro.PLC_ADC_DOld = 0;} else if (Gyro.PLC_DeltaADD > 0) { // Gyro.PLC_ADC_DOld = (Gyro.PLC_DeltaADD /6553600 )+1; Gyro.PLC_ADC_DOld = 1; } else if (Gyro.PLC_DeltaADD < 0) { // Gyro.PLC_ADC_DOld = (Gyro.PLC_DeltaADD /6553600 )-1; Gyro.PLC_ADC_DOld = -1; } else { Gyro.PLC_ADC_DOld = 1; } } else { Gyro.PLC_Error2Mode = 1; Gyro.PLC_DeltaADD = 0; } Spi.DAC_B += Gyro.PLC_ADC_DOld * 16; if ( Spi.DAC_B < 1000 ) {Spi.DAC_B = 32000; Gyro.PLC_Error2Mode = 5; Gyro.PLC_DeltaADD = 0;} if ( Spi.DAC_B > 63000 ) {Spi.DAC_B = 32000; Gyro.PLC_Error2Mode = 5; Gyro.PLC_DeltaADD = 0;} if(Gyro.LogPLC==1) { sprintf((Time),"%d %d %d %d %d %d\r\n", Spi.DAC_B, temp9,flagmod, AD_MAX, Gyro.AD_Slow, k);//выдаем в терминал для постройки граффика регулировки периметра. WriteCon(Time); } } *//* void PlcRegul_old(void) // на всякий случай { int Delta; ADD_AMP+=Spi.ADC5; Count_AMP++; if(Count_AMP>=(32*32+8)) { Delta = ADD_AMP - Cur_Amp; if(Gyro.RgConA&0x2) { if (Znak_Amp > 1) { Znak_Amp --; } else if ( Delta > 30000000 ) { AD_Regul += 5000000; Znak_Amp = 5; } else if ( Delta < (-3000000)) { AD_Regul += 5000000; Znak_Amp = 5; } else if ((Delta * Znak_Amp) > 0) { Znak_Amp = 1; AD_Regul -= (Delta * Znak_Amp * 10); } else { Znak_Amp = -1; AD_Regul -= (Delta * Znak_Amp * 10); } Spi.DAC_B = (AD_Regul + 0x1fffffff)/65536; } Cur_Amp=ADD_AMP; Count_AMP=0; ADD_AMP=0; } } */ void DAC_OutPut(void)//выдача в цапы { if(Gyro.LogPLC) Modulator(); LPC_SSP0->DR=0x5555; LPC_SSP0->DR=0x5555; LPC_SSP0->DR=0x5555; if (CountV31 & 1) { //если нечетный такт то LPC_SSP0->DR = WRITE_DAC0; //e.команда для ЦАП_0 передавать. LPC_SSP0->DR = (Spi.DAC_A); //e. передача 12 бит } else { //если такт четный. LPC_SSP0->DR = WRITE_DAC1; //e.команда для ЦАП_1 передавать. LPC_SSP0->DR = (Spi.DAC_B); temp9=Spi.DAC_B; } } /* void SPI_Exchange(void) { unsigned int DummySPI; Spi.ADC5 = LPC_SSP0->DR; Spi.ADC4 = LPC_SSP0->DR; Spi.ADC3 = LPC_SSP0->DR; Spi.ADC2 = LPC_SSP0->DR; Spi.ADC1 = LPC_SSP0->DR; Input.ArrayIn[2]= Spi.ADC5; DAC_OutPut(); // LPC_DAC->CR = (((SinPLC[CountV64]*35/5)+24300));// модулятор while (LPC_SSP0->SR & RX_SSP_notEMPT) //если буфер SPI не пуст. DummySPI = LPC_SSP0->DR; //очистить буфер. //заполнение буферов еденичных значений АЦП. Buff_ADC_1 [CountV31] = Spi.ADC1; Buff_ADC_2 [CountV31] = Spi.ADC2; Buff_ADC_3 [CountV31] = Spi.ADC3; Buff_ADC_4 [CountV31] = Spi.ADC4; Buff_ADC_5 [CountV255] = Spi.ADC5; // ампл ацп. Temp_AMP64P += Buff_ADC_5[CountV255]; Temp_AMP64P -= Buff_ADC_5[(CountV255-64) & 0xff]; // заполнение буфера накопленых приращений за 8 тактов Buff_AMP64P[CountV255] = (unsigned int) (Temp_AMP64P); Temp_ADC_2 += Buff_ADC_2[CountV31]; Temp_ADC_2 -= Buff_ADC_2[(CountV31-32) & 0xff]; Temp_ADC_3 += Buff_ADC_3[CountV31]; Temp_ADC_3 -= Buff_ADC_3[(CountV31-32) & 0xff]; Temp_ADC_4 += Buff_ADC_4[CountV31]; Temp_ADC_4 -= Buff_ADC_4[(CountV31-32) & 0xff]; Temp_ADC_5 += Buff_ADC_1[CountV255]; Temp_ADC_5 -= Buff_ADC_1[(CountV255-32) & 0xff]; Spi.PLC_NewData=1; }*/