VladislavOstapov/f103-floppotron
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Добавлены таймеры bpm и реализация таймеров для вывода звука

Browse Source
This commit is contained in:
VladislavOstapov
2023-11-01 19:28:54 +03:00
parent f75982feac
commit 0564fa221f
8 changed files with 448 additions and 60 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
Core/Inc/floppy.h
View File

@@ -1,10 +1,22 @@
//
// Created by Vlad on 11.10.2023.
//
#ifndef FLOPPOTRON_FLOPPY_H
#define FLOPPOTRON_FLOPPY_H
#ifdef __cplusplus
extern "C" {
#endif
/**
* Функция, вызываемая в прерывании таймера несущей частоты
*/
void FloppySoundTickHandler();
/**
* Функция, вызываемая в прерывании таймера времени (по умолчанию должно быть время 100bpm)
*/
void FloppyTrackTick();
#ifdef __cplusplus
};
#endif
#endif //FLOPPOTRON_FLOPPY_H

18
Core/Inc/main.h
View File

@@ -57,12 +57,20 @@ void Error_Handler(void);
/* USER CODE END EFP */
/* Private defines -----------------------------------------------------------*/
#define STEP1_Pin GPIO_PIN_0
#define STEP1_GPIO_Port GPIOA
#define DIR1_Pin GPIO_PIN_1
#define DIR1_Pin GPIO_PIN_0
#define DIR1_GPIO_Port GPIOA
#define TEST_Pin GPIO_PIN_2
#define TEST_GPIO_Port GPIOA
#define STEP1_Pin GPIO_PIN_1
#define STEP1_GPIO_Port GPIOA
#define SEL1_Pin GPIO_PIN_2
#define SEL1_GPIO_Port GPIOA
#define DIR2_Pin GPIO_PIN_3
#define DIR2_GPIO_Port GPIOA
#define STEP2_Pin GPIO_PIN_4
#define STEP2_GPIO_Port GPIOA
#define SEL2_Pin GPIO_PIN_5
#define SEL2_GPIO_Port GPIOA
#define SOUND_TICK_Pin GPIO_PIN_11
#define SOUND_TICK_GPIO_Port GPIOB
/* USER CODE BEGIN Private defines */

1
Core/Inc/stm32f1xx_it.h
View File

@@ -56,6 +56,7 @@ void DebugMon_Handler(void);
void PendSV_Handler(void);
void SysTick_Handler(void);
void USB_LP_CAN1_RX0_IRQHandler(void);
void TIM3_IRQHandler(void);
void TIM4_IRQHandler(void);
/* USER CODE BEGIN EFP */

233
Core/Src/floppy.cpp
View File

@@ -1,3 +1,230 @@
//
// Created by Vlad on 11.10.2023.
//
#include "floppy.h"
#include "main.h"
#define FLOPPOTRON_TICK_SPEED (uint16_t)(72000000 / 3600)
#define FLOPPOTRON_SOUND_FREQ (FLOPPOTRON_TICK_SPEED / 2)
#define FLOPPOTRON_MAX_STEPS (100 * 2 * 2)
// класс, описывающий программный таймер для флоппи привода, но мы сделаем вместо него структуру
struct FloppyDrive {
public:
uint16_t cnt = 0; // текущий счетчик таймера
uint16_t top = 0; // верхнее значение таймера
uint16_t curr_step = 0; // текущий шаг флоппи привода
bool isStarted = false; // запущен ли таймер
GPIO_TypeDef* gpio{};
const uint16_t gpioDirBit{}; // бит ноги GPIO для подключения к Floppy::DIR
const uint16_t gpioStepBit{}; // бит ноги GPIO для подключения к Floppy::STEP
const uint16_t gpioSelBit{}; // бит ноги GPIO для подключения к Floppy::DRVSB (Drive select B)
void setFreq(uint16_t freq) {
// freq = FLOPPOTRON_SOUND_FREQ / top
top = FLOPPOTRON_SOUND_FREQ / freq;
}
void setEnable(bool en) {
isStarted = en;
}
void tick() {
if (isStarted) {
cnt++;
if (cnt >= top) {
cnt = 0;
curr_step++;
if (curr_step >= FLOPPOTRON_MAX_STEPS) {
curr_step = 0;
}
if (curr_step & 1) {
// нечетные шаги, это тик направления
if (curr_step < FLOPPOTRON_MAX_STEPS / 2) {
gpio->ODR |= gpioDirBit;
} else {
gpio->ODR &= ~gpioDirBit;
}
} else {
// четные шаги, это шаги мотора
gpio->ODR ^= gpioStepBit;
}
}
} else {
cnt = 0;
}
}
};
FloppyDrive drives[] = {
{.gpio = DIR1_GPIO_Port, .gpioDirBit = DIR1_Pin, .gpioStepBit = STEP1_Pin},
{.gpio = DIR2_GPIO_Port, .gpioDirBit = DIR2_Pin, .gpioStepBit = STEP2_Pin},
};
void FloppySoundTickHandler() {
for (auto& drive:drives) {
drive.tick();
}
}
#define FT_CMD_NOTES_ON 0x1000
#define FT_CMD_NOTES_OFF 0x2000
#define FT_CMD_WAIT 0x3000
// составная команда - частота на
#define FT_CMD_SET_FRQ1 0x8000
#define FT_CMD_SET_FRQ2 0x9000
#define FT_CMD_STOP 0x0000
#define FT_CMD_MASK 0xF000
// хандлер для проигрывания нот
void FloppyTrackTick() {
// байткод для 100bpm, тестовая мелодия
const static uint16_t bytecode[] = {
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 165, FT_CMD_WAIT | 50, // '3'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 165, FT_CMD_WAIT | 50, // '3'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 220, FT_CMD_WAIT | 50, // '6'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 220, FT_CMD_WAIT | 50, // '6'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 220, FT_CMD_WAIT | 50, // '6'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 220, FT_CMD_WAIT | 50, // '6'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 165, FT_CMD_WAIT | 50, // '3'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 262, FT_CMD_WAIT | 50, // '1''
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 220, FT_CMD_WAIT | 50, // '6'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 165, FT_CMD_WAIT | 50, // '3'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 262, FT_CMD_WAIT | 50, // '1''
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 247, FT_CMD_WAIT | 50, // '7'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 147, FT_CMD_WAIT | 50, // '2'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 165, FT_CMD_WAIT | 50, // '3'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 174, FT_CMD_WAIT | 50, // '4'
// FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 50, // ' '
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 220, FT_CMD_WAIT | 50, // '6'
// FT_CMD_NOTES_ON | 1, FT_CMD_SET_FRQ1 | 196, FT_CMD_WAIT | 50, // '5'
// недо-имперский марш
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 165, FT_CMD_SET_FRQ2 | 165, FT_CMD_WAIT | 25, // '3'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 25, // ' '
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 165, FT_CMD_SET_FRQ2 | 165, FT_CMD_WAIT | 25, // '3'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 25, // ' '
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 165, FT_CMD_SET_FRQ2 | 165, FT_CMD_WAIT | 25, // '3'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 25, // ' '
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 131, FT_CMD_SET_FRQ2 | 131, FT_CMD_WAIT | 25, // '1'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 25, // ' '
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 196, FT_CMD_SET_FRQ2 | 196, FT_CMD_WAIT | 25, // '5'
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 165, FT_CMD_SET_FRQ2 | 165, FT_CMD_WAIT | 25, // '3'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 25, // ' '
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 131, FT_CMD_SET_FRQ2 | 131, FT_CMD_WAIT | 25, // '1'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 25, // ' '
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 196, FT_CMD_SET_FRQ2 | 196, FT_CMD_WAIT | 25, // '5'
FT_CMD_NOTES_ON | 3, FT_CMD_SET_FRQ1 | 165, FT_CMD_SET_FRQ2 | 165, FT_CMD_WAIT | 25, // '3'
FT_CMD_NOTES_OFF | 3, FT_CMD_WAIT | 500,
FT_CMD_STOP
};
static const uint16_t* pc = bytecode;
static uint16_t wait = 0;
if (wait == 0) {
while (wait == 0) {
uint16_t cmd = *(pc++);
uint16_t value = cmd & (~FT_CMD_MASK);
switch (cmd & FT_CMD_MASK) {
case FT_CMD_STOP:
pc = bytecode; // просто все начнем сначала
drives[0].setEnable(false);
drives[1].setEnable(false);
break;
case FT_CMD_NOTES_ON:
if (value & 1) {
drives[0].setEnable(true);
}
if (value & 2) {
drives[1].setEnable(true);
}
break;
case FT_CMD_NOTES_OFF:
if (value & 1) {
drives[0].setEnable(false);
}
if (value & 2) {
drives[1].setEnable(false);
}
break;
case FT_CMD_WAIT:
wait = value;
break;
case FT_CMD_SET_FRQ1:
drives[0].setFreq(value);
break;
case FT_CMD_SET_FRQ2:
drives[1].setFreq(value);
break;
}
}
} else {
wait--;
}
}

71
Core/Src/main.c
View File

@@ -22,7 +22,7 @@
/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include "floppy.h"
/* USER CODE END Includes */
/* Private typedef -----------------------------------------------------------*/
@@ -41,6 +41,7 @@
/* USER CODE END PM */
/* Private variables ---------------------------------------------------------*/
TIM_HandleTypeDef htim3;
TIM_HandleTypeDef htim4;
/* USER CODE BEGIN PV */
@@ -51,6 +52,7 @@ TIM_HandleTypeDef htim4;
void SystemClock_Config(void);
static void MX_GPIO_Init(void);
static void MX_TIM4_Init(void);
static void MX_TIM3_Init(void);
/* USER CODE BEGIN PFP */
/* USER CODE END PFP */
@@ -90,9 +92,11 @@ int main(void)
MX_GPIO_Init();
MX_TIM4_Init();
MX_USB_DEVICE_Init();
MX_TIM3_Init();
/* USER CODE BEGIN 2 */
HAL_TIM_Base_Start_IT(&htim4);
HAL_TIM_Base_Start_IT(&htim3);
/* USER CODE END 2 */
@@ -153,6 +157,51 @@ void SystemClock_Config(void)
}
}
/**
* @brief TIM3 Initialization Function
* @param None
* @retval None
*/
static void MX_TIM3_Init(void)
{
/* USER CODE BEGIN TIM3_Init 0 */
/* USER CODE END TIM3_Init 0 */
TIM_ClockConfigTypeDef sClockSourceConfig = {0};
TIM_MasterConfigTypeDef sMasterConfig = {0};
/* USER CODE BEGIN TIM3_Init 1 */
/* USER CODE END TIM3_Init 1 */
htim3.Instance = TIM3;
htim3.Init.Prescaler = 71;
htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
htim3.Init.Period = 9999;
htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
{
Error_Handler();
}
sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
if (HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig) != HAL_OK)
{
Error_Handler();
}
sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
{
Error_Handler();
}
/* USER CODE BEGIN TIM3_Init 2 */
/* USER CODE END TIM3_Init 2 */
}
/**
* @brief TIM4 Initialization Function
* @param None
@@ -212,17 +261,31 @@ static void MX_GPIO_Init(void)
/* GPIO Ports Clock Enable */
__HAL_RCC_GPIOD_CLK_ENABLE();
__HAL_RCC_GPIOA_CLK_ENABLE();
__HAL_RCC_GPIOB_CLK_ENABLE();
/*Configure GPIO pin Output Level */
HAL_GPIO_WritePin(GPIOA, STEP1_Pin|DIR1_Pin|TEST_Pin, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOA, DIR1_Pin|STEP1_Pin|SEL1_Pin|DIR2_Pin
|STEP2_Pin|SEL2_Pin, GPIO_PIN_RESET);
/*Configure GPIO pins : STEP1_Pin DIR1_Pin TEST_Pin */
GPIO_InitStruct.Pin = STEP1_Pin|DIR1_Pin|TEST_Pin;
/*Configure GPIO pin Output Level */
HAL_GPIO_WritePin(SOUND_TICK_GPIO_Port, SOUND_TICK_Pin, GPIO_PIN_RESET);
/*Configure GPIO pins : DIR1_Pin STEP1_Pin SEL1_Pin DIR2_Pin
STEP2_Pin SEL2_Pin */
GPIO_InitStruct.Pin = DIR1_Pin|STEP1_Pin|SEL1_Pin|DIR2_Pin
|STEP2_Pin|SEL2_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
GPIO_InitStruct.Pull = GPIO_NOPULL;
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
/*Configure GPIO pin : SOUND_TICK_Pin */
GPIO_InitStruct.Pin = SOUND_TICK_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
GPIO_InitStruct.Pull = GPIO_NOPULL;
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
HAL_GPIO_Init(SOUND_TICK_GPIO_Port, &GPIO_InitStruct);
/* USER CODE BEGIN MX_GPIO_Init_2 */
/* USER CODE END MX_GPIO_Init_2 */
}

32
Core/Src/stm32f1xx_hal_msp.c
View File

@@ -88,7 +88,21 @@ void HAL_MspInit(void)
*/
void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* htim_base)
{
if(htim_base->Instance==TIM4)
if(htim_base->Instance==TIM3)
{
/* USER CODE BEGIN TIM3_MspInit 0 */
/* USER CODE END TIM3_MspInit 0 */
/* Peripheral clock enable */
__HAL_RCC_TIM3_CLK_ENABLE();
/* TIM3 interrupt Init */
HAL_NVIC_SetPriority(TIM3_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(TIM3_IRQn);
/* USER CODE BEGIN TIM3_MspInit 1 */
/* USER CODE END TIM3_MspInit 1 */
}
else if(htim_base->Instance==TIM4)
{
/* USER CODE BEGIN TIM4_MspInit 0 */
@@ -113,7 +127,21 @@ void HAL_TIM_Base_MspInit(TIM_HandleTypeDef* htim_base)
*/
void HAL_TIM_Base_MspDeInit(TIM_HandleTypeDef* htim_base)
{
if(htim_base->Instance==TIM4)
if(htim_base->Instance==TIM3)
{
/* USER CODE BEGIN TIM3_MspDeInit 0 */
/* USER CODE END TIM3_MspDeInit 0 */
/* Peripheral clock disable */
__HAL_RCC_TIM3_CLK_DISABLE();
/* TIM3 interrupt DeInit */
HAL_NVIC_DisableIRQ(TIM3_IRQn);
/* USER CODE BEGIN TIM3_MspDeInit 1 */
/* USER CODE END TIM3_MspDeInit 1 */
}
else if(htim_base->Instance==TIM4)
{
/* USER CODE BEGIN TIM4_MspDeInit 0 */

47
Core/Src/stm32f1xx_it.c
View File

@@ -22,6 +22,7 @@
#include "stm32f1xx_it.h"
/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include "floppy.h"
/* USER CODE END Includes */
/* Private typedef -----------------------------------------------------------*/
@@ -56,6 +57,7 @@
/* External variables --------------------------------------------------------*/
extern PCD_HandleTypeDef hpcd_USB_FS;
extern TIM_HandleTypeDef htim3;
extern TIM_HandleTypeDef htim4;
/* USER CODE BEGIN EV */
@@ -213,38 +215,39 @@ void USB_LP_CAN1_RX0_IRQHandler(void)
/* USER CODE END USB_LP_CAN1_RX0_IRQn 1 */
}
/**
* @brief This function handles TIM3 global interrupt.
*/
void TIM3_IRQHandler(void)
{
/* USER CODE BEGIN TIM3_IRQn 0 */
// вызываем функцию обработки мелодии
FloppyTrackTick();
// сброс всех флагов прерывания
TIM3->SR = 0;
/* USER CODE END TIM3_IRQn 0 */
/* USER CODE BEGIN TIM3_IRQn 1 */
/* USER CODE END TIM3_IRQn 1 */
}
/**
* @brief This function handles TIM4 global interrupt.
*/
void TIM4_IRQHandler(void)
{
/* USER CODE BEGIN TIM4_IRQn 0 */
TEST_GPIO_Port->ODR ^= TEST_Pin;
// дергаем ногу такта таймера (для отладки)
SOUND_TICK_GPIO_Port->ODR ^= SOUND_TICK_Pin;
static uint16_t cnt = 0;
cnt += 1;
if (cnt >= 50) { // тут менять частоту (делитель от 40к)
cnt = 0;
// вызываем тик у флоппи приводов
FloppySoundTickHandler();
// тик таймера, который для флоппи
static char t = 0;
static int curr_step = 0;
if (t) {
STEP1_GPIO_Port->ODR ^= STEP1_Pin;
curr_step++;
} else {
if (curr_step >= 80) {
curr_step = 0;
DIR1_GPIO_Port->ODR ^= DIR1_Pin;
}
}
t = !t;
}
// сброс всех флагов прерывания
TIM4->SR = 0;
/* USER CODE END TIM4_IRQn 0 */
HAL_TIM_IRQHandler(&htim4);
/* USER CODE BEGIN TIM4_IRQn 1 */
/* USER CODE END TIM4_IRQn 1 */