123
Fork of LG by
commandset.c
- Committer:
- igor_v
- Date:
- 2016-02-03
- Revision:
- 21:bc8c1cec3da6
- Parent:
- 1:f2adcae3d304
- Child:
- 112:4a96133a1311
File content as of revision 21:bc8c1cec3da6:
#include <string.h> #include "Global.h" #define COMMAND_DEBUG //++++++++++++++++debug++++++++++++++++ extern uint32_t In_Flag; unsigned char BuffTemp1[100]; //e. +++++++++++++++++++ variables +++++++++++++++++++++++++++++++++++++++++++ //r. +++++++++++++++++++ переменные +++++++++++++++++++++++++++++++++++++++++++ uint32_t CMD_Mode = 0; //e. operation mode of the device //r. режим работы устройства uint32_t CMD_Code; //e. full code of the last recieved command //r. полный код последней принятой команды uint32_t wrk_period; //e. run period in cycles //r. рабочий период в циклах uint32_t blt_in_test; int32_t ScopeMode; //e. mode of display for a control point of an scope //r. режим отображения для контрольной точки осциллографа void SetSpeedPeriod(void) //e.============ procedure of set of rate and periodicity of answer ======== //r.============ процедура установки скорости и периодичности ответа ======== { if ((rcv_buf[3] & 0x0080) != 0) { //e. is periodic data transmission needed? //r. периодическая передача трубуется? trm_cycl = 1; //e. yes, set present flag //r. да, установить данный флаг } else { trm_cycl = 0; //e. no, reset present flag //r. нет, сбросить данный флаг } SRgR &= 0xffcf; //e. clear the bit of transfer rate //r. очистка бит скорости передачи trm_rate = (rcv_buf[3] >> 1) & 0x0030; SRgR |= trm_rate; //e. set present transfer rate //r. установить данную скорость передачи } // SetSpeedPeriod void B_Delta_BINS(void) //r.===процедура выдачи накопленных разностей счетчиков импульсов в ИНС в формате 14.18 { Valid_Data = 0; // reset all bits of status word num_of_par = 2; //e. 2 parameters output //r. выводить 2 параметра addr_param[0] = &Output.Str.BINS_dif; //e. set the first parameter address //r. задать адрес первого параметра addr_param[1] = &Valid_Data; //e. set the second paremeter address //r. задать адрес второго параметра size_param[0] = 4; //e. the length of the 1st parameter is 4 bytes //r. параметр 1 имеeт длину 4 байта size_param[1] = 1; //e. the length of the 2nd parameter is 1 byte (!! - the high byte, instead of low is transmitted) //r. параметр 2 имеет длину 1 байт (!!! передается старший байт, а не младший) trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // B_Delta_BINS void B_Delta_SF(void) //r.=== процедура для измерения масштабного множителя { //e. time for data transfer has come, we work only with dither counters //r. пришло время передавать данные, работаем только с вибро-счетчиками RgConB = RATE_VIBRO_1; //e. set in the additional register of device control the mode of work with dither counters and the filter of moving average //r. устанавливаем в дополнительном регистре управления режим работы с вибросчетчиками и фильтром скользящего среднего Valid_Data = 0; // reset all bits of status word num_of_par = 5;//8; //e. 8 parameters output //r. выводить 8 параметра addr_param[0] = &Output.Str.SF_dif; //e. set the first parameter address //r. задать адрес первого параметра addr_param[1] = &Out_main_cycle_latch; //e. set the second paremeter address //r. задать адрес второго параметра addr_param[2] = &Out_T_latch;//F_ras; addr_param[3] = &Output.Str.WP_reg; addr_param[4] = &Output.Str.Tmp_Out; size_param[0] = 8; //e. the length of the 1st parameter is 4 bytes //r. параметр 1 имеeт длину 4 байта size_param[1] = 4; //e. the length of the 2nd parameter is 1 byte (!! - the high byte, instead of low is transmitted) //r. параметр 2 имеет длину 1 байт (!!! передается старший байт, а не младший) size_param[2] = 2; size_param[3] = 2; size_param[4] = 12; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // B_Delta_SF void B_Delta_PS_execution(void) { static void * paramTable[11] = {&(Output.Str.F_ras) , &(Output.Str.HF_reg), &(Output.Str.T_Vibro), &(Output.Str.L_Vibro), &(Output.Str.WP_reg), &(Output.Str.Tmp_Out[0]), &(Output.Str.Tmp_Out[1]), &(Output.Str.Tmp_Out[2]), &(Output.Str.Tmp_Out[3]), &(Output.Str.Tmp_Out[4]), &(Output.Str.Tmp_Out[5])}; static uint32_t val, paramTmpWord; static uint32_t * ptr; static uint32_t index = 0; if ((index & 1) == 0) { // high byte ptr = (uint32_t*)paramTable[index >> 1]; val = *ptr; paramTmpWord = val >> 8; // move it to low byte of word } else { paramTmpWord = val; } paramTmpWord &= 0xFF; paramTmpWord |= index << 8; Valid_Data = 0; // reset all bits of status word num_of_par = 2; //e. 2 parameters output //r. выводить 2 параметра addr_param[0] = &Output.Str.PS_dif; //e. set the first parameter address //r. задать адрес первого параметра addr_param[1] = ¶mTmpWord; size_param[0] = 2; //e. the 1st parameter has 2 bytes length //r. параметр 1 имеeт длину 2 байт size_param[1] = 2; //e. the 2nd and 3rd parameters have 1 bytes length//r. параметры 2,3 имеют длину 1 байт trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика index++; if (index > 21) { index = 0; } } // B_Delta_PS_execution void M_Mirror(void) //e.---------------- prepare to transmission of the copy of receiving buffer ------------- //r.---------------- подготовка передачи копии приемного буфера ------------- { num_of_par = 1; //e. 1 parameter output //r. выводить 1 параметр addr_param[0] = &rcv_copy; //e. set the address of the receiving buffer //r. установка адреса приемного буфера //e. multiply the number of copied words on 2, since each //r. умножить число скопированных слов на 2, т.к. каждое //e. will be trasferred in two steps: first zero, and then //r. будет передаватьсч в два приема: сначала нулевой, а затем size_param[0] = rcv_byt_copy << 1; // multiplay by 2 if (size_param[0] >= 64) { size_param[0] = 64; //e. maximal amount - no more than double length of the copy buffer //r. максимальное количество - не более двойной длины буфера-копии } trm_rate = 0; //e. set the transfer rate to the 38400 bauds //r. установить скорость передачи 38400 бод trm_cycl = 0; //e. forbid cyclic transmission of the parameter //r. запретить передачу параметра в цикле trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // M_Mirror void Mk_Ask1(void) //r.----------------- prepare of the standart answer 1 ---------------------- //r.----------------- подготовка стандартного ответа 1 ---------------------- { CMD_Code &= 0xff00; //e. clear bits of errors //r. очистить в нем поле ошибок num_of_par = 1; //e. total amount parameters in aswer - 1 //r. всего параметров в ответе - 1 addr_param[0] = &CMD_Code; //e. and this parameter - returnable command code //r. и этот параметр - возвращаемый код команды size_param[0] = 2; //e. and both its bytes //r. причем оба его байта trm_ena = 1; //e. allow operation of the transmitter of the device //r. разрешить работу передатчика устройства } // Mk_Ask1 void Mk_AskDev(void) //r.----------------- answer on a command for device mode set ------------ //r.----------------- Ответ на команду установки режима прибора ------------ { num_of_par = 2; //e. 2 parameters output //r. выводить два параметра addr_param[0] = &Device_Mode; //e. address of the counter mode register (intenal latch, external latch, etc.) //r. адрес регистра режима счетчиков (внутр., внешняя защелка и т.д.) addr_param[1] = &SRgR; //e. address of the mode register of the processor card //r. адрес регистра режима платы процессора size_param[0] = 2; //e. size of the counter mode register - 2 bytes //r. размер регистра режима счетчиков - 2 байта size_param[1] = 2; //e. size of the mode register of the processor card //r. размер регистра режима платы процессора trm_cycl = 0; //e. forbid cyclic transmission of the parameter //r. запретить передачу параметра в цикле trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // Mk_AskDev void GLD_Output(void) //e. ----------- Output modes --------- //r. --------- Режимы вывода --------- { if (Latch_Rdy) { //latch appeared if (trm_cycl) trm_ena = 1; //enable packet generation switch (CMD_Mode) { case 1: //e. Delta _PS mode B_Delta_PS_execution(); break; case 5: CMD_Code &= 0xff1f; //e. reset bits of current command code settings of periodicity and transfer rate //r. сбросить в текущем коде команды биты установки периодичности и скорости передачи if (CMD_Code == 0xdd02) { //e. is it the Rate2 mode? //r. это режим Rate2? if (data_Rdy & WHOLE_PERIOD) { trm_ena = 1; } else trm_ena = 0; } break; } } } // GLD_Delta ///// -------- commands ------------------------------------------------------------- //e. set main device operation modes: //r. Установка основных режимов работы прибора: //e. 1. acions with counters (internal latch, external latch with request over line, //r. 1. работа со счетчиками (внутренняя защелка, внешняя защелки с запросом по линии, //e. external latch without request over line (instant answer after receiving of external latch pulse)) //r. внешняя защелка без запроса по линии (ответ сразу после прихода импульса внешн. защелки)) //e. 2. line receiving/transmission rate //r. 2. скорость приема/передачи по линии void B_Dev_Mode(void) { Device_Mode = rcv_buf[3] & 0x00ff; //e. read the byte of command parameter from the receiver buffer //r. считать из буфера приемника байт параметра команды //e. and write it to the counter mode register //r. и записываем в регистр режима счетчиков trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_AskDev(); } // B_Dev_Mode void B_BIT_Mode(void) { uint8_t temp; temp = rcv_buf[3] & 0x000f & (~((rcv_buf[3] & 0x00f0) >> 4)); if (temp == 1) { // 1 - const test Is_BIT = 1; BIT_number = (long)(rcv_buf[4] & 0x00FF) << 24; BIT_number |= (long)(rcv_buf[5] & 0x00FF) << 16; BIT_number |= (long)(rcv_buf[6] & 0x00FF) << 8; BIT_number |= (long)(rcv_buf[7] & 0x00FF); } else { Is_BIT = 0; } trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_AskDev(); } // B_BIT_Mode void M_Stimul(void) //e. === procedure of output of analog (DAC) and digital (flags) stimuluses //r. === процедура вывода аналоговых (ЦАП) и дискретных (флаги) стимулов { uint32_t chan; ScopeMode = 4; //e. WP_PHASE_DETECTOR allocate a mode of display for a control point of an scope //r. WP_PHASE_DETECTOR назначить режим отображения для контрольной точки осциллографа chan = CMD_Code & 0x0007; //e. extracting the number of stimulus //r. выделение номера стимула Output.ArrayOut[chan] = (((int)rcv_buf[4] << 8) | (int)rcv_buf[5])-0x8000; if ((CMD_Code & (1 << 7)) == 0) { //e. to estimate: whether the answer is required //r. оценить: требуется ли ответ return; //e. if no - return //r. если нет - возврат } Mk_Ask1(); //e. otherwise - answer output //r. иначе - выдать ответ } // M_Stymul void M_Status(void) //e. === procedure of initialization of transmission of the device status //r. === процедура инициализации передачи статуса устройства { SetSpeedPeriod(); //e. and set the answer transfer rate and its periodicity //r. и установить скорость передачи ответа и его периодичность num_of_par = 2; //e. 2 parameters output //r. выводить два параметра addr_param[0] = &blt_in_test; //e. the register address of the self-testing result //r. адрес регистра результата самотестирования addr_param[1] = &ser_num; //e. address of the register of errors of line //r. адрес регистра ошибок линии size_param[0] = 2; //e. size of the self-test register - 2 bytes //r. размер регистра самотестирования - 2 байта size_param[1] = 2; //e. size of the register of errors of line //r. размер регистра ошибок линии trm_rate = 0; //e. set the transfer rate to the 38400 bauds //r. установить скорость передачи 38400 бод trm_cycl = 0; //e. forbid cyclic transmission of the parameter //r. запретить передачу параметра в цикле trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // M_Status void M_Clear(void) //e.---------------- cleaning of the register of errors of line -------------------------- //r.---------------- очистка регистра ошибок линии -------------------------- { line_err = 0; } // M_Clear void M_Tmp_W(void) //e.----------------- write the command to the AD7714 IC ------------------------- //r.----------------- запись команды в схемы AD7714 ------------------------- { Mk_Ask1(); } void M_Tmp_R(void) //e.----------------- read the data from the AD7714 IC -------------------------- //r.----------------- чтение данных из схем AD7714 -------------------------- { } // M_Tmp_R void M_ADC_R(void) //e.----------------- read the data from the ADCs ADS1250, ADS8321 --------- //r.----------------- чтение данных из каналов АЦП ADS1250, ADS8321 --------- { SetSpeedPeriod(); //e. set the answer transfer rate and its periodicity //r. установить скорость передачи ответа и его периодичность UART_SwitchSpeed(trm_rate); num_of_par = 4; //e. 4 parameters output //r. выводить четыре параметра addr_param[0] = 0; //e. //r. <!-- использовались для ДУП, теперь не используются addr_param[1] = 0; //e. //r. --> addr_param[2] = 0; addr_param[3] = &(Input.StrIn.HF_out); //e. set the 4th parameter address _HF_out //r. задать адрес четвертого параметра _HF_out size_param[0] = 2; //e. size of the parameters - 2 bytes //r. размер параметров - 2 байта size_param[1] = 2; size_param[2] = 2; size_param[3] = 2; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // M_ADC_R void M_Cnt_R(void) //r.----------------- read the counters of the Elio5 card -------------------------- //r.----------------- чтение счетчиков платы Elio5 -------------------------- { SetSpeedPeriod(); //e. set the answer transfer rate and its periodicity //r. установить скорость передачи ответа и его периодичность UART_SwitchSpeed(trm_rate); num_of_par = 2; //e. 2 parameters output //r. выводить два параметра addr_param[0] = &(Output.Str.Cnt_Pls); //e. set the first parameter address //r. задать адрес первого параметра addr_param[1] = &(Output.Str.Cnt_Mns); //e. set the second paremeter address //r. задать адрес второго параметра size_param[0] = 2; //e. size of the parameters - 2 bytes //r. размер параметров - 2 байта size_param[1] = 2; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // M_Cnt_R /*void M_e5r_W(void) //r.----------------- write to the mode register of the Elio5 card ------------------ //r.----------------- запись в регистр режима платы Elio5 ------------------ { //e. read the byte of command parameter from the receiver buffer //r. считать из буфера приемника байт параметра команды //e. and write it to the card mode register and its copy //r. и записать его в регистр режима платы и в его копию #if !defined COMMAND_DEBUG Copy_e5_RgR = rcv_buf[3]; io_space_write(E5_RGR, Copy_e5_RgR); #endif trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_e5r_W */ /* void M_e5rA_W(void) //e.----- write to the 1st additional mode register of the Elio5 card ---------- //r.----- запись в 1-ый дополнительный регистр режима платы Elio5 ---------- { //e. this command is used for switching a signal on which data counters are latched: //r. эта команда используется для переключения сигнала, по которому защелкиваются //e. on the Reper signal or on Sign Meander //r. информационные счетчики: либо по Reper`у либо по RefMeandr`у //e. read the byte of command parameter from the receiver buffer //r. считать из буфера приемника байт параметра команды //e. and write it to the card mode register and its copy //r. и записать его в регистр режима платы и в его копию Copy_e5_RgRA = rcv_buf[3]; //??? Device_Mode = Copy_e5_RgRA; //e. and write it to the counter mode register //r. и записываем в регистр режима счетчиков #if !defined COMMAND_DEBUG io_space_write(E5_RGRA, Copy_e5_RgRA); #endif trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_e5rA_W */ void M_Ctl_R(void) //r.----------------- reading the control register of the device ----------------- //r.----------------- чтение регистра управления устройства ----------------- { num_of_par = 2; //e. 2 parameters transfer //r. передавать 2 параметра addr_param[0] = &CMD_Code; //e. the first parameter in answer - returned command code //r. первый параметр в ответе - возвращаемый код команды size_param[0] = 2; size_param[1] = 2; //e. two bytes also have control registers //r. два байта имеют также и регистры управления if ((rcv_buf[3] & (1 << 4)) == 0) { //e. is main control register needed? //r. требуется основной регистр управления? addr_param[1] = &RgConA; //e. yes //r. да } else { addr_param[1] = &RgConB; //e. otherwise - load the address of the addititonal register //r. иначе - загрузить адрес дополнительного регистра } CMD_Code &= 0xff10; //e. clear in it bit of errors and byte number //r. сбросить в нем поля ошибок и номера бита trm_ena = 1; //e. allow operation of the transmitter of line //r. разрешить работу передатчика линии } // M_Ctl_R void M_Ctl_M(void) //r.----------------- modification of the control register of the device ------------ //r.----------------- модификация регистра управления устройства ------------ { uint32_t * ptr; uint32_t bit_numb; num_of_par = 2; //e. 2 parameters transfer //r. передавать 2 параметра addr_param[0] = &CMD_Code; //e. the first parameter in answer - returned command code //r. первый параметр в ответе - возвращаемый код команды size_param[0] = 2; size_param[1] = 2; //e. two bytes also have control registers //r. два байта имеют также и регистры управления if ((CMD_Code & (1 << 4)) == 0) { //e. is main control register needed? //r. требуется основной регистр управления? ptr = &RgConA; //e. yes //r. да } else { ptr = &RgConB; //e. otherwise - load the address of the addititonal register //r. иначе - загрузить адрес дополнительного регистра } addr_param[1] = ptr; //e. the second parameter in answer - modified register //r. второй параметр в ответе - модифицированный регистр bit_numb = CMD_Code & 0x000f; //e. extract the number of the changeable bit //r. выделить номер изменяемого бита if ((CMD_Code & (1 << 7)) == 0) { // Is clear bit *ptr &= ~(1 << bit_numb); // yes, clear bit } else { *ptr |= 1 << bit_numb; // no, set bit } CMD_Code &= 0xff10; //e. clear in command bit of errors and byte number //r. сбросить в команде поля ошибок и номера бита trm_cycl = 0; //e. forbid cyclic transmission of the parameter //r. запретить передачу параметра в цикле trm_ena = 1; //e. allow operation of the transmitter of line //r. разрешить работу передатчика линии } // M_Ctl_M void M_Flg_R(void) //e.------------ reading the register of input flags --------------------------- //r.------------ чтение регистра входных флагов --------------------------- { num_of_par = 1; //e. 1 parameter output //r. выводить один параметр addr_param[0] = &In_Flag; //e. the address of the flag register copy //r. адрес копии регистра флагов size_param[0] = 2; //e. size of the buffer - 2 bytes //r. размер буфера - 2 байта trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // M_Flg_R void M_Vib_W(void) //r.------------ set the oscillation period of the dither drive ----------------- //r.------------ установка периода колебаний вибропривода ----------------- { ScopeMode = 1; //e. VB_PHASE_DETECTOR allocate a mode of display for a control point of an scope //r. VB_PHASE_DETECTOR назначить режим отображения для контрольной точки осциллографа Output.Str.T_Vibro = (rcv_buf[4] << 8) | (rcv_buf[5] & 0xFF); //e. new variable of the period //r. новая переменная периода /* sprintf(BuffTemp1, "\n\r F = %d ", Output.Str.T_Vibro); SendToBuff(BuffTemp1,15);*/ Output.Str.L_Vibro= (rcv_buf[6] << 8) | (rcv_buf[7] & 0xFF); //e. new variable of the pulse width //r. новая переменная длительности импульсов /*sprintf(BuffTemp1, "\n\r L = %d ", Output.Str.L_Vibro); SendToBuff(BuffTemp1,15);*/ VibroDither_Set(); //e. and output its value to period registers on card //r. вывести ее значение в регистры периода на плате trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_Vib_W void M_Gph_W(void) //e.------------ set the gain factor of photodetector channels ------------------- //r.------------ установка усиления каналов фотоприемника ------------------- { Device_blk.Str.Gain_Ph_A = rcv_buf[4]; //e. read from the receiver buffer the value of the gain factor of the A channel //r. считать из буфера приемника значение усиления канала А Device_blk.Str.Gain_Ph_B = rcv_buf[5]; //e. read from the receiver buffer the value of the gain factor of the B channel //r. считать из буфера приемника значение усиления канала В Out_G_photo(Device_blk.Str.Gain_Ph_A, Device_blk.Str.Gain_Ph_B); //e. display these values to digital potentiometers //r. вывести эти значения в цифровые потенциометры trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_Gph_W void M_Rate(void) //e.------------ start of transfer of the M_Rate parameters stack ------------------- //r.------------ запуск передачи набора параметров M_Rate ------------------- { uint8_t mode; SetSpeedPeriod(); //e. set the answer transfer rate and its periodicity //r. установить скорость передачи ответа и его периодичность UART_SwitchSpeed(trm_rate); mode = rcv_buf[3] & 0x001f; //e. extract number of the parameters stack in the command //r. выделить номер набора параметров в команде switch (mode) { case 1: //e. it is the Rate stack //r. это набор Rate RgConB = RATE_REPER_OR_REFMEANDR; //e. counter latch every vibro period SwitchRefMeandInt(RATE_REPER_OR_REFMEANDR); //e. enable reference meander interrupt wrk_period = 12500000; //e. load needed length of working period 1 с.//r. загрузить требуемую длительность рабочего периода 1 с. num_of_par = 14; //e. 9 parameters or groups of parameters output //r. выводить 9 параметров или групп параметров Valid_Data = 0; // reset all bits of status word addr_param[0] = &(Output.Str.Cnt_Pls); //e. set the address of the 1st parameter in the 1st group //r. задать адрес первого параметра в 1-ой группе addr_param[1] = &(Output.Str.Cnt_Mns); //e. set the address of the 1st parameter in the 2nd group //r. задать адрес первого параметра в 2-ой группе addr_param[2] = &(Output.Str.Cnt_Dif); //e. set the address of the 1st parameter in the 3rd group //r. задать адрес первого параметра в 3-ой группе addr_param[3] = &(Output.Str.F_ras); //e. set the address of the _F_ras parameter in the 4th group //r. задать адрес параметра _F_ras во 4-ой группе addr_param[4] = &(Output.Str.HF_reg); //e. set the address of the _HF_reg parameter in the 5th group //r. задать адрес параметра _HF_reg в 5-ей группе addr_param[5] = &(Output.Str.HF_dif); //e. set the address of the _HF_dif parameter in the 6th group //r. задать адрес параметра _HF_dif в 6-ой группе addr_param[6] = &(Output.Str.T_Vibro); //e. parameter _T_Vibro //r. параметр _T_Vibro addr_param[7] = &(Output.Str.T_VB_pll); //e. parameter _T_VB_pll //r.параметрв _T_VB_pll addr_param[8] = &(Output.Str.L_Vibro); //e. parameter _L_Vibro //r. параметр _L_Vibro addr_param[9] = &(Input.StrIn.HF_out); //e. set the address of the _RI_reg parameter in the 8th group //r. задать адрес параметра _RI_reg в 8-ой группе addr_param[10] = &(Output.Str.WP_reg); //e. parameters: _WP_reg, _WP_pll //r. параметров _WP_reg, _WP_pll addr_param[11] = &(Output.Str.WP_pll); //e. parameters: _WP_reg, _WP_pll //r. параметров _WP_reg, _WP_pll addr_param[12] = &(Output.Str.Tmp_Out); //e. set the address of the temperature sensors array //r. задать адрес массива датчиков температуры addr_param[13] = &(Output.Str.WP_scope1); //e. reserved //r. зарезервировано для дальнейших применений size_param[0] = 2; //e. groups 1-6, 8-10 consists of one parameter ... //r. группы 1-6, 8-10 содержат по одному параметру size_param[1] = 2; //e. and have 2 bytes length each //r. и имеют длину 2 байта каждая size_param[2] = 2; size_param[3] = 2; size_param[4] = 2; size_param[5] = 2; size_param[6] = 2; size_param[7] = 2; size_param[8] = 2; size_param[9] = 2; size_param[10] = 2; size_param[11] = 2; size_param[13] = 4; //e. the 11th group parameters has length of 4 bytes //r. 11-z группа параметров имеет длину 4 байта size_param[12] = 12; //e. format o the GLD array of temperatures - 12 bytes //r. формат массива температур ГЛД - 12 байт trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика break; case 2: //e. it is the Rate2 stack //r. это набор Rate2 RgConB = RATE_REPER_OR_REFMEANDR; SwitchRefMeandInt(RATE_REPER_OR_REFMEANDR); //e. enable interrupt from ref. meander wrk_period = 0; //e. frequency of output = fvibro //r. частота вывода равна частоте ВП num_of_par = 2; //e. 2 parameters output //r. выводить 2 параметра addr_param[0] = &(Output.Str.Cnt_Pls); //e. set the first parameter address //r. задать адрес первого параметра addr_param[1] = &(Output.Str.Cnt_Mns); //e. and the 2nd //r. и второго size_param[0] = 2; //e. parameters has 2 bytes length //r. параметры имеет длину 2 байта size_param[1] = 2; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика break; case 3: //e. it is the Rate3 stack //r. это набор Rate3 wrk_period = 2500; //e. frequency of output = 10000 Hz //r. n=1, частота вывода = 10000 Hz num_of_par = 2; //e. 2 parameters output //r. выводить 2 параметра addr_param[0] = &(Output.Str.WP_scope1); //e. set the addresses of output parameters //r. задать адреса выводимых параметров addr_param[1] = &(Output.Str.WP_scope2); size_param[0] = 2; //e. all parameters has 2 bytes length //r. все параметры имеют длину 2 байта size_param[1] = 2; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика break; case 4: //e. it is the Rate4 stack //r. это набор Rate4 wrk_period = 20000; //e. correspond to output frequency 1.25 kHz //r. соотвествует частоте вывода 1.25 kHz num_of_par = 4; //e. 4 parameters output //r. выводить 4 параметра //e. set the addresses of output parameters //r. задать адреса выводимых параметров // --- raw data array of numbers --- // addr_param[0] = &Dif_Curr_Array; // --- filtered array of numbers --- // addr_param[1] = &Dif_Filt_Array; // --------------------------------- addr_param[2] = &(Output.Str.HF_reg); //e. HFO regulator //r. напряжение ГВЧ addr_param[3] = &(Output.Str.WP_reg); //e. CPLC heater regulator //r. напряжение нагревателя size_param[0] = 16; size_param[1] = 32; size_param[2] = 2; size_param[3] = 2; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика break; case 7: wrk_period = 20000; //e. correspond to output frequency 1250 Hz //r. соотвествует частоте вывода 1.25 kHz num_of_par = 5; //e. 4 parameters output //r. выводить 5 параметра //e. set the addresses of output parameters //r. задать адреса выводимых параметров // --- raw data array of PLC phase --- addr_param[0] = &(Output.Str.WP_Phase_Det_Array); // --- filtered array of reference sin--- addr_param[1] = &(Output.Str.WP_sin_Array); // --------------------------------- addr_param[2] = &(Output.Str.WP_reg); //e. CPLC heater regulator //r. напряжение нагревателя addr_param[3] = &(Output.Str.WP_pll); //e. CPLC phase //r. фаза addr_param[4] = &(Output.Str.HF_reg); //e. set the address of the _HF_reg parameter in the 5th group //r. задать адрес параметра _HF_reg в 5-ей группе size_param[0] = 16; size_param[1] = 16; size_param[2] = 2; size_param[3] = 2; size_param[4] = 2; trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика break; } SetIntLatch(wrk_period); } // M_Rate void M_Reset(void) { while(1); } // will not achieve void M_Param_R(void) //e. ------------ read the parameter of the GLD from the data memory ---------------------- //r.------------ чтение параметра GLD из памяти данных ---------------------- { num_of_par = 1; //e. 1 parameter output //r. выводить один параметр addr_param[0] = (void *)(&Device_blk.Str.My_Addres + rcv_buf[3]); //e. address of the needed parameter in the block //r. адрес требуемого параметра в блоке size_param[0] = 2; //e. size of the buffer - 2 bytes //r. размер буфера - 2 байта trm_ena = 1; //e. allow operation of the transmitter //r. разрешить работу передатчика } // M_Param_R void M_Param_W(void) //e.------------ write the parameter of the GLD from the data memory ----------------------- //r.------------ запись параметра GLD в память данных ----------------------- { int * ptr; ScopeMode = 0; //e. VB_DELAY_MEANDER allocate a mode of display for a control point of an scope //r. VB_DELAY_MEANDER назначить режим отображения для контрольной точки осциллографа ptr = (int *)&Device_blk.Str.My_Addres; // pointer to Parameters block ptr += rcv_buf[3]; // calculate offset *ptr = (rcv_buf[4] << 8) | (rcv_buf[5] & 0xFF); // write new parameter value trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_Param_W void M_LdPar_F() //e.============ procedure for load the GLD parameters from the flash-memory =========== //r.============ процедура загрузки параметров ГЛД из флэш-памяти =========== { LoadFlashParam(FromFLASH); //e. load the GLD parameters from the flash-memory //r. загрузить параметры ГЛД из фдэш-памяти blt_in_test = ((uint32_t)FIRMWARE_VER << 8) | (Device_blk.Str.Device_SerialNumber & 0x00FF); // Init_software(); trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_LdPar_F void M_LdPar_D(void) //e.============ procedure for set parameters of the GLD by default ============ //r.============ процедура установки параметров ГЛД по умолчанию ============ { #if !defined COMMAND_DEBUG LoadFlashParam(ByDefault); //e. define parameters of the GLD by default //r. определить параметры ГЛД по умолчанию (default) Init_software(); #endif trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_LdPar_D void M_Start(void) //e.============ initialization of the GLD switch on ================================= //r.============ инициализация запуска ГЛД ================================= { start_Rq = 1; //e. set the flag of the GLD switch on request //r. установить флаг запроса старта ГЛД trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_Start void M_Stop(void) //e.============ initialization of the GLD switch off ============================== //r.============ инициализация выключения ГЛД ============================== { stop_Rq = 1; //e. set the flag of the GLD switch off request //r. установить флаг запроса выключения ГЛД trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_Stop void M_Pulse(void) //e.============ generetion of the light-up pulse ========================= //r.============ генерация импульса запуска лазера ========================= { pulse_Rq = 1; //e. set the flag of the GLD switch on request //r. установить флаг запроса старта ГЛД trm_cycl = 0; //e. periodic data transmission is not needed //r. периодическая передача ответа не требуется Mk_Ask1(); } // M_Pulse void B_Rate(void) //e. === procedure of device operation in a mode of continuous output of raw data //r. === процедура работы прибора в режиме непрерывной выдачи "сырых" данных { } // B_Rate void B_Delta(void) //e. === procedure not used //r. === процедура не используется { } // B_Delta void D_Period_W(void) //e. === set the period of the angle increase output //r. === установка периода выдачи приращения угла { } // D_Period_W // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ void exec_CMD(void) //e. === the final decoding and command execution procedure //r. === процедура окончательной дешифрации и исполнения команды { uint32_t wcode; rx_buf_copy = 1; //e. initialization of the flag of copying of receiving buffer //r. предустанов флага копирования приемного буфера wcode = (rcv_buf[2] & 0xFF) << 8; CMD_Code = wcode | (rcv_buf[3] & 0xFF); //e. save it in the memory for echo-transmission //r. сохранить его в памяти для обратной передачи if (wcode == CMD_RATE) { //e. is it Rate command? //r. это команда Rate? B_Rate(); return; } else if (wcode == CMD_DEV_MODE) { //e. is it the Device_Mode command? //r. это команда установки режима прибора? CMD_Mode = 3; B_Dev_Mode(); return; } else if (wcode == CMD_DELTA_BINS) { //e. is it the B_DeltaBINS command (command of request for data transfer to the navigation system)? //r. это команда запроса передачи данных в навиг.систему? RgConB = RATE_VIBRO_1; //e. set in the additional register of device control the mode of work with dither counters and the filter of moving average //r. устанавливаем в дополнительном регистре управления режим работы с вибросчетчиками и фильтром скользящего среднего SetSpeedPeriod(); UART_SwitchSpeed(trm_rate); CMD_Mode = 4; B_Delta_BINS(); return; } else if (wcode == CMD_DELTA_PS) { //e. is it the B_DeltaPS command (command of request for data transfer to the uPC)? //r. это команда запроса передачи данных в MkPC? SetSpeedPeriod(); //e. and set the answer transfer rate and its periodicity //r. и установить скорость передачи ответа и его периодичность (_trm_cycl) UART_SwitchSpeed(trm_rate); if (Device_Mode < 4) //e. work with internal latch Device_Mode = DM_INT_LATCH_DELTA_PS; else Device_Mode = DM_EXT_LATCH_DELTA_PS_PULSE; CMD_Mode = 1; // B_Delta_PS(); return; } else if (wcode == CMD_DELTA_SF) { // is it the B_DeltaSF command? SetSpeedPeriod(); //e. and set the answer transfer rate and its periodicity //r. и установить скорость передачи ответа и его периодичность (_trm_cycl) CMD_Mode = 7; if ((rcv_buf[3] & 0x0001) != 0) //e.reset of accumulated number is disabled //r. сброс накопленного между защелками числа запрещен Ext_Latch_ResetEnable = 0; else Ext_Latch_ResetEnable = 1; B_Delta_SF(); return; } else if (wcode == CMD_BIT_MODE) { //e. is this the BIT mode command? //r. это команда тестирования? CMD_Mode = 6; //e. set the value of the Delta mode//r. установить значение режима Delta B_BIT_Mode(); return; } else if (wcode == CMD_DELTA) { //e. is this the B_Delta command? //r. это команда B_Delta? CMD_Mode = 2; //e. set the value of the Delta mode//r. установить значение режима Delta B_Delta(); //e. output calculated value of angle increase //r. выводить вычисленное значение приращения угла return; } else if (CMD_Code == CMD_MAINT) { //e. is this the Maintenance mode command? //r. это команда Maintenance mode? if (!RgConB) { RgConB = RATE_VIBRO_1; SwitchRefMeandInt(RATE_VIBRO_1); //e. disable interrupt from referense meander } CMD_Mode = 5; //e. yes, switch on present mode //r. да, включить данный режим M_Status(); //e. output the status stack of registers //r. вывести статусный набор регистров if (Device_Mode != DM_INT_10KHZ_LATCH) { //e. mode of internal latch 10 kHz //r. режим внутренней защелки 10 кГц Device_Mode = DM_INT_10KHZ_LATCH; trm_ena = 0; } else UART_SwitchSpeed(trm_rate); return; } else if (wcode == SUBCMD_M_RESET) { //e. is this subcommand for modification of the device control register? //r. это подкоманда модификации регистра управления у-ва? // Mk_AskDev(); M_Reset(); return; } else { // subcommand analyse if (CMD_Mode == 2) { //e. is this the 2(Delta) mode? //r. это режим 2? (Delta) if (CMD_Code == CMD_D_PERIOD_W) { //e. the Delta mode, check the subcommand ... //r. режим DElta, проверить подкоманду загрузки периода D_Period_W(); //e. otherwise - set the data transfer period //r. иначе установитиь период выдачи данных return; } else { line_sts = line_sts | CODE_ERR; // invalid command code return; } } else if (CMD_Mode == 5) { //e. check the 5 mode (Maintenance) //r. проверка режима 5 (Maintenance) if (CMD_Code == SUBCMD_M_CLEAR) { //e. is this subcommand of cleaning of the error register? //r. это подкоманда очистки регистра ошибок линии? M_Clear(); //e. yes, cleaning the error register //r. да, очистка регистра ошибок M_Status(); //e. preparing for trabsfer of the device status //r. подготовка передачи статуса устройства UART_SwitchSpeed(trm_rate); return; } else if (CMD_Code == SUBCMD_M_MIRR) { //e. is this subcommand of return of previous command? //r. это подкоманда возврата предыдущей команды? rx_buf_copy = 0; //e. yes, forbid copying of command on saving previous //r. да, запретить копирование команды для сохранения предыдущей M_Mirror(); //e. prepare transfer of the receiving buffer copy //r. подготовить передачу копии приемного буфера return; } /* else if (wcode == SUBCMD_M_TMP_W) //e. is this subcommand for writing instructions to the AD7714? //r. это подкоманда записи инструкций в AD7714? { // M_Tmp_W(); //e. yes, procedure call of write of the command //r. да, вызов процедуры записи команды return; } */ else if (wcode == SUBCMD_M_TMP_R) { //e. is this subcommand for data read from the AD7714? //r. это подкоманда чтения данных из AD7714? M_Tmp_R(); //r. yes, call the procedure for data read //e. да, вызов процедуры чтения данных return; } /* else if (wcode == SUBCMD_M_E5R_W) //e. is this subcommand for write to the mode register? //r. это подкоманда записи в регистр режима? { M_e5r_W(); //e. yes, write data to the mode register of the Elio5 card //r. да, записать данные в регистр режима платы Elio5 return; } else if (wcode == SUBCMD_M_E5RA_W) //e. is this subcommand for write to the mode register? //r. это подкоманда записи в регистр режима? { M_e5rA_W(); //e. yes, write data to the mode register of the Elio5 card //r. да, записать данные в регистр режима платы Elio5 return; } */ else if (wcode == SUBCMD_M_ADC_R) { //e. is t the subcommand for data read from ADCs ADS1250 and ADS8321 ? //r. это подкоманда чтения данных из АЦП ADS1250 и ADS8321? M_ADC_R(); //e. read of ADC channels //r. чтение каналов АЦП return; } else if (wcode == SUBCMD_M_CNT_R) { //e. is this subcommand of data read from pulse counters? //r. это подкоманда чтения данных из счетчиков импульсов? M_Cnt_R(); //e. read of counters //r. чтение счетчиков return; } else if (wcode == SUBCMD_M_FLG_R) { //e. is it the command of data read about input flags? //r. это подкоманда чтения данных о входных флагах? M_Flg_R(); //e. read the input flags //r. читать входные флаги return; } else if (wcode == SUBCMD_M_VIB_W) { //e. is this subcommand for load the dither drive period? //r. это подкоманда загрузки периода вибропривода? M_Vib_W(); //e. set the new value of the period //r. установить новое значение периода return; } else if (wcode == SUBCMD_M_GPH_W) { //e. is this subcommand for set the gain factor of photodetector channels? //r. это подкоманда установки усиления каналов фотоприемника ? M_Gph_W(); //e. set the new values of gain factor //r. установить новые значения усиления return; } else if (wcode == SUBCMD_M_STIMUL) { //e. is this subcommand for set the values of the DACs and flags? //r. это подкоманда установки значения ЦАПов и фдагов ? M_Stimul(); //e. set the new values //r. установить новые значения return; } else if (wcode == SUBCMD_M_RATE) { //e. is this subcommand for set the M_Rate output stack //r. это подкоманда установки выдачи набора M_Rate ? M_Rate(); //e. switch on the M_Rate data transfer //r. включить передачу данных M_Rate return; } else if (wcode == SUBCMD_M_PARAM_W) { //e. is this subcommand for write the new value of the GLD parameter ... //r. это подкоманда записи нового значения параметра GLD M_Param_W(); //e. write the new value of the parameter //r. записать новое значение параметра return; } else if (wcode == SUBCMD_M_PARAM_R) { //e. is this subcommand for read the value of the GLD parameter? //r. это подкоманда чтения значения параметра GLD? M_Param_R(); //e. read the value from the data memory //r. считать значение параметра из памяти даных return; } else if (CMD_Code == SUBCMD_M_LDPAR_F) { //e. is this subcommand for load GLD parameters ... //r. это подкоманда загрузки параметров GLD M_LdPar_F(); //e. start the loading of parameters //r. запустить загрузку параметров return; } else if (CMD_Code == SUBCMD_M_LDPAR_D) { //e. is this subcommand for direct setting of the GLD parameters ... //r. это подкоманда прямого назначения параметров GLD M_LdPar_D(); //e. read the value of the parameter from the data memory //r. считать значение параметра из памяти даных return; } else if (CMD_Code == SUBCMD_M_START) { //e. is this subcommand for GLD starting? //r. это подкоманда запуска GLD? M_Start(); //e. call the procedure of start //r. запустить процедуру старта return; } else if (CMD_Code == SUBCMD_M_PULSE) { //e. is this subcommand for GLD starting? //r. это подкоманда запуска GLD? M_Pulse(); //e. call light-up function //r. выдать импульс поджига return; } else if (CMD_Code == SUBCMD_M_STOP) { //e. is this subcommand for GLD switch off? //r. это подкоманда выключения GLD? M_Stop(); //e. otherwise- switch off all regulators and stop device //r. выключить все контуры и остановить прибор return; } else if (wcode == SUBCMD_M_CTL_R) { //e. is this subcommand for read the device control register? //r. это подкоманда чтения регистра управления у-ва? M_Ctl_R(); return; } else if (wcode == SUBCMD_M_CTL_M) { //e. is this subcommand for modification of the device control register? //r. это подкоманда модификации регистра управления у-ва? M_Ctl_M(); return; } /* else if (wcode == SUBCMD_M_RESET) //e. is this subcommand for modification of the device control register? //r. это подкоманда модификации регистра управления у-ва? { M_Reset(); return; }*/ else { line_sts = line_sts | MODE_ERR; // mode error return; } } } } // exec_CMD void decode_CMD(void) { int size; if (!rcv_Rdy) { //e. is data in receive buffer? //r. в приемном буфере есть информация? return; //e. if no, stop processing //r. если нет, закончить обработку } if (!line_sts) { //e. Whether there were errors of receiving of start-bit? //r. были ли ошибки приема старт-бита ? //e. there were not errors of receiving of bytes, check the device address //r. ошибок приема байтов не было, проверить адрес обращения //Is_Brodcast_Req = 0; //e. reset the flag of broadcasting request //r. сбросить флаг широковещательного запроса if (rcv_buf[1] != Device_blk.Str.My_Addres) { if (rcv_buf[1] != BROADCAST_ADDRESS) { goto end; } } if (rcv_buf[0] == COMMAND_PREFIX) { //e. there is new command in the receiver buffer, stop the transfer //r. в буфере приемника есть новая команда, прекратить передачу trm_ena = 0; //e. reset the flag of transmission allowing //r. сбросить флаг разрешения передачи //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// exec_CMD(); // шей команды ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// //e. check up presence of errors in operation of this procedure //r. проверить, наличие ошибок в работе данной поцедуры //e. did is the "unknown code of a command" or "parameters were set incorrectly" error? //r. была ошибка "неизвестный код команды" или "неверно заданные параметры"? if ( ((line_sts & CODE_ERR) == CODE_ERR) || ((line_sts & PARAM_ERR) == PARAM_ERR) ) { line_err = line_sts; //e. set error bits in the error register of the line //r. установить биты ошибок в регистре ошибок линии } } else { line_err = line_sts | NO_CMD_ERR; // добавление ошибки в регистр ошибок } } else { line_err = line_sts; } end: if (rx_buf_copy) { //e. is copying of present received packet needed? //r. требуется копирование данного принятого пакета? size = rcv_num_byt; rcv_byt_copy = rcv_num_byt; //e. save the size of copy //r. запомнить размер копии if (rcv_num_byt > sizeof(rcv_buf)) { //e. compare the size of receiving buffer with amount of received bytes //r. копирование требуется, сравнить размер приемного буфера с числом принятых байт size = sizeof(rcv_buf); } memcpy(rcv_copy, rcv_buf, size); //e. copy of received amount of bytes, but no more than buffer size //r. копировать принятое число байт, но не более размера буфера } rx_buf_copy = 0; //e. reset the flag of necessity of copying of receiving buffer //r. сбросить флаг необходимости копирования приемного буфера do rcv_buf[--rcv_num_byt] = 0; while(rcv_num_byt); rcv_num_byt_old = rcv_num_byt; line_sts = 0; //e. reset the line status register //r. сбросить регистр статуса линии rcv_Rdy = 0; //e. allow further data reception //r. разрешить дальнейший прием данных } // decode_CMD