motorcontroldemo_035/Vsrc/V_DIO.c
Dmitry Shpak a99491f9b8 Основные обновления в данном коммите:
- проект переведён на VectorIDE v1.3

В целях экономии памяти удалены:
 - модуль управления светодиодами
 - модуль ШИМ для двигателей SRD
 - модуль часов реального времени
 - режим привода для измерения задержки меджу сигналами ШИМ и измерениями токов

Добавлены следующие модули:
 - проект переведён на VectorIDE v1.3
 - модуль SPI для абсолютного ДПР
 - модуль управление реле для заряда ЗПТ
 - модуль дискретных вводов-выводов
 - модуль управления вентилятором Одноплатного Инвертора
 - модуль тормозного резистора Одноплатного Инвертора

Прочие изменения:
 - оптимизирована инициализация регистров периферии
 - удалено множество неиспользуемых переменных
 - разрешение работы всех GPIO перенесено в функцию "PeripheralClockEnable"
 - добавлен счётчик индексной метки энкодера
 - исправлен сброс прерываний модуля захвата CAP
 - переработан режим задания постоянного тока статора
- исправлены прочие мелкие ошибки в разных модулях
2021-12-01 13:54:14 +03:00

86 lines
1.9 KiB
C

/*!
Copyright 2017 ÀÎ "ÍÈÈÝÒ" è ÎÎÎ "ÍÏÔ ÂÅÊÒÎÐ"
Licensed under the Apache License, Version 2.0 (the "License");
you may not use this file except in compliance with the License.
You may obtain a copy of the License at
http://www.apache.org/licenses/LICENSE-2.0
Unless required by applicable law or agreed to in writing, software
distributed under the License is distributed on an "AS IS" BASIS,
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
See the License for the specific language governing permissions and
limitations under the License.
\file V_DIO.c
\brief Ìîäóëü äèñêðåòíûõ âõîäîâ/âûõîäîâ
\author ÎÎÎ "ÍÏÔ Âåêòîð". http://motorcontrol.ru
\version v 1.0 25/08/2017
\addtogroup
@{*/
#include "main.h"
#include "filter.h"
// Âåêòîð ñîñòîßíèß äèñêðåòíûõ âûõîäîâ
volatile Uint8 output_vect = 0;
// Âåêòîð ñîñòîßíèß äèñêðåòíûõ âõîäîâ
volatile Uint8 input_vect = 0;
// Ôèëüòðû äèñêðåòíûõ âõîäîâ
TFilter fIn1 = FILTER_DEFAULTS;
void DIO_Init()
{
#if defined (HW_MOTORCONTROLBOARD)
// Èíèöèàëèçàöèÿ äèñêðåòíîãî âõîäà
GPIOA->ALTFUNCCLR = (1 << 14);
GPIOA->OUTENCLR = (1 << 14);
// Èíèöèàëèçàöèÿ äèñêðåòíîãî âûõîäà
GPIOA->ALTFUNCCLR = (1 << 15);
GPIOA->OUTENSET = (1 << 15);
// Êîýôôèöèåíò ôèëüòðàöèè äèñêðåòíûõ âõîäîâ
fIn1.T = _IQ(0.03);
#endif
}
void DIO_slow_calc()
{
// Âûâîäèì óïðàâëßþùåå âîçäåéñòâèå ïî Âûõîäó 1
if (BIT_IS_SET(output_vect, 0))
D_OUT1_ON;
else
D_OUT1_OFF;
// Ïîëó÷àåì ñîñòîßíèå Âõîäà 1 ñ ó÷¸òîì ôèëüòðàöèè
if (fIn1.output > _IQ(0.8)) SET_BIT(input_vect, 0);
if (fIn1.output < _IQ(0.3)) CLEAR_BIT(input_vect, 0);
}
void DIO_fast_calc()
{
// Èíåðöèîííûé ôèëüòð äèñêðåòíîãî Âõîäà 1
fIn1.input = (D_IN1 == 1) ? _IQ(1.0) : 0;
fIn1.calc(&fIn1);
}
/*@}*/