diff --git a/Vinclude/build.h b/Vinclude/build.h index 89aff8b..2808571 100644 --- a/Vinclude/build.h +++ b/Vinclude/build.h @@ -31,7 +31,7 @@ #define CANTORS_ENA // Также можно задействовать USB для CANopen -#define CANTOUSB_ENA +//#define CANTOUSB_ENA //!Режимы работы (состояния ДА sm_ctrl) //! Режим останов diff --git a/Vsrc/SM_Sys.c b/Vsrc/SM_Sys.c index 94fd746..948c5a1 100644 --- a/Vsrc/SM_Sys.c +++ b/Vsrc/SM_Sys.c @@ -205,7 +205,7 @@ void SM_Sys_Fast_Calc(TSM_Sys *p) { global_time.calc(&global_time); cur_par.calc(&cur_par); //Расчет текущих показателей привода - drv_params.sens_type = drv_params.sens_type & 3; //Отсекаем верхнюю часть переменной, там мусор + drv_params.sens_type = drv_params.sens_type & 7; //Отсекаем верхнюю часть переменной, там мусор #ifdef WATCHDOG_ON // Watchdog.feed();//если сторожевой таймер используется, сбрасываем его здесь diff --git a/Vsrc/V_adc.c b/Vsrc/V_adc.c index ba03820..97bb3a6 100644 --- a/Vsrc/V_adc.c +++ b/Vsrc/V_adc.c @@ -104,7 +104,7 @@ void AdcDrv_fast_calc(TAdcDrv *p) { p->IB_temp = ADC->SEQ[0].SFIFO; p->Udc_temp = ADC->SEQ[0].SFIFO; p->T_temp = ADC->SEQ[0].SFIFO; - Debug1 = p->T_temp; + // Очистка FIFO на случай, если почему-то там оказалось больше чем надо значений (бывает после остановки житагом) while (ADC->SEQ[0].SFLOAD) trash = ADC->SEQ[0].SFIFO; @@ -174,7 +174,7 @@ void AdcDrv_slow_calc(TAdcDrv *p) { p->IbGainNom = _IQ16mpy(p->Imeas_b_gain, drv_params._1_I_nom) << 1; p->IcGainNom = _IQ16mpy(p->Imeas_c_gain, drv_params._1_I_nom) << 1; p->UdcGainNom = _IQ16mpy(p->Udc_meas_gain, drv_params._1_Udc_nom) << 4; - p->TGainNom = _IQ16mpy(p->T_meas_gain,_IQ(1.0/100)) << 6; + p->TGainNom = _IQ16mpy(p->T_meas_gain,_IQ(0.05)) << 4; } //! Миллисекундный расчет