a
Dependencies: Locate Move Servo button mbed
Fork of 3servotest by
Encoder/EncoderInit.cpp@0:f12d257b587e, 2016-09-01 (annotated)
- Committer:
- sakanakuuun
- Date:
- Thu Sep 01 05:13:31 2016 +0000
- Revision:
- 0:f12d257b587e
;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sakanakuuun | 0:f12d257b587e | 1 | #include "mbed.h" |
sakanakuuun | 0:f12d257b587e | 2 | |
sakanakuuun | 0:f12d257b587e | 3 | void EncoderInit(TIM_Encoder_InitTypeDef * encoder, TIM_HandleTypeDef * timer, TIM_TypeDef * TIMx, uint32_t maxcount, uint32_t encmode) |
sakanakuuun | 0:f12d257b587e | 4 | { |
sakanakuuun | 0:f12d257b587e | 5 | |
sakanakuuun | 0:f12d257b587e | 6 | timer->Instance = TIMx; |
sakanakuuun | 0:f12d257b587e | 7 | timer->Init.Period = maxcount; |
sakanakuuun | 0:f12d257b587e | 8 | timer->Init.CounterMode = TIM_COUNTERMODE_UP; |
sakanakuuun | 0:f12d257b587e | 9 | timer->Init.Prescaler = 0; |
sakanakuuun | 0:f12d257b587e | 10 | timer->Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; |
sakanakuuun | 0:f12d257b587e | 11 | |
sakanakuuun | 0:f12d257b587e | 12 | encoder->EncoderMode = encmode; |
sakanakuuun | 0:f12d257b587e | 13 | |
sakanakuuun | 0:f12d257b587e | 14 | encoder->IC1Filter = 0x0F; |
sakanakuuun | 0:f12d257b587e | 15 | encoder->IC1Polarity = TIM_INPUTCHANNELPOLARITY_RISING; |
sakanakuuun | 0:f12d257b587e | 16 | encoder->IC1Prescaler = TIM_ICPSC_DIV4; |
sakanakuuun | 0:f12d257b587e | 17 | encoder->IC1Selection = TIM_ICSELECTION_DIRECTTI; |
sakanakuuun | 0:f12d257b587e | 18 | |
sakanakuuun | 0:f12d257b587e | 19 | encoder->IC2Filter = 0x0F; |
sakanakuuun | 0:f12d257b587e | 20 | encoder->IC2Polarity = TIM_INPUTCHANNELPOLARITY_FALLING; |
sakanakuuun | 0:f12d257b587e | 21 | encoder->IC2Prescaler = TIM_ICPSC_DIV4; |
sakanakuuun | 0:f12d257b587e | 22 | encoder->IC2Selection = TIM_ICSELECTION_DIRECTTI; |
sakanakuuun | 0:f12d257b587e | 23 | |
sakanakuuun | 0:f12d257b587e | 24 | |
sakanakuuun | 0:f12d257b587e | 25 | if (HAL_TIM_Encoder_Init(timer, encoder) != HAL_OK) { |
sakanakuuun | 0:f12d257b587e | 26 | printf("Couldn't Init Encoder\r\n"); |
sakanakuuun | 0:f12d257b587e | 27 | while (1) {} |
sakanakuuun | 0:f12d257b587e | 28 | } |
sakanakuuun | 0:f12d257b587e | 29 | |
sakanakuuun | 0:f12d257b587e | 30 | if(HAL_TIM_Encoder_Start(timer,TIM_CHANNEL_1)!=HAL_OK) { |
sakanakuuun | 0:f12d257b587e | 31 | printf("Couldn't Start Encoder\r\n"); |
sakanakuuun | 0:f12d257b587e | 32 | while (1) {} |
sakanakuuun | 0:f12d257b587e | 33 | } |
sakanakuuun | 0:f12d257b587e | 34 | } |
sakanakuuun | 0:f12d257b587e | 35 |