|
|
@@ -1,20 +1,32 @@
|
|
|
#include <furi_hal_rfid.h>
|
|
|
#include <furi_hal_ibutton.h>
|
|
|
+#include <furi_hal_interrupt.h>
|
|
|
#include <furi_hal_resources.h>
|
|
|
-#include <furi_hal_version.h>
|
|
|
+#include <furi.h>
|
|
|
|
|
|
-#include <tim.h>
|
|
|
#include <stm32wbxx_ll_tim.h>
|
|
|
#include <stm32wbxx_ll_comp.h>
|
|
|
|
|
|
-#define LFRFID_TIM htim1
|
|
|
-#define LFRFID_CH TIM_CHANNEL_1
|
|
|
-#define LFRFID_READ_TIM htim1
|
|
|
-#define LFRFID_READ_CHANNEL TIM_CHANNEL_1
|
|
|
-#define LFRFID_EMULATE_TIM htim2
|
|
|
-#define LFRFID_EMULATE_CHANNEL TIM_CHANNEL_3
|
|
|
+#define FURI_HAL_RFID_READ_TIMER TIM1
|
|
|
+#define FURI_HAL_RFID_READ_TIMER_CHANNEL LL_TIM_CHANNEL_CH1N
|
|
|
+// We can't use N channel for LL_TIM_OC_Init, so...
|
|
|
+#define FURI_HAL_RFID_READ_TIMER_CHANNEL_CONFIG LL_TIM_CHANNEL_CH1
|
|
|
+
|
|
|
+#define FURI_HAL_RFID_EMULATE_TIMER TIM2
|
|
|
+#define FURI_HAL_RFID_EMULATE_TIMER_IRQ TIM2_IRQn
|
|
|
+#define FURI_HAL_RFID_EMULATE_TIMER_CHANNEL LL_TIM_CHANNEL_CH3
|
|
|
+
|
|
|
+typedef struct {
|
|
|
+ FuriHalRfidEmulateCallback callback;
|
|
|
+ void* context;
|
|
|
+} FuriHalRfid;
|
|
|
+
|
|
|
+FuriHalRfid* furi_hal_rfid = NULL;
|
|
|
|
|
|
void furi_hal_rfid_init() {
|
|
|
+ furi_assert(furi_hal_rfid == NULL);
|
|
|
+ furi_hal_rfid = malloc(sizeof(FuriHalRfid));
|
|
|
+
|
|
|
furi_hal_rfid_pins_reset();
|
|
|
|
|
|
LL_COMP_InitTypeDef COMP_InitStruct = {0};
|
|
|
@@ -105,210 +117,129 @@ void furi_hal_rfid_pin_pull_pulldown() {
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_tim_read(float freq, float duty_cycle) {
|
|
|
- // TODO LL init
|
|
|
- uint32_t period = (uint32_t)((SystemCoreClock) / freq) - 1;
|
|
|
-
|
|
|
- TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
|
- TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
|
- TIM_OC_InitTypeDef sConfigOC = {0};
|
|
|
- TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};
|
|
|
-
|
|
|
- // basic PWM setup with needed freq and internal clock
|
|
|
- LFRFID_READ_TIM.Init.Prescaler = 0;
|
|
|
- LFRFID_READ_TIM.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
|
- LFRFID_READ_TIM.Init.Period = period;
|
|
|
- LFRFID_READ_TIM.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
|
- LFRFID_READ_TIM.Init.RepetitionCounter = 0;
|
|
|
- LFRFID_READ_TIM.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
|
- if(HAL_TIM_Base_Init(&LFRFID_READ_TIM) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
- sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
|
|
|
- if(HAL_TIM_ConfigClockSource(&LFRFID_READ_TIM, &sClockSourceConfig) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
- if(HAL_TIM_PWM_Init(&LFRFID_READ_TIM) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
+ FURI_CRITICAL_ENTER();
|
|
|
+ LL_TIM_DeInit(FURI_HAL_RFID_READ_TIMER);
|
|
|
+ FURI_CRITICAL_EXIT();
|
|
|
|
|
|
- // no master-slave mode
|
|
|
- sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
|
- sMasterConfig.MasterOutputTrigger2 = TIM_TRGO2_RESET;
|
|
|
- sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
|
- if(HAL_TIMEx_MasterConfigSynchronization(&LFRFID_READ_TIM, &sMasterConfig) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
+ LL_TIM_InitTypeDef TIM_InitStruct = {0};
|
|
|
+ TIM_InitStruct.Autoreload = (SystemCoreClock / freq) - 1;
|
|
|
+ LL_TIM_Init(FURI_HAL_RFID_READ_TIMER, &TIM_InitStruct);
|
|
|
+ LL_TIM_DisableARRPreload(FURI_HAL_RFID_READ_TIMER);
|
|
|
|
|
|
- // pwm config
|
|
|
- sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
|
- sConfigOC.Pulse = (uint32_t)(LFRFID_READ_TIM.Init.Period * duty_cycle);
|
|
|
- sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
|
- sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
|
- sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
|
- sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
|
- sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
|
- if(HAL_TIM_PWM_ConfigChannel(&LFRFID_READ_TIM, &sConfigOC, LFRFID_READ_CHANNEL) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
+ LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {0};
|
|
|
+ TIM_OC_InitStruct.OCMode = LL_TIM_OCMODE_PWM1;
|
|
|
+ TIM_OC_InitStruct.OCNState = LL_TIM_OCSTATE_ENABLE;
|
|
|
+ TIM_OC_InitStruct.CompareValue = TIM_InitStruct.Autoreload * duty_cycle;
|
|
|
+ LL_TIM_OC_Init(
|
|
|
+ FURI_HAL_RFID_READ_TIMER, FURI_HAL_RFID_READ_TIMER_CHANNEL_CONFIG, &TIM_OC_InitStruct);
|
|
|
|
|
|
- // no deadtime
|
|
|
- sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
|
|
|
- sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
|
|
|
- sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
|
|
|
- sBreakDeadTimeConfig.DeadTime = 0;
|
|
|
- sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
|
|
|
- sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
|
|
|
- sBreakDeadTimeConfig.BreakFilter = 0;
|
|
|
- sBreakDeadTimeConfig.BreakAFMode = TIM_BREAK_AFMODE_INPUT;
|
|
|
- sBreakDeadTimeConfig.Break2State = TIM_BREAK2_DISABLE;
|
|
|
- sBreakDeadTimeConfig.Break2Polarity = TIM_BREAK2POLARITY_HIGH;
|
|
|
- sBreakDeadTimeConfig.Break2Filter = 0;
|
|
|
- sBreakDeadTimeConfig.Break2AFMode = TIM_BREAK_AFMODE_INPUT;
|
|
|
- sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
|
|
|
- if(HAL_TIMEx_ConfigBreakDeadTime(&LFRFID_READ_TIM, &sBreakDeadTimeConfig) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
+ LL_TIM_EnableCounter(FURI_HAL_RFID_READ_TIMER);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_tim_read_start() {
|
|
|
- HAL_TIMEx_PWMN_Start(&LFRFID_READ_TIM, LFRFID_READ_CHANNEL);
|
|
|
+ LL_TIM_EnableAllOutputs(FURI_HAL_RFID_READ_TIMER);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_tim_read_stop() {
|
|
|
- HAL_TIMEx_PWMN_Stop(&LFRFID_READ_TIM, LFRFID_READ_CHANNEL);
|
|
|
+ LL_TIM_DisableAllOutputs(FURI_HAL_RFID_READ_TIMER);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_tim_emulate(float freq) {
|
|
|
- // TODO LL init
|
|
|
- // uint32_t prescaler = (uint32_t)((SystemCoreClock) / freq) - 1;
|
|
|
-
|
|
|
- TIM_ClockConfigTypeDef sClockSourceConfig = {0};
|
|
|
- TIM_MasterConfigTypeDef sMasterConfig = {0};
|
|
|
- TIM_OC_InitTypeDef sConfigOC = {0};
|
|
|
-
|
|
|
// basic PWM setup with needed freq and internal clock
|
|
|
- LFRFID_EMULATE_TIM.Init.Prescaler = 0;
|
|
|
- LFRFID_EMULATE_TIM.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
|
- LFRFID_EMULATE_TIM.Init.Period = 1;
|
|
|
- LFRFID_EMULATE_TIM.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
|
- LFRFID_EMULATE_TIM.Init.RepetitionCounter = 0;
|
|
|
- LFRFID_EMULATE_TIM.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_ENABLE;
|
|
|
- if(HAL_TIM_Base_Init(&LFRFID_EMULATE_TIM) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
-
|
|
|
- sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_ETRMODE2;
|
|
|
- sClockSourceConfig.ClockPolarity = TIM_ETRPOLARITY_INVERTED;
|
|
|
- sClockSourceConfig.ClockPrescaler = TIM_CLOCKPRESCALER_DIV1;
|
|
|
- sClockSourceConfig.ClockFilter = 0;
|
|
|
- if(HAL_TIM_ConfigClockSource(&LFRFID_EMULATE_TIM, &sClockSourceConfig) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
- if(HAL_TIM_PWM_Init(&LFRFID_EMULATE_TIM) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
+ FURI_CRITICAL_ENTER();
|
|
|
+ LL_TIM_DeInit(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+ FURI_CRITICAL_EXIT();
|
|
|
|
|
|
- // no master-slave mode
|
|
|
- sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
|
|
|
- sMasterConfig.MasterOutputTrigger2 = TIM_TRGO2_RESET;
|
|
|
- sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
|
|
|
- if(HAL_TIMEx_MasterConfigSynchronization(&LFRFID_EMULATE_TIM, &sMasterConfig) != HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
- }
|
|
|
+ LL_TIM_SetPrescaler(FURI_HAL_RFID_EMULATE_TIMER, 0);
|
|
|
+ LL_TIM_SetCounterMode(FURI_HAL_RFID_EMULATE_TIMER, LL_TIM_COUNTERMODE_UP);
|
|
|
+ LL_TIM_SetAutoReload(FURI_HAL_RFID_EMULATE_TIMER, 1);
|
|
|
+ LL_TIM_DisableARRPreload(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+ LL_TIM_SetRepetitionCounter(FURI_HAL_RFID_EMULATE_TIMER, 0);
|
|
|
+
|
|
|
+ LL_TIM_SetClockDivision(FURI_HAL_RFID_EMULATE_TIMER, LL_TIM_CLOCKDIVISION_DIV1);
|
|
|
+ LL_TIM_SetClockSource(FURI_HAL_RFID_EMULATE_TIMER, LL_TIM_CLOCKSOURCE_EXT_MODE2);
|
|
|
+ LL_TIM_ConfigETR(
|
|
|
+ FURI_HAL_RFID_EMULATE_TIMER,
|
|
|
+ LL_TIM_ETR_POLARITY_INVERTED,
|
|
|
+ LL_TIM_ETR_PRESCALER_DIV1,
|
|
|
+ LL_TIM_ETR_FILTER_FDIV1);
|
|
|
+
|
|
|
+ LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {0};
|
|
|
+ TIM_OC_InitStruct.OCMode = LL_TIM_OCMODE_PWM1;
|
|
|
+ TIM_OC_InitStruct.OCState = LL_TIM_OCSTATE_ENABLE;
|
|
|
+ TIM_OC_InitStruct.CompareValue = 1;
|
|
|
+ LL_TIM_OC_Init(
|
|
|
+ FURI_HAL_RFID_EMULATE_TIMER, FURI_HAL_RFID_EMULATE_TIMER_CHANNEL, &TIM_OC_InitStruct);
|
|
|
+
|
|
|
+ LL_TIM_GenerateEvent_UPDATE(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+}
|
|
|
|
|
|
- // pwm config
|
|
|
- sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
|
|
- sConfigOC.Pulse = 1;
|
|
|
- sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
|
|
- sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
|
|
|
- sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
|
|
- sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
|
|
|
- sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
|
|
|
- if(HAL_TIM_PWM_ConfigChannel(&LFRFID_EMULATE_TIM, &sConfigOC, LFRFID_EMULATE_CHANNEL) !=
|
|
|
- HAL_OK) {
|
|
|
- Error_Handler();
|
|
|
+static void furi_hal_rfid_emulate_isr() {
|
|
|
+ if(LL_TIM_IsActiveFlag_UPDATE(FURI_HAL_RFID_EMULATE_TIMER)) {
|
|
|
+ LL_TIM_ClearFlag_UPDATE(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+ furi_hal_rfid->callback(furi_hal_rfid->context);
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-void furi_hal_rfid_tim_emulate_start() {
|
|
|
+void furi_hal_rfid_tim_emulate_start(FuriHalRfidEmulateCallback callback, void* context) {
|
|
|
+ furi_assert(furi_hal_rfid);
|
|
|
+
|
|
|
+ furi_hal_rfid->callback = callback;
|
|
|
+ furi_hal_rfid->context = context;
|
|
|
+
|
|
|
// TODO make api for interrupts priority
|
|
|
for(size_t i = WWDG_IRQn; i <= DMAMUX1_OVR_IRQn; i++) {
|
|
|
HAL_NVIC_SetPriority(i, 15, 0);
|
|
|
}
|
|
|
|
|
|
- HAL_NVIC_SetPriority(TIM2_IRQn, 5, 0);
|
|
|
- HAL_NVIC_EnableIRQ(TIM2_IRQn);
|
|
|
+ furi_hal_interrupt_set_timer_isr(FURI_HAL_RFID_EMULATE_TIMER, furi_hal_rfid_emulate_isr);
|
|
|
|
|
|
- HAL_TIM_PWM_Start_IT(&LFRFID_EMULATE_TIM, LFRFID_EMULATE_CHANNEL);
|
|
|
- HAL_TIM_Base_Start_IT(&LFRFID_EMULATE_TIM);
|
|
|
+ NVIC_SetPriority(
|
|
|
+ FURI_HAL_RFID_EMULATE_TIMER_IRQ, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
|
|
|
+ NVIC_EnableIRQ(FURI_HAL_RFID_EMULATE_TIMER_IRQ);
|
|
|
+
|
|
|
+ LL_TIM_EnableIT_UPDATE(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+ LL_TIM_EnableAllOutputs(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+ LL_TIM_EnableCounter(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_tim_emulate_stop() {
|
|
|
- HAL_TIM_Base_Stop(&LFRFID_EMULATE_TIM);
|
|
|
- HAL_TIM_PWM_Stop(&LFRFID_EMULATE_TIM, LFRFID_EMULATE_CHANNEL);
|
|
|
+ furi_hal_interrupt_set_timer_isr(FURI_HAL_RFID_EMULATE_TIMER, NULL);
|
|
|
+ LL_TIM_DisableCounter(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
+ LL_TIM_DisableAllOutputs(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_tim_reset() {
|
|
|
FURI_CRITICAL_ENTER();
|
|
|
|
|
|
- HAL_TIM_Base_DeInit(&LFRFID_READ_TIM);
|
|
|
- LL_TIM_DeInit(TIM1);
|
|
|
- HAL_TIM_Base_DeInit(&LFRFID_EMULATE_TIM);
|
|
|
- LL_TIM_DeInit(TIM2);
|
|
|
+ LL_TIM_DeInit(FURI_HAL_RFID_READ_TIMER);
|
|
|
+ LL_TIM_DeInit(FURI_HAL_RFID_EMULATE_TIMER);
|
|
|
|
|
|
FURI_CRITICAL_EXIT();
|
|
|
}
|
|
|
|
|
|
-bool furi_hal_rfid_is_tim_emulate(TIM_HandleTypeDef* hw) {
|
|
|
- return (hw == &LFRFID_EMULATE_TIM);
|
|
|
-}
|
|
|
-
|
|
|
void furi_hal_rfid_set_emulate_period(uint32_t period) {
|
|
|
- LFRFID_EMULATE_TIM.Instance->ARR = period;
|
|
|
+ LL_TIM_SetAutoReload(FURI_HAL_RFID_EMULATE_TIMER, period);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_set_emulate_pulse(uint32_t pulse) {
|
|
|
- switch(LFRFID_EMULATE_CHANNEL) {
|
|
|
- case TIM_CHANNEL_1:
|
|
|
- LFRFID_EMULATE_TIM.Instance->CCR1 = pulse;
|
|
|
- break;
|
|
|
- case TIM_CHANNEL_2:
|
|
|
- LFRFID_EMULATE_TIM.Instance->CCR2 = pulse;
|
|
|
- break;
|
|
|
- case TIM_CHANNEL_3:
|
|
|
- LFRFID_EMULATE_TIM.Instance->CCR3 = pulse;
|
|
|
- break;
|
|
|
- case TIM_CHANNEL_4:
|
|
|
- LFRFID_EMULATE_TIM.Instance->CCR4 = pulse;
|
|
|
- break;
|
|
|
- default:
|
|
|
- furi_crash(NULL);
|
|
|
- break;
|
|
|
- }
|
|
|
+#if FURI_HAL_RFID_EMULATE_TIMER_CHANNEL == LL_TIM_CHANNEL_CH3
|
|
|
+ LL_TIM_OC_SetCompareCH3(FURI_HAL_RFID_EMULATE_TIMER, pulse);
|
|
|
+#else
|
|
|
+#error Update this code. Would you kindly?
|
|
|
+#endif
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_set_read_period(uint32_t period) {
|
|
|
- LFRFID_TIM.Instance->ARR = period;
|
|
|
+ LL_TIM_SetAutoReload(FURI_HAL_RFID_READ_TIMER, period);
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_set_read_pulse(uint32_t pulse) {
|
|
|
- switch(LFRFID_READ_CHANNEL) {
|
|
|
- case TIM_CHANNEL_1:
|
|
|
- LFRFID_TIM.Instance->CCR1 = pulse;
|
|
|
- break;
|
|
|
- case TIM_CHANNEL_2:
|
|
|
- LFRFID_TIM.Instance->CCR2 = pulse;
|
|
|
- break;
|
|
|
- case TIM_CHANNEL_3:
|
|
|
- LFRFID_TIM.Instance->CCR3 = pulse;
|
|
|
- break;
|
|
|
- case TIM_CHANNEL_4:
|
|
|
- LFRFID_TIM.Instance->CCR4 = pulse;
|
|
|
- break;
|
|
|
- default:
|
|
|
- furi_crash(NULL);
|
|
|
- break;
|
|
|
- }
|
|
|
+#if FURI_HAL_RFID_READ_TIMER_CHANNEL == LL_TIM_CHANNEL_CH1N
|
|
|
+ LL_TIM_OC_SetCompareCH1(FURI_HAL_RFID_READ_TIMER, pulse);
|
|
|
+#else
|
|
|
+#error Update this code. Would you kindly?
|
|
|
+#endif
|
|
|
}
|
|
|
|
|
|
void furi_hal_rfid_change_read_config(float freq, float duty_cycle) {
|