提交 c1168675 编写于 作者: T tangweikang

[bsp][stm32][driver][drv_pulse_encoder.c] code style

上级 f1fe6479
...@@ -19,40 +19,44 @@ extern "C" { ...@@ -19,40 +19,44 @@ extern "C" {
#ifdef BSP_USING_PULSE_ENCODER1 #ifdef BSP_USING_PULSE_ENCODER1
#ifndef PULSE_ENCODER1_CONFIG #ifndef PULSE_ENCODER1_CONFIG
#define PULSE_ENCODER1_CONFIG \ #define PULSE_ENCODER1_CONFIG \
{ \ { \
.tim_handler.Instance = TIM1, \ .tim_handler.Instance = TIM1, \
.name = "pulse1" \ .encoder_irqn = TIM1_UP_IRQn, \
.name = "pulse1" \
} }
#endif /* PULSE_ENCODER1_CONFIG */ #endif /* PULSE_ENCODER1_CONFIG */
#endif /* BSP_USING_PULSE_ENCODER1 */ #endif /* BSP_USING_PULSE_ENCODER1 */
#ifdef BSP_USING_PULSE_ENCODER2 #ifdef BSP_USING_PULSE_ENCODER2
#ifndef PULSE_ENCODER2_CONFIG #ifndef PULSE_ENCODER2_CONFIG
#define PULSE_ENCODER2_CONFIG \ #define PULSE_ENCODER2_CONFIG \
{ \ { \
.tim_handler.Instance = TIM2, \ .tim_handler.Instance = TIM2, \
.name = "pulse2" \ .encoder_irqn = TIM2_IRQn, \
.name = "pulse2" \
} }
#endif /* PULSE_ENCODER2_CONFIG */ #endif /* PULSE_ENCODER2_CONFIG */
#endif /* BSP_USING_PULSE_ENCODER2 */ #endif /* BSP_USING_PULSE_ENCODER2 */
#ifdef BSP_USING_PULSE_ENCODER3 #ifdef BSP_USING_PULSE_ENCODER3
#ifndef PULSE_ENCODER3_CONFIG #ifndef PULSE_ENCODER3_CONFIG
#define PULSE_ENCODER3_CONFIG \ #define PULSE_ENCODER3_CONFIG \
{ \ { \
.tim_handler.Instance = TIM3, \ .tim_handler.Instance = TIM3, \
.name = "pulse3" \ .encoder_irqn = TIM3_IRQn, \
.name = "pulse3" \
} }
#endif /* PULSE_ENCODER3_CONFIG */ #endif /* PULSE_ENCODER3_CONFIG */
#endif /* BSP_USING_PULSE_ENCODER3 */ #endif /* BSP_USING_PULSE_ENCODER3 */
#ifdef BSP_USING_PULSE_ENCODER4 #ifdef BSP_USING_PULSE_ENCODER4
#ifndef PULSE_ENCODER4_CONFIG #ifndef PULSE_ENCODER4_CONFIG
#define PULSE_ENCODER4_CONFIG \ #define PULSE_ENCODER4_CONFIG \
{ \ { \
.tim_handler.Instance = TIM4, \ .tim_handler.Instance = TIM4, \
.name = "pulse4" \ .encoder_irqn = TIM4_IRQn, \
.name = "pulse4" \
} }
#endif /* PULSE_ENCODER4_CONFIG */ #endif /* PULSE_ENCODER4_CONFIG */
#endif /* BSP_USING_PULSE_ENCODER4 */ #endif /* BSP_USING_PULSE_ENCODER4 */
......
...@@ -51,7 +51,7 @@ struct stm32_pulse_encoder_device ...@@ -51,7 +51,7 @@ struct stm32_pulse_encoder_device
struct rt_pulse_encoder_device pulse_encoder; struct rt_pulse_encoder_device pulse_encoder;
TIM_HandleTypeDef tim_handler; TIM_HandleTypeDef tim_handler;
IRQn_Type encoder_irqn; IRQn_Type encoder_irqn;
volatile rt_int32_t over_under_flowcount; rt_int32_t over_under_flowcount;
char *name; char *name;
}; };
...@@ -82,7 +82,7 @@ rt_err_t pulse_encoder_init(struct rt_pulse_encoder_device *pulse_encoder) ...@@ -82,7 +82,7 @@ rt_err_t pulse_encoder_init(struct rt_pulse_encoder_device *pulse_encoder)
TIM_Encoder_InitTypeDef sConfig; TIM_Encoder_InitTypeDef sConfig;
TIM_MasterConfigTypeDef sMasterConfig; TIM_MasterConfigTypeDef sMasterConfig;
struct stm32_pulse_encoder_device *stm32_device; struct stm32_pulse_encoder_device *stm32_device;
stm32_device = rt_container_of(pulse_encoder, struct stm32_pulse_encoder_device, pulse_encoder); stm32_device = (struct stm32_pulse_encoder_device*)pulse_encoder;
stm32_device->tim_handler.Init.Prescaler = 0; stm32_device->tim_handler.Init.Prescaler = 0;
stm32_device->tim_handler.Init.CounterMode = TIM_COUNTERMODE_UP; stm32_device->tim_handler.Init.CounterMode = TIM_COUNTERMODE_UP;
...@@ -133,7 +133,7 @@ rt_err_t pulse_encoder_init(struct rt_pulse_encoder_device *pulse_encoder) ...@@ -133,7 +133,7 @@ rt_err_t pulse_encoder_init(struct rt_pulse_encoder_device *pulse_encoder)
rt_err_t pulse_encoder_clear_count(struct rt_pulse_encoder_device *pulse_encoder) rt_err_t pulse_encoder_clear_count(struct rt_pulse_encoder_device *pulse_encoder)
{ {
struct stm32_pulse_encoder_device *stm32_device; struct stm32_pulse_encoder_device *stm32_device;
stm32_device = rt_container_of(pulse_encoder, struct stm32_pulse_encoder_device, pulse_encoder); stm32_device = (struct stm32_pulse_encoder_device*)pulse_encoder;
stm32_device->over_under_flowcount = 0; stm32_device->over_under_flowcount = 0;
__HAL_TIM_SET_COUNTER(&stm32_device->tim_handler, 0); __HAL_TIM_SET_COUNTER(&stm32_device->tim_handler, 0);
return RT_EOK; return RT_EOK;
...@@ -142,15 +142,15 @@ rt_err_t pulse_encoder_clear_count(struct rt_pulse_encoder_device *pulse_encoder ...@@ -142,15 +142,15 @@ rt_err_t pulse_encoder_clear_count(struct rt_pulse_encoder_device *pulse_encoder
rt_int32_t pulse_encoder_get_count(struct rt_pulse_encoder_device *pulse_encoder) rt_int32_t pulse_encoder_get_count(struct rt_pulse_encoder_device *pulse_encoder)
{ {
struct stm32_pulse_encoder_device *stm32_device; struct stm32_pulse_encoder_device *stm32_device;
stm32_device = rt_container_of(pulse_encoder, struct stm32_pulse_encoder_device, pulse_encoder); stm32_device = (struct stm32_pulse_encoder_device*)pulse_encoder;
return (rt_int32_t)((rt_int16_t)__HAL_TIM_GET_COUNTER(&stm32_device->tim_handler) + stm32_device->over_under_flowcount*AUTO_RELOAD_VALUE); return (rt_int32_t)((rt_int16_t)__HAL_TIM_GET_COUNTER(&stm32_device->tim_handler) + stm32_device->over_under_flowcount * AUTO_RELOAD_VALUE);
} }
rt_err_t pulse_encoder_control(struct rt_pulse_encoder_device *pulse_encoder, rt_uint32_t cmd, void *args) rt_err_t pulse_encoder_control(struct rt_pulse_encoder_device *pulse_encoder, rt_uint32_t cmd, void *args)
{ {
rt_err_t result; rt_err_t result;
struct stm32_pulse_encoder_device *stm32_device; struct stm32_pulse_encoder_device *stm32_device;
stm32_device = rt_container_of(pulse_encoder, struct stm32_pulse_encoder_device, pulse_encoder); stm32_device = (struct stm32_pulse_encoder_device*)pulse_encoder;
result = RT_EOK; result = RT_EOK;
...@@ -174,11 +174,11 @@ rt_err_t pulse_encoder_control(struct rt_pulse_encoder_device *pulse_encoder, rt ...@@ -174,11 +174,11 @@ rt_err_t pulse_encoder_control(struct rt_pulse_encoder_device *pulse_encoder, rt
void pulse_encoder_update_isr(struct stm32_pulse_encoder_device *device) void pulse_encoder_update_isr(struct stm32_pulse_encoder_device *device)
{ {
/* TIM Update event */ /* TIM Update event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_UPDATE) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_UPDATE) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_UPDATE); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_UPDATE);
if(__HAL_TIM_IS_TIM_COUNTING_DOWN(&device->tim_handler)) if (__HAL_TIM_IS_TIM_COUNTING_DOWN(&device->tim_handler))
{ {
device->over_under_flowcount--; device->over_under_flowcount--;
} }
...@@ -186,46 +186,52 @@ void pulse_encoder_update_isr(struct stm32_pulse_encoder_device *device) ...@@ -186,46 +186,52 @@ void pulse_encoder_update_isr(struct stm32_pulse_encoder_device *device)
{ {
device->over_under_flowcount++; device->over_under_flowcount++;
} }
} }
/* Capture compare 1 event */ /* Capture compare 1 event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC1) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC1) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC1); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC1);
} }
/* Capture compare 2 event */ /* Capture compare 2 event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC2) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC2) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC2); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC2);
} }
/* Capture compare 3 event */ /* Capture compare 3 event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC3) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC3) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC3); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC3);
} }
/* Capture compare 4 event */ /* Capture compare 4 event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC4) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_CC4) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC4); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_CC4);
} }
/* TIM Break input event */ /* TIM Break input event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_BREAK) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_BREAK) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_BREAK); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_BREAK);
} }
/* TIM Trigger detection event */ /* TIM Trigger detection event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_TRIGGER) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_TRIGGER) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_TRIGGER); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_IT_TRIGGER);
} }
/* TIM commutation event */ /* TIM commutation event */
if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_COM) != RESET) if (__HAL_TIM_GET_FLAG(&device->tim_handler, TIM_FLAG_COM) != RESET)
{ {
__HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_FLAG_COM); __HAL_TIM_CLEAR_IT(&device->tim_handler, TIM_FLAG_COM);
} }
} }
#ifdef BSP_USING_PULSE_ENCODER1 #ifdef BSP_USING_PULSE_ENCODER1
void TIM1_UP_TIM10_IRQHandler(void) #if defined(SOC_SERIES_STM32F4)
void TIM1_UP_TIM10_IRQHandler(void)
#elif defined(SOC_SERIES_STM32F1)
void TIM1_UP_IRQHandler(void)
#else
#error "Please check TIM1's IRQHandler"
#endif
{ {
/* enter interrupt */ /* enter interrupt */
rt_interrupt_enter(); rt_interrupt_enter();
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册