79 lines
2.3 KiB
C
79 lines
2.3 KiB
C
#include "memecoder.h"
|
|
#include "ch32v20x.h"
|
|
|
|
|
|
int memecoder_prev_state = 0;
|
|
int memecoder_count = 0;
|
|
|
|
|
|
void memecoder_init() {
|
|
// Enable GPIOA
|
|
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
|
|
|
|
// Set up GPIO on port A
|
|
GPIO_InitTypeDef GPIO_InitStructure;
|
|
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
|
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD;
|
|
|
|
// PHASE_A - PA0
|
|
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
|
|
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
|
|
|
// PHASE_B - PA1
|
|
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
|
|
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
|
|
|
TIM_DeInit(TIM2);
|
|
|
|
TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
|
|
TIM_TimeBaseStructInit(&TIM_TimeBaseInitStructure);
|
|
TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStructure);
|
|
|
|
TIM_ICInitTypeDef TIM_ICInitTypeDefStructure;
|
|
TIM_ICStructInit(&TIM_ICInitTypeDefStructure);
|
|
TIM_ICInit(TIM2, &TIM_ICInitTypeDefStructure);
|
|
TIM_ICInitTypeDefStructure.TIM_Channel = TIM_Channel_2;
|
|
TIM_ICInit(TIM2, &TIM_ICInitTypeDefStructure);
|
|
|
|
TIM_EncoderInterfaceConfig(TIM2, TIM_EncoderMode_TI12, TIM_ICPolarity_Falling, TIM_ICPolarity_Falling);
|
|
TIM_Cmd(TIM2, ENABLE);
|
|
}
|
|
|
|
void memecoder_update() {
|
|
// u8 cur_state =
|
|
// GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_12) << 0 |
|
|
// GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_13) << 1;// |
|
|
// GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_14) << 2;
|
|
|
|
// if(cur_state != memecoder_prev_state) {
|
|
// printf("%d\r\n", cur_state);
|
|
// if( (memecoder_prev_state == 0 && cur_state == 1) ||
|
|
// (memecoder_prev_state == 1 && cur_state == 3) ||
|
|
// (memecoder_prev_state == 3 && cur_state == 2) ||
|
|
// (memecoder_prev_state == 2 && cur_state == 0)) {
|
|
// if( (memecoder_prev_state == 1 && cur_state == 3) ||
|
|
// (memecoder_prev_state == 3 && cur_state == 2) ||
|
|
// (memecoder_prev_state == 2 && cur_state == 6) ||
|
|
// (memecoder_prev_state == 6 && cur_state == 4) ||
|
|
// (memecoder_prev_state == 4 && cur_state == 5) ||
|
|
// (memecoder_prev_state == 5 && cur_state == 1)) {
|
|
// memecoder_count++;
|
|
// } else {
|
|
// memecoder_count--;
|
|
// }
|
|
|
|
// memecoder_prev_state = cur_state;
|
|
// }
|
|
}
|
|
|
|
void memecoder_set(int value) {
|
|
memecoder_count = value;
|
|
}
|
|
|
|
int memecoder_get() {
|
|
return (int16_t)TIM_GetCounter(TIM2) / 4;
|
|
}
|
|
|
|
void memecoder_zero() {
|
|
memecoder_count = 0;
|
|
}
|