tarou yamada
It is based on https://developer.mbed.org/users/gregeric/code/Nucleo_Hello_Encoder/
rotary_encoder_base/rotary_encoder_base.cpp@4:d07f58c46a79, 2016-04-03 (annotated)
- Committer:
- inst
- Date:
- Sun Apr 03 06:30:19 2016 +0000
- Revision:
- 4:d07f58c46a79
- Parent:
- 3:65021ea3fae5
- Child:
- 5:fae9a340d212
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| inst | 0:caf1d0bc4b90 | 1 | #include "rotary_encoder_base.hpp" |
| inst | 0:caf1d0bc4b90 | 2 | #include "rotary_encoder.hpp" |
| inst | 3:65021ea3fae5 | 3 | #include "mbed.h" |
| inst | 0:caf1d0bc4b90 | 4 | |
| inst | 2:4580c3869b7b | 5 | namespace mbed_stl { |
| inst | 2:4580c3869b7b | 6 | |
| inst | 0:caf1d0bc4b90 | 7 | rotary_encoder_base::rotary_encoder_base(TIM_TypeDef* timer_type, |
| inst | 0:caf1d0bc4b90 | 8 | uint32_t encoder_mode, |
| inst | 0:caf1d0bc4b90 | 9 | size_t resolution) : rotary_encoder(resolution) { |
| inst | 4:d07f58c46a79 | 10 | |
| inst | 4:d07f58c46a79 | 11 | |
| inst | 4:d07f58c46a79 | 12 | |
| inst | 4:d07f58c46a79 | 13 | // todo:delete debug |
| inst | 4:d07f58c46a79 | 14 | encoder_mode = TIM_ENCODERMODE_TI12; |
| inst | 4:d07f58c46a79 | 15 | resolution = 400; |
| inst | 4:d07f58c46a79 | 16 | |
| inst | 0:caf1d0bc4b90 | 17 | |
| inst | 3:65021ea3fae5 | 18 | timer_handler_.Instance = timer_type; |
| inst | 3:65021ea3fae5 | 19 | timer_handler_.Init.Period = max_counts_; |
| inst | 3:65021ea3fae5 | 20 | timer_handler_.Init.CounterMode = TIM_COUNTERMODE_UP; |
| inst | 3:65021ea3fae5 | 21 | timer_handler_.Init.Prescaler = 0; |
| inst | 3:65021ea3fae5 | 22 | timer_handler_.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; |
| inst | 3:65021ea3fae5 | 23 | |
| inst | 3:65021ea3fae5 | 24 | TIM_Encoder_InitTypeDef encoder; |
| inst | 0:caf1d0bc4b90 | 25 | encoder.EncoderMode = encoder_mode; |
| inst | 3:65021ea3fae5 | 26 | |
| inst | 0:caf1d0bc4b90 | 27 | encoder.IC1Filter = 0x0F; |
| inst | 0:caf1d0bc4b90 | 28 | encoder.IC1Polarity = TIM_INPUTCHANNELPOLARITY_RISING; |
| inst | 0:caf1d0bc4b90 | 29 | encoder.IC1Prescaler = TIM_ICPSC_DIV4; |
| inst | 0:caf1d0bc4b90 | 30 | encoder.IC1Selection = TIM_ICSELECTION_DIRECTTI; |
| inst | 0:caf1d0bc4b90 | 31 | |
| inst | 0:caf1d0bc4b90 | 32 | encoder.IC2Filter = 0x0F; |
| inst | 0:caf1d0bc4b90 | 33 | encoder.IC2Polarity = TIM_INPUTCHANNELPOLARITY_FALLING; |
| inst | 0:caf1d0bc4b90 | 34 | encoder.IC2Prescaler = TIM_ICPSC_DIV4; |
| inst | 0:caf1d0bc4b90 | 35 | encoder.IC2Selection = TIM_ICSELECTION_DIRECTTI; |
| inst | 3:65021ea3fae5 | 36 | |
| inst | 3:65021ea3fae5 | 37 | //////////////////////////////////////// |
| inst | 3:65021ea3fae5 | 38 | //printf("t:%d, e:%d", &timer_handler_, &encoder); |
| inst | 3:65021ea3fae5 | 39 | if (HAL_TIM_Encoder_Init(&timer_handler_, &encoder) != HAL_OK) { |
| inst | 3:65021ea3fae5 | 40 | error("couldn't init encoder\n"); |
| inst | 0:caf1d0bc4b90 | 41 | } |
| inst | 3:65021ea3fae5 | 42 | //printf("%d end\n", cnt++); |
| inst | 3:65021ea3fae5 | 43 | /////////////////////////////////////////// |
| inst | 0:caf1d0bc4b90 | 44 | } |
| inst | 0:caf1d0bc4b90 | 45 | |
| inst | 3:65021ea3fae5 | 46 | rotary_encoder_base::~rotary_encoder_base() {} |
| inst | 3:65021ea3fae5 | 47 | |
| inst | 0:caf1d0bc4b90 | 48 | int32_t rotary_encoder_base::get_counts() const { |
| inst | 3:65021ea3fae5 | 49 | int32_t counts = timer_handler_.Instance->CNT; |
| inst | 0:caf1d0bc4b90 | 50 | |
| inst | 0:caf1d0bc4b90 | 51 | if (counts > (max_counts_ >> 1)) { |
| inst | 0:caf1d0bc4b90 | 52 | return counts - max_counts_; |
| inst | 0:caf1d0bc4b90 | 53 | } |
| inst | 0:caf1d0bc4b90 | 54 | return counts; |
| inst | 0:caf1d0bc4b90 | 55 | } |
| inst | 0:caf1d0bc4b90 | 56 | |
| inst | 0:caf1d0bc4b90 | 57 | void rotary_encoder_base::reset() { |
| inst | 3:65021ea3fae5 | 58 | timer_handler_.Instance->CNT = 0; |
| inst | 0:caf1d0bc4b90 | 59 | } |
| inst | 0:caf1d0bc4b90 | 60 | |
| inst | 0:caf1d0bc4b90 | 61 | void rotary_encoder_base::start() { |
| inst | 3:65021ea3fae5 | 62 | if(HAL_TIM_Encoder_Start(&timer_handler_, TIM_CHANNEL_1) != HAL_OK) { |
| inst | 0:caf1d0bc4b90 | 63 | error("couldn't start encoder\r\n"); |
| inst | 0:caf1d0bc4b90 | 64 | } |
| inst | 0:caf1d0bc4b90 | 65 | } |
| inst | 0:caf1d0bc4b90 | 66 | |
| inst | 0:caf1d0bc4b90 | 67 | void rotary_encoder_base::stop() { |
| inst | 3:65021ea3fae5 | 68 | if(HAL_TIM_Encoder_Stop(&timer_handler_, TIM_CHANNEL_1) != HAL_OK) { |
| inst | 0:caf1d0bc4b90 | 69 | error("couldn't start encoder\r\n"); |
| inst | 0:caf1d0bc4b90 | 70 | } |
| inst | 0:caf1d0bc4b90 | 71 | } |
| inst | 2:4580c3869b7b | 72 | |
| inst | 2:4580c3869b7b | 73 | } /* namespace mbed_stl */ |