boot test init
в добавок сделано считывание частоты и скважности сети. можно по скважности определить какая фаза оборвана (в теории) + нормальный гитигнор
This commit is contained in:
@@ -22,7 +22,7 @@
|
||||
#include "gpio.h"
|
||||
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
#include "tim.h"
|
||||
/* USER CODE END 0 */
|
||||
|
||||
/*----------------------------------------------------------------------------*/
|
||||
@@ -78,13 +78,19 @@ void MX_GPIO_Init(void)
|
||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
||||
|
||||
/*Configure GPIO pins : PBPin PBPin PBPin PBPin
|
||||
PBPin PBPin PBPin */
|
||||
PBPin PBPin */
|
||||
GPIO_InitStruct.Pin = IN_12_Pin|IN_11_Pin|BOOT1_Pin|IN_10_Pin
|
||||
|IN_09_Pin|IN_08_Pin|IN_07_Pin;
|
||||
|IN_09_Pin|IN_08_Pin;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
||||
|
||||
/*Configure GPIO pin : PtPin */
|
||||
GPIO_InitStruct.Pin = IN_07_Pin;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_IT_RISING_FALLING;
|
||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||
HAL_GPIO_Init(IN_07_GPIO_Port, &GPIO_InitStruct);
|
||||
|
||||
/*Configure GPIO pin : PA8 */
|
||||
GPIO_InitStruct.Pin = GPIO_PIN_8;
|
||||
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
||||
@@ -98,8 +104,48 @@ void MX_GPIO_Init(void)
|
||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
||||
|
||||
/* EXTI interrupt init*/
|
||||
HAL_NVIC_SetPriority(EXTI15_10_IRQn, 0, 0);
|
||||
HAL_NVIC_EnableIRQ(EXTI15_10_IRQn);
|
||||
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 2 */
|
||||
#define MEASURE_PIN IN_07_Pin
|
||||
#define MEASURE_PORT IN_07_GPIO_Port
|
||||
volatile uint32_t last_tick = 0;
|
||||
volatile uint32_t high_time = 0;
|
||||
volatile uint32_t period_time = 0;
|
||||
volatile uint8_t first_edge = 1;
|
||||
|
||||
float duty_cycle = 0.0f;
|
||||
float frequency = 0.0f;
|
||||
void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin)
|
||||
{
|
||||
if (GPIO_Pin != MEASURE_PIN) return;
|
||||
|
||||
static uint16_t last_tick = 0;
|
||||
static uint16_t low_time = 0;
|
||||
static uint16_t high_time = 0;
|
||||
|
||||
uint16_t now = (uint16_t)__HAL_TIM_GET_COUNTER(&htim2);
|
||||
uint16_t delta = (now >= last_tick) ? (now - last_tick) : (uint16_t)(0x10000 + now - last_tick);
|
||||
last_tick = now;
|
||||
|
||||
if (HAL_GPIO_ReadPin(MEASURE_PORT, MEASURE_PIN) == GPIO_PIN_SET) {
|
||||
// RISING → закончился LOW
|
||||
low_time = delta;
|
||||
} else {
|
||||
// FALLING → закончился HIGH
|
||||
high_time = delta;
|
||||
uint32_t period = (uint32_t)high_time + (uint32_t)low_time;
|
||||
if (period > 0) {
|
||||
frequency = 1e6f / period; // Гц
|
||||
duty_cycle = (high_time * 100.0f) / period; // %
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
/* USER CODE END 2 */
|
||||
|
||||
@@ -38,7 +38,7 @@ void MX_IWDG_Init(void)
|
||||
|
||||
/* USER CODE END IWDG_Init 1 */
|
||||
hiwdg.Instance = IWDG;
|
||||
hiwdg.Init.Prescaler = IWDG_PRESCALER_4;
|
||||
hiwdg.Init.Prescaler = IWDG_PRESCALER_256;
|
||||
hiwdg.Init.Reload = 4095;
|
||||
if (HAL_IWDG_Init(&hiwdg) != HAL_OK)
|
||||
{
|
||||
|
||||
@@ -107,10 +107,11 @@ int main(void)
|
||||
MX_GPIO_Init();
|
||||
MX_CAN_Init();
|
||||
MX_TIM4_Init();
|
||||
|
||||
MX_IWDG_Init();
|
||||
MX_UART4_Init();
|
||||
MX_TIM2_Init();
|
||||
/* USER CODE BEGIN 2 */
|
||||
|
||||
HAL_TIM_Base_Start(&htim2);
|
||||
LED_0_ON;
|
||||
LED_1_OFF;
|
||||
LED_2_ON;
|
||||
@@ -151,7 +152,7 @@ int main(void)
|
||||
/* USER CODE BEGIN WHILE */
|
||||
while (1)
|
||||
{
|
||||
//=== БЛОК ПРИНУДИТЕЛЬНОЙ ПАУЗЫ ===//
|
||||
//=== БЛОК ПР<EFBFBD>?НУД<EFBFBD>?ТЕЛЬНОЙ ПАУЗЫ ===//
|
||||
if (flag.force_pause)
|
||||
{
|
||||
__disable_irq(); // Отключаем все прерывания
|
||||
@@ -159,7 +160,7 @@ int main(void)
|
||||
__enable_irq(); // Включаем прерывания обратно
|
||||
}
|
||||
|
||||
//=== ОБРАБОТКА CAN-ШИНЫ ===//
|
||||
//=== ОБРАБОТКА CAN-Ш<EFBFBD>?НЫ ===//
|
||||
if (CanGO) // Флаг разрешения работы с CAN-шиной
|
||||
{
|
||||
CanGO = 0; // Сбрасываем флаг
|
||||
@@ -298,10 +299,10 @@ int main(void)
|
||||
|
||||
Next: // Метка для перехода к следующей части цикла
|
||||
|
||||
//=== ЧТЕНИЕ ВХОДНЫХ СИГНАЛОВ ===//
|
||||
//=== ЧТЕН<EFBFBD>?Е ВХОДНЫХ С<EFBFBD>?ГНАЛОВ ===//
|
||||
ReadEnteres(); // Функция чтения дискретных входов
|
||||
|
||||
//=== УПРАВЛЕНИЕ ВЫХОДНЫМИ СИГНАЛАМИ ===//
|
||||
//=== УПРАВЛЕН<EFBFBD>?Е ВЫХОДНЫМ<EFBFBD>? С<>?ГНАЛАМ<EFBFBD>? ===//
|
||||
if (Errors.all | Alarms.all)
|
||||
Pvt4_OFF; // Выключение сигнала "Система ВЭП в норме"
|
||||
else
|
||||
@@ -324,7 +325,7 @@ int main(void)
|
||||
}
|
||||
precom = Commands; // Сохранение текущих команд для следующей итерации
|
||||
|
||||
//=== ОБРАБОТКА СИСТЕМНЫХ КОМАНД ===//
|
||||
//=== ОБРАБОТКА С<EFBFBD>?СТЕМНЫХ КОМАНД ===//
|
||||
if (cDefParam) // Команда сброса параметров по умолчанию
|
||||
{
|
||||
cDefParam = 0;
|
||||
@@ -425,28 +426,28 @@ int Isit(int num, int i, int z)
|
||||
{
|
||||
int res, pls;
|
||||
|
||||
//=== ПРОВЕРКА ДИАПАЗОНА ===//
|
||||
//=== ПРОВЕРКА Д<EFBFBD>?АПАЗОНА ===//
|
||||
// Если номер элемента вне допустимого диапазона (0x00-0x7F)
|
||||
if((num < 0) || (num >= 0x80))
|
||||
return 0; // Элемент не активен
|
||||
|
||||
//=== ПРОВЕРКА МАСКИ КАНАЛА ===//
|
||||
//=== ПРОВЕРКА МАСК<EFBFBD>? КАНАЛА ===//
|
||||
// Определяем битовую маску для данного элемента
|
||||
// num/0x10 - определяем индекс в массиве масок (0-7)
|
||||
// num&0x0F - определяем позицию бита в слове (0-15)
|
||||
res = Maska[i][num / 0x10]; // Получаем маску для группы элементов
|
||||
res &= (1 << (num & 0x0F)); // Проверяем конкретный бит в маске
|
||||
|
||||
//=== ДОПОЛНИТЕЛЬНЫЕ ПРОВЕРКИ (если z != 0) ===//
|
||||
//=== ДОПОЛН<EFBFBD>?ТЕЛЬНЫЕ ПРОВЕРК<EFBFBD>? (если z != 0) ===//
|
||||
if(z)
|
||||
{
|
||||
// Проверка времени ожидания: если превышена половина времени перезапуска
|
||||
pls = (espero[num] > CanRestart[i] / 2);
|
||||
|
||||
// ИЛИ проверка счетчика отправки (если county[num] != 0)
|
||||
// <EFBFBD>?Л<>? проверка счетчика отправки (если county[num] != 0)
|
||||
pls = pls || county[num];
|
||||
|
||||
// Комбинированная проверка: должен быть установлен в маске И выполнять условия
|
||||
// Комбинированная проверка: должен быть установлен в маске <EFBFBD>? выполнять условия
|
||||
res = res && pls;
|
||||
}
|
||||
|
||||
@@ -476,25 +477,25 @@ void Millisecond()
|
||||
#define CANPOWSE 10 // 10 msec - период обновления CAN
|
||||
#define BLINK_TIME 250 // 0.25 sec - период мигания
|
||||
|
||||
//=== ОБНОВЛЕНИЕ WATCHDOG ===//
|
||||
//=== ОБНОВЛЕН<EFBFBD>?Е WATCHDOG ===//
|
||||
if(!cReset)
|
||||
IWDG->KR = 0xAAAA; // Сброс watchdog таймера
|
||||
|
||||
//=== ПРОВЕРКА АКТИВНОСТИ ТАЙМЕРА ===//
|
||||
//=== ПРОВЕРКА АКТ<EFBFBD>?ВНОСТ<EFBFBD>? ТАЙМЕРА ===//
|
||||
if(!timGo) return; // Если таймер не активен - выход
|
||||
|
||||
//=== ЧТЕНИЕ ПЕРЕКЛЮЧАТЕЛЕЙ И КНОПОК ===//
|
||||
//=== ЧТЕН<EFBFBD>?Е ПЕРЕКЛЮЧАТЕЛЕЙ <EFBFBD>? КНОПОК ===//
|
||||
Jumpers.byt.byte_1 = ReadJumpers(); // Чтение состояния переключателей
|
||||
Jumpers.bit.bit0 = Buttons.bit.bit0 = TestJumper(); // Чтение состояния кнопки
|
||||
|
||||
//=== УПРАВЛЕНИЕ CAN-ШИНОЙ ===//
|
||||
//=== УПРАВЛЕН<EFBFBD>?Е CAN-Ш<EFBFBD>?НОЙ ===//
|
||||
if(++CanPowse >= CANPOWSE)
|
||||
{
|
||||
CanPowse = 0; // Сброс счетчика
|
||||
CanGO = 1; // Установка флага разрешения работы CAN
|
||||
}
|
||||
|
||||
//=== УПРАВЛЕНИЕ РЕЖИМОМ "ЗАСЫПАНИЯ" ===//
|
||||
//=== УПРАВЛЕН<EFBFBD>?Е РЕЖ<EFBFBD>?МОМ "ЗАСЫПАН<EFBFBD>?Я" ===//
|
||||
if(Alarms.bit.bit8) // Разряд батареи
|
||||
{
|
||||
if (Falling_asleep) Falling_asleep--; // Уменьшение времени до "сна"
|
||||
@@ -502,7 +503,7 @@ void Millisecond()
|
||||
else
|
||||
Falling_asleep = 1000L * Sleep_time; // Установка времени до "сна"
|
||||
|
||||
//=== ОБРАБОТКА ТЕСТОВОГО РЕЖИМА ===//
|
||||
//=== ОБРАБОТКА ТЕСТОВОГО РЕЖ<EFBFBD>?МА ===//
|
||||
TST = TestJumper() | cTestLamp; // Текущее состояние теста (кнопка или команда)
|
||||
|
||||
if(TST & !preTest) // Обнаружение фронта нажатия кнопки
|
||||
@@ -512,7 +513,7 @@ void Millisecond()
|
||||
}
|
||||
preTest = TST; // Сохранение состояния для следующего вызова
|
||||
|
||||
//=== УПРАВЛЕНИЕ МИГАНИЕМ ИНДИКАТОРОВ ===//
|
||||
//=== УПРАВЛЕН<EFBFBD>?Е М<EFBFBD>?ГАН<EFBFBD>?ЕМ <EFBFBD>?НД<D09D>?КАТОРОВ ===//
|
||||
if(++count_blink >= BLINK_TIME)
|
||||
{
|
||||
count_blink = 0; // Сброс счетчика
|
||||
@@ -521,19 +522,19 @@ void Millisecond()
|
||||
blink_alarm = (count_mode & 7) ? 1 : 0; // Мигание 1:7 (12.5%)
|
||||
}
|
||||
|
||||
//=== УСТАНОВКА СТАНДАРТНЫХ СОСТОЯНИЙ ИНДИКАТОРОВ ===//
|
||||
//=== УСТАНОВКА СТАНДАРТНЫХ СОСТОЯН<EFBFBD>?Й <20>?НД<D09D>?КАТОРОВ ===//
|
||||
power_lamp = 1; // Силовая лампа включена
|
||||
norm_diod = 1; // Нормальный светодиод включен
|
||||
work_diod = !blink_over; // Рабочий светодиод синхронизирован с миганием
|
||||
|
||||
//=== РЕЖИМ ТЕСТИРОВАНИЯ ===//
|
||||
//=== РЕЖ<EFBFBD>?М ТЕСТ<EFBFBD>?РОВАН<EFBFBD>?Я ===//
|
||||
if(TST)
|
||||
{
|
||||
power_lamp = blink_over; // Мигание силовой лампы
|
||||
norm_diod = blink_over; // Мигание нормального светодиода
|
||||
work_diod = blink_over; // Мигание рабочего светодиода
|
||||
}
|
||||
//=== РЕЖИМ ОСВЕЩЕНИЯ ===//
|
||||
//=== РЕЖ<EFBFBD>?М ОСВЕЩЕН<EFBFBD>?Я ===//
|
||||
else if(Lightness)
|
||||
{
|
||||
power_lamp = norm_diod = 0; // Базовое состояние - выключено
|
||||
@@ -550,20 +551,20 @@ void Millisecond()
|
||||
// Уровень освещенности 5: инверсное быстрое мигание (87.5%)
|
||||
if(Lightness == 5) power_lamp = norm_diod = !blink_alarm;
|
||||
}
|
||||
//=== РЕЖИМ ОШИБОК ===//
|
||||
//=== РЕЖ<EFBFBD>?М ОШ<EFBFBD>?БОК ===//
|
||||
else if(Errors.all)
|
||||
{
|
||||
power_lamp = blink_over; // Мигание при ошибках
|
||||
norm_diod = blink_over; // Мигание при ошибках
|
||||
}
|
||||
//=== РЕЖИМ ТРЕВОГ ===//
|
||||
//=== РЕЖ<EFBFBD>?М ТРЕВОГ ===//
|
||||
else if(Alarms.all)
|
||||
{
|
||||
power_lamp = blink_alarm; // Быстрое мигание при тревогах
|
||||
norm_diod = blink_alarm; // Быстрое мигание при тревогах
|
||||
}
|
||||
|
||||
//=== ШИМ УПРАВЛЕНИЕ ЯРКОСТЬЮ СИЛОВОЙ ЛАМПЫ ===//
|
||||
//=== Ш<EFBFBD>?М УПРАВЛЕН<EFBFBD>?Е ЯРКОСТЬЮ С<EFBFBD>?ЛОВОЙ ЛАМПЫ ===//
|
||||
if(++count_bright == 10) // maximum_bright (100%)
|
||||
{
|
||||
count_bright = 0;
|
||||
@@ -571,11 +572,11 @@ void Millisecond()
|
||||
else Pvt1_OFF; // Выключение
|
||||
}
|
||||
|
||||
//=== УПРАВЛЕНИЕ ЯРКОСТЬЮ ===//
|
||||
//=== УПРАВЛЕН<EFBFBD>?Е ЯРКОСТЬЮ ===//
|
||||
if(count_bright == Brightness)
|
||||
if(!TST) Pvt1_OFF; // Отключение лампочки с регулировкой яркости
|
||||
|
||||
//=== УПРАВЛЕНИЕ СВЕТОДИОДАМИ ===//
|
||||
//=== УПРАВЛЕН<EFBFBD>?Е СВЕТОД<EFBFBD>?ОДАМ<EFBFBD>? ===//
|
||||
if(work_diod) LED_2_ON; // Включение рабочего светодиода
|
||||
else LED_2_OFF; // Выключение рабочего светодиода
|
||||
|
||||
@@ -606,8 +607,7 @@ void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
|
||||
/* USER CODE END Callback 0 */
|
||||
if (htim->Instance == TIM8) {
|
||||
HAL_IncTick();
|
||||
Millisecond();
|
||||
}
|
||||
}
|
||||
/* USER CODE BEGIN Callback 1 */
|
||||
/* USER CODE END Callback 1 */
|
||||
}
|
||||
|
||||
@@ -244,6 +244,20 @@ void TIM4_IRQHandler(void)
|
||||
/* USER CODE END TIM4_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles EXTI line[15:10] interrupts.
|
||||
*/
|
||||
void EXTI15_10_IRQHandler(void)
|
||||
{
|
||||
/* USER CODE BEGIN EXTI15_10_IRQn 0 */
|
||||
|
||||
/* USER CODE END EXTI15_10_IRQn 0 */
|
||||
HAL_GPIO_EXTI_IRQHandler(IN_07_Pin);
|
||||
/* USER CODE BEGIN EXTI15_10_IRQn 1 */
|
||||
|
||||
/* USER CODE END EXTI15_10_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles TIM8 update interrupt.
|
||||
*/
|
||||
|
||||
@@ -24,8 +24,49 @@
|
||||
|
||||
/* USER CODE END 0 */
|
||||
|
||||
TIM_HandleTypeDef htim2;
|
||||
TIM_HandleTypeDef htim4;
|
||||
|
||||
/* TIM2 init function */
|
||||
void MX_TIM2_Init(void)
|
||||
{
|
||||
|
||||
/* USER CODE BEGIN TIM2_Init 0 */
|
||||
|
||||
/* USER CODE END TIM2_Init 0 */
|
||||
|
||||
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
||||
TIM_MasterConfigTypeDef sMasterConfig = {0};
|
||||
|
||||
/* USER CODE BEGIN TIM2_Init 1 */
|
||||
|
||||
/* USER CODE END TIM2_Init 1 */
|
||||
htim2.Instance = TIM2;
|
||||
htim2.Init.Prescaler = 64-1;
|
||||
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
|
||||
htim2.Init.Period = 65535;
|
||||
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
||||
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
||||
if (HAL_TIM_Base_Init(&htim2) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
||||
if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
||||
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
||||
if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
/* USER CODE BEGIN TIM2_Init 2 */
|
||||
|
||||
/* USER CODE END TIM2_Init 2 */
|
||||
|
||||
}
|
||||
/* TIM4 init function */
|
||||
void MX_TIM4_Init(void)
|
||||
{
|
||||
@@ -74,7 +115,18 @@ void MX_TIM4_Init(void)
|
||||
void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* tim_baseHandle)
|
||||
{
|
||||
|
||||
if(tim_baseHandle->Instance==TIM4)
|
||||
if(tim_baseHandle->Instance==TIM2)
|
||||
{
|
||||
/* USER CODE BEGIN TIM2_MspInit 0 */
|
||||
|
||||
/* USER CODE END TIM2_MspInit 0 */
|
||||
/* TIM2 clock enable */
|
||||
__HAL_RCC_TIM2_CLK_ENABLE();
|
||||
/* USER CODE BEGIN TIM2_MspInit 1 */
|
||||
|
||||
/* USER CODE END TIM2_MspInit 1 */
|
||||
}
|
||||
else if(tim_baseHandle->Instance==TIM4)
|
||||
{
|
||||
/* USER CODE BEGIN TIM4_MspInit 0 */
|
||||
|
||||
@@ -94,7 +146,18 @@ void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* tim_baseHandle)
|
||||
void HAL_TIM_Base_MspDeInit(TIM_HandleTypeDef* tim_baseHandle)
|
||||
{
|
||||
|
||||
if(tim_baseHandle->Instance==TIM4)
|
||||
if(tim_baseHandle->Instance==TIM2)
|
||||
{
|
||||
/* USER CODE BEGIN TIM2_MspDeInit 0 */
|
||||
|
||||
/* USER CODE END TIM2_MspDeInit 0 */
|
||||
/* Peripheral clock disable */
|
||||
__HAL_RCC_TIM2_CLK_DISABLE();
|
||||
/* USER CODE BEGIN TIM2_MspDeInit 1 */
|
||||
|
||||
/* USER CODE END TIM2_MspDeInit 1 */
|
||||
}
|
||||
else if(tim_baseHandle->Instance==TIM4)
|
||||
{
|
||||
/* USER CODE BEGIN TIM4_MspDeInit 0 */
|
||||
|
||||
|
||||
Reference in New Issue
Block a user