Sungwoo Kim / Mbed 2 deprecated HydraulicControlBoard_Rainbow_v1_2_copy

2011

Dependencies:   mbed FastPWM

INIT_HW/INIT_HW.cpp@244:8586c11b4c30, 23 months ago (annotated)

Committer:
Lightvalve
Date:
Mon Aug 01 09:49:00 2022 +0000
Revision:
244:8586c11b4c30
Parent:
241:c53d4c26b04a 
220801

Who changed what in which revision?

UserRevisionLine numberNew contents of line
GiJeongKim 0:51c43836c1d7 1 #include "mbed.h"
GiJeongKim 0:51c43836c1d7 2 #include "FastPWM.h"
GiJeongKim 0:51c43836c1d7 3 #include "setting.h"
GiJeongKim 0:51c43836c1d7 4
Lightvalve 231:30896263bd8b 5 extern ADC_HandleTypeDef hadc1;
Lightvalve 231:30896263bd8b 6 extern ADC_HandleTypeDef hadc2;
Lightvalve 232:e9c5ec04e378 7 extern ADC_HandleTypeDef hadc3;
Lightvalve 231:30896263bd8b 8
Lightvalve 232:e9c5ec04e378 9 void Init_ADC1(void)
Lightvalve 231:30896263bd8b 10 {
Lightvalve 235:bfdf0f479a38 11 /*
Lightvalve 235:bfdf0f479a38 12 // ADC Setup
Lightvalve 235:bfdf0f479a38 13 // RCC->APB2ENR |= RCC_APB2ENR_ADC3EN; // clock for ADC3
Lightvalve 235:bfdf0f479a38 14 // RCC->APB2ENR |= RCC_APB2ENR_ADC2EN; // clock for ADC2
Lightvalve 235:bfdf0f479a38 15 RCC->APB2ENR |= RCC_APB2ENR_ADC1EN; // clock for ADC1
Lightvalve 235:bfdf0f479a38 16 RCC->AHB1ENR |= RCC_AHB1ENR_GPIOCEN; // Enable clock for GPIOC
Lightvalve 235:bfdf0f479a38 17 // RCC->AHB1ENR |= RCC_AHB1ENR_GPIOBEN; // Enable clock for GPIOB
Lightvalve 235:bfdf0f479a38 18 ADC1->CR2 |= ADC_CR2_ADON;//0x00000001; // ADC1 ON
Lightvalve 235:bfdf0f479a38 19 // ADC->CCR = 0x00000016; // Regular simultaneous mode only
Lightvalve 235:bfdf0f479a38 20 ADC1->CR1 |= 0x800; // Discontinuous mode
Lightvalve 235:bfdf0f479a38 21 ADC1->CR1 |= 0x100; // Scan mode
Lightvalve 235:bfdf0f479a38 22 ADC1->CR2 |= 0x400; // EOC
Lightvalve 235:bfdf0f479a38 23 ADC1->SQR1 |= 0x100000; // 2 conversions
Lightvalve 235:bfdf0f479a38 24 // ADC1->SQR3 = 0x00000008; // use PB_0 as input - ADC1_IN8
Lightvalve 235:bfdf0f479a38 25 ADC1->SQR3 |= 0x0000000E; //channel // use PC_4 as input - ADC1_IN14
Lightvalve 235:bfdf0f479a38 26 ADC1->SQR3 |= 0x000001E0; // use PC_5 as input - ADC1_IN15 0b0000 0000 0000 0000 0000 0001 1110 0000
Lightvalve 235:bfdf0f479a38 27 // ADC2->CR2 |= ADC_CR2_ADON;//0x00000001; // ADC2 ON
Lightvalve 235:bfdf0f479a38 28 // ADC2->SQR3 = 0x00000008; // use PB_0 as input - ADC2_IN8
Lightvalve 235:bfdf0f479a38 29 // ADC3->CR2 |= ADC_CR2_ADON; // ADC3 ON00000000000
Lightvalve 235:bfdf0f479a38 30 // ADC3->SQR3 = 0x0000000B; // use PC_1, - ADC3_IN11
Lightvalve 235:bfdf0f479a38 31 GPIOC->MODER |= 0b111100000000; //each channel // PC_4, PC_5 are analog inputs
Lightvalve 235:bfdf0f479a38 32 // GPIOB->MODER |= 0x3; // PB_0 as analog input
Lightvalve 235:bfdf0f479a38 33 // ADC1->SMPR2 |= 0x01000000; // 15 cycles on CH_8, 0b0000000100000000<<16
Lightvalve 235:bfdf0f479a38 34 // ADC1->SMPR1 |= 0x00001000; // 15 cycles on CH_14
Lightvalve 235:bfdf0f479a38 35 // ADC1->SMPR1 |= 0x00008000; // 15 cycles on CH_15
Lightvalve 235:bfdf0f479a38 36 // ADC2->SMPR2 |= 0x01000000; // 15 cycles on CH_8, 0b0000000100000000<<16
Lightvalve 235:bfdf0f479a38 37 // ADC3->SMPR1 |= 0x00000008; // 15 cycles on CH_11, 0b0000000000001000
Lightvalve 235:bfdf0f479a38 38
Lightvalve 235:bfdf0f479a38 39 */
Lightvalve 232:e9c5ec04e378 40
Lightvalve 235:bfdf0f479a38 41 //////////////////////////////////////////////////ADC1////////////////////////////////////////////////
Lightvalve 235:bfdf0f479a38 42 ADC_ChannelConfTypeDef sConfig = {0};
Lightvalve 232:e9c5ec04e378 43
Lightvalve 235:bfdf0f479a38 44 hadc1.Instance = ADC1;
Lightvalve 235:bfdf0f479a38 45 hadc1.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV4;
Lightvalve 235:bfdf0f479a38 46 hadc1.Init.Resolution = ADC_RESOLUTION_12B;
Lightvalve 235:bfdf0f479a38 47 hadc1.Init.ScanConvMode = ENABLE;
Lightvalve 235:bfdf0f479a38 48 hadc1.Init.ContinuousConvMode = DISABLE;
Lightvalve 235:bfdf0f479a38 49 hadc1.Init.DiscontinuousConvMode = ENABLE;
Lightvalve 235:bfdf0f479a38 50 hadc1.Init.NbrOfDiscConversion = 1;
Lightvalve 235:bfdf0f479a38 51 hadc1.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
Lightvalve 235:bfdf0f479a38 52 hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
Lightvalve 235:bfdf0f479a38 53 hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
Lightvalve 235:bfdf0f479a38 54 hadc1.Init.NbrOfConversion = 2;
Lightvalve 235:bfdf0f479a38 55 hadc1.Init.DMAContinuousRequests = DISABLE;
Lightvalve 235:bfdf0f479a38 56 hadc1.Init.EOCSelection = ADC_EOC_SINGLE_CONV;
Lightvalve 235:bfdf0f479a38 57 if (HAL_ADC_Init(&hadc1) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 58 // Error_Handler();
Lightvalve 235:bfdf0f479a38 59 }
Lightvalve 235:bfdf0f479a38 60 sConfig.Channel = ADC_CHANNEL_14;
Lightvalve 235:bfdf0f479a38 61 sConfig.Rank = 1;
Lightvalve 235:bfdf0f479a38 62 sConfig.SamplingTime = ADC_SAMPLETIME_3CYCLES;
Lightvalve 235:bfdf0f479a38 63 if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 64 // Error_Handler();
Lightvalve 235:bfdf0f479a38 65 }
Lightvalve 235:bfdf0f479a38 66 sConfig.Channel = ADC_CHANNEL_15;
Lightvalve 235:bfdf0f479a38 67 sConfig.Rank = 2;
Lightvalve 235:bfdf0f479a38 68 if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 69 // Error_Handler();
Lightvalve 235:bfdf0f479a38 70 }
Lightvalve 235:bfdf0f479a38 71 hadc1.Instance->CR2 |= ADC_CR2_ADON;
Lightvalve 231:30896263bd8b 72 }
Lightvalve 231:30896263bd8b 73
Lightvalve 232:e9c5ec04e378 74 void Init_ADC2(void)
Lightvalve 232:e9c5ec04e378 75 {
Lightvalve 235:bfdf0f479a38 76
Lightvalve 235:bfdf0f479a38 77 //////////////////////////////////////////////////ADC2////////////////////////////////////////////////
Lightvalve 235:bfdf0f479a38 78 ADC_ChannelConfTypeDef sConfig = {0};
Lightvalve 235:bfdf0f479a38 79
Lightvalve 235:bfdf0f479a38 80 hadc2.Instance = ADC2;
Lightvalve 235:bfdf0f479a38 81 hadc2.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV4;
Lightvalve 235:bfdf0f479a38 82 hadc2.Init.Resolution = ADC_RESOLUTION_12B;
Lightvalve 235:bfdf0f479a38 83 hadc2.Init.ScanConvMode = ENABLE;
Lightvalve 235:bfdf0f479a38 84 hadc2.Init.ContinuousConvMode = DISABLE;
Lightvalve 235:bfdf0f479a38 85 hadc2.Init.DiscontinuousConvMode = ENABLE;
Lightvalve 235:bfdf0f479a38 86 hadc2.Init.NbrOfDiscConversion = 1;
Lightvalve 235:bfdf0f479a38 87 hadc2.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
Lightvalve 235:bfdf0f479a38 88 hadc2.Init.ExternalTrigConv = ADC_SOFTWARE_START;
Lightvalve 235:bfdf0f479a38 89 hadc2.Init.DataAlign = ADC_DATAALIGN_RIGHT;
Lightvalve 235:bfdf0f479a38 90 hadc2.Init.NbrOfConversion = 2;
Lightvalve 235:bfdf0f479a38 91 hadc2.Init.DMAContinuousRequests = DISABLE;
Lightvalve 235:bfdf0f479a38 92 hadc2.Init.EOCSelection = ADC_EOC_SINGLE_CONV;
Lightvalve 235:bfdf0f479a38 93 if (HAL_ADC_Init(&hadc2) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 94 // Error_Handler();
Lightvalve 235:bfdf0f479a38 95 }
Lightvalve 235:bfdf0f479a38 96 sConfig.Channel = ADC_CHANNEL_11;
Lightvalve 235:bfdf0f479a38 97 sConfig.Rank = 1;
Lightvalve 235:bfdf0f479a38 98 sConfig.SamplingTime = ADC_SAMPLETIME_3CYCLES;
Lightvalve 235:bfdf0f479a38 99 if (HAL_ADC_ConfigChannel(&hadc2, &sConfig) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 100 // Error_Handler();
Lightvalve 235:bfdf0f479a38 101 }
Lightvalve 235:bfdf0f479a38 102 sConfig.Channel = ADC_CHANNEL_9;
Lightvalve 235:bfdf0f479a38 103 sConfig.Rank = 2;
Lightvalve 235:bfdf0f479a38 104 if (HAL_ADC_ConfigChannel(&hadc2, &sConfig) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 105 // Error_Handler();
Lightvalve 235:bfdf0f479a38 106 }
Lightvalve 235:bfdf0f479a38 107 hadc2.Instance->CR2 |= ADC_CR2_ADON;
Lightvalve 232:e9c5ec04e378 108 }
Lightvalve 231:30896263bd8b 109
Lightvalve 232:e9c5ec04e378 110 void Init_ADC3(void)
Lightvalve 231:30896263bd8b 111 {
Lightvalve 235:bfdf0f479a38 112 //////////////////////////////////////////////////ADC3////////////////////////////////////////////////
Lightvalve 235:bfdf0f479a38 113 ADC_ChannelConfTypeDef sConfig = {0};
Lightvalve 235:bfdf0f479a38 114
Lightvalve 235:bfdf0f479a38 115 hadc3.Instance = ADC3;
Lightvalve 235:bfdf0f479a38 116 hadc3.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV4;
Lightvalve 235:bfdf0f479a38 117 hadc3.Init.Resolution = ADC_RESOLUTION_12B;
Lightvalve 235:bfdf0f479a38 118 hadc3.Init.ScanConvMode = DISABLE;
Lightvalve 235:bfdf0f479a38 119 hadc3.Init.ContinuousConvMode = DISABLE;
Lightvalve 235:bfdf0f479a38 120 hadc3.Init.DiscontinuousConvMode = DISABLE;
Lightvalve 235:bfdf0f479a38 121 hadc3.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
Lightvalve 235:bfdf0f479a38 122 hadc3.Init.ExternalTrigConv = ADC_SOFTWARE_START;
Lightvalve 235:bfdf0f479a38 123 hadc3.Init.DataAlign = ADC_DATAALIGN_RIGHT;
Lightvalve 235:bfdf0f479a38 124 hadc3.Init.NbrOfConversion = 1;
Lightvalve 235:bfdf0f479a38 125 hadc3.Init.DMAContinuousRequests = DISABLE;
Lightvalve 235:bfdf0f479a38 126 hadc3.Init.EOCSelection = ADC_EOC_SEQ_CONV;
Lightvalve 235:bfdf0f479a38 127 if (HAL_ADC_Init(&hadc3) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 128 // Error_Handler();
Lightvalve 235:bfdf0f479a38 129 }
Lightvalve 235:bfdf0f479a38 130 sConfig.Channel = ADC_CHANNEL_1;
Lightvalve 235:bfdf0f479a38 131 sConfig.Rank = 1;
Lightvalve 235:bfdf0f479a38 132 sConfig.SamplingTime = ADC_SAMPLETIME_3CYCLES;
Lightvalve 235:bfdf0f479a38 133 if (HAL_ADC_ConfigChannel(&hadc3, &sConfig) != HAL_OK) {
Lightvalve 232:e9c5ec04e378 134 // Error_Handler();
Lightvalve 235:bfdf0f479a38 135 }
Lightvalve 235:bfdf0f479a38 136 hadc3.Instance->CR2 |= ADC_CR2_ADON;
Lightvalve 232:e9c5ec04e378 137 }
GiJeongKim 0:51c43836c1d7 138
Lightvalve 11:82d8768d7351 139
Lightvalve 231:30896263bd8b 140 void Init_TMR3()
Lightvalve 231:30896263bd8b 141 {
Lightvalve 241:c53d4c26b04a 142 ///////////////Trigger by TIMER 1/////////////////////////////////
Lightvalve 241:c53d4c26b04a 143
Lightvalve 11:82d8768d7351 144 RCC->APB1ENR |= RCC_APB1ENR_TIM3EN; // enable TIM3 clock
Lightvalve 228:fb5b57e3f157 145 NVIC_EnableIRQ(TIM3_IRQn); //Enable TIM3 IRQ
Lightvalve 11:82d8768d7351 146
Lightvalve 11:82d8768d7351 147 TIM3->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 241:c53d4c26b04a 148 TIM3->CR1 = 0x10;
Lightvalve 11:82d8768d7351 149 TIM3->CR1 |= TIM_CR1_UDIS;
Lightvalve 11:82d8768d7351 150 TIM3->EGR |= TIM_EGR_UG;
Lightvalve 11:82d8768d7351 151
Lightvalve 241:c53d4c26b04a 152 TIM3->PSC = 1-1; // 10kHz
Lightvalve 241:c53d4c26b04a 153 TIM3->ARR = 1;
Lightvalve 235:bfdf0f479a38 154 TIM3->CNT = 0;
Lightvalve 235:bfdf0f479a38 155 TIM3->SR = 0;
Lightvalve 241:c53d4c26b04a 156 TIM3->SMCR = 0x07; //External clock mode
Lightvalve 241:c53d4c26b04a 157 TIM3->CR1 |= TIM_CR1_CEN; // enable TIM3
Lightvalve 241:c53d4c26b04a 158
Lightvalve 241:c53d4c26b04a 159 // RCC->APB1ENR |= RCC_APB1ENR_TIM3EN; // enable TIM3 clock
Lightvalve 241:c53d4c26b04a 160 // NVIC_EnableIRQ(TIM3_IRQn); //Enable TIM3 IRQ
Lightvalve 241:c53d4c26b04a 161 //
Lightvalve 241:c53d4c26b04a 162 // TIM3->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 241:c53d4c26b04a 163 // TIM3->CR1 = 0x40; // CMS = 10, interrupt only when counting up // Center-aligned mode
Lightvalve 241:c53d4c26b04a 164 // TIM3->CR1 |= TIM_CR1_UDIS;
Lightvalve 241:c53d4c26b04a 165 // TIM3->RCR |= 0x001; // update event once per up/down count of TIM3
Lightvalve 241:c53d4c26b04a 166 // TIM3->EGR |= TIM_EGR_UG;
Lightvalve 241:c53d4c26b04a 167 //
Lightvalve 241:c53d4c26b04a 168 // TIM3->PSC = 0x00; // no prescaler, timer counts up in sync with the peripheral clock
Lightvalve 241:c53d4c26b04a 169 // TIM3->ARR = TMR3_COUNT-1; // set auto reload, 5 khz
Lightvalve 241:c53d4c26b04a 170 // TIM3->CNT = 0;
Lightvalve 241:c53d4c26b04a 171 // TIM3->SR = 0;
Lightvalve 241:c53d4c26b04a 172 // TIM3->CCER |= ~(TIM_CCER_CC1NP); // Interupt when low side is on.
Lightvalve 241:c53d4c26b04a 173 // TIM3->CR1 |= TIM_CR1_CEN; // enable TIM4
Lightvalve 20:806196fda269 174 }
Lightvalve 20:806196fda269 175
Lightvalve 231:30896263bd8b 176 void Init_TMR2()
Lightvalve 231:30896263bd8b 177 {
Lightvalve 241:c53d4c26b04a 178 ///////////////Trigger by TIMER 1/////////////////////////////////
Lightvalve 241:c53d4c26b04a 179
Lightvalve 228:fb5b57e3f157 180 RCC->APB1ENR |= RCC_APB1ENR_TIM2EN; // enable TIM2 clock
Lightvalve 228:fb5b57e3f157 181 NVIC_EnableIRQ(TIM2_IRQn); //Enable TIM2 IRQ
Lightvalve 20:806196fda269 182
Lightvalve 23:59218d4a256d 183 TIM2->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 241:c53d4c26b04a 184 TIM2->CR1 = 0x10;
Lightvalve 23:59218d4a256d 185 TIM2->CR1 |= TIM_CR1_UDIS;
Lightvalve 23:59218d4a256d 186 TIM2->EGR |= TIM_EGR_UG;
Lightvalve 20:806196fda269 187
Lightvalve 241:c53d4c26b04a 188 TIM2->PSC = 2-1; // 20 prescaler, 5kHz
Lightvalve 241:c53d4c26b04a 189 TIM2->ARR = 1;
Lightvalve 235:bfdf0f479a38 190 TIM2->CNT = 0;
Lightvalve 235:bfdf0f479a38 191 TIM2->SR = 0;
Lightvalve 241:c53d4c26b04a 192 TIM2->SMCR = 0x07; //External clock mode
Lightvalve 228:fb5b57e3f157 193 TIM2->CR1 |= TIM_CR1_CEN; // enable TIM2
Lightvalve 241:c53d4c26b04a 194
Lightvalve 241:c53d4c26b04a 195
Lightvalve 241:c53d4c26b04a 196 ////////////////Trigger by Internal Clock/////////////////////////////////
Lightvalve 241:c53d4c26b04a 197 // RCC->APB1ENR |= RCC_APB1ENR_TIM2EN; // enable TIM2 clock
Lightvalve 241:c53d4c26b04a 198 // //ISR Setup
Lightvalve 241:c53d4c26b04a 199 // NVIC_EnableIRQ(TIM2_IRQn); //Enable TIM2 IRQ
Lightvalve 241:c53d4c26b04a 200 // TIM2->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 241:c53d4c26b04a 201 // TIM2->CR1 = 0x40; // CMS = 10, interrupt only when counting up // Center-aligned mode
Lightvalve 241:c53d4c26b04a 202 // TIM2->CR1 |= TIM_CR1_UDIS;
Lightvalve 241:c53d4c26b04a 203 // TIM2->RCR |= 0x001; // update event once per up/down count of TIM2
Lightvalve 241:c53d4c26b04a 204 // TIM2->EGR |= TIM_EGR_UG;
Lightvalve 241:c53d4c26b04a 205 // TIM2->PSC = 0x00; // no prescaler, timer counts up in sync with the peripheral clock
Lightvalve 241:c53d4c26b04a 206 // TIM2->ARR = TMR2_COUNT-1; // set auto reload, 5 khz
Lightvalve 241:c53d4c26b04a 207 // TIM2->CNT = 0;
Lightvalve 241:c53d4c26b04a 208 // TIM2->SR = 0;
Lightvalve 241:c53d4c26b04a 209 // TIM2->CR1 |= TIM_CR1_CEN; // enable TIM2
Lightvalve 228:fb5b57e3f157 210 }
Lightvalve 228:fb5b57e3f157 211
Lightvalve 235:bfdf0f479a38 212
Lightvalve 231:30896263bd8b 213 void Init_TMR1()
Lightvalve 231:30896263bd8b 214 {
Lightvalve 241:c53d4c26b04a 215 ///////////////////PWM output by L6205D/////////////////////////////////
Lightvalve 241:c53d4c26b04a 216
Lightvalve 241:c53d4c26b04a 217 RCC->APB2ENR |= RCC_APB2ENR_TIM1EN; // enable TIM1 clock
Lightvalve 240:3ffd78cbd029 218 FastPWM pwm_v(PIN_H1);
Lightvalve 240:3ffd78cbd029 219 FastPWM pwm_w(PIN_L1);
Lightvalve 241:c53d4c26b04a 220
Lightvalve 235:bfdf0f479a38 221 TIM1->CR2 |= 0x20; //MMS = 010
Lightvalve 231:30896263bd8b 222 TIM1->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 231:30896263bd8b 223 TIM1->CR1 = 0x40; // CMS = 10, interrupt only when counting up // Center-aligned mode
Lightvalve 231:30896263bd8b 224 TIM1->CR1 |= TIM_CR1_UDIS;
Lightvalve 231:30896263bd8b 225 TIM1->CR1 |= TIM_CR1_ARPE; // autoreload on,
Lightvalve 235:bfdf0f479a38 226 TIM1->RCR |= 0x001; // update event once per up/down count of TIM1
Lightvalve 231:30896263bd8b 227 TIM1->EGR |= TIM_EGR_UG;
Lightvalve 232:e9c5ec04e378 228 TIM1->CCMR1 |= 0x60; //CH1 - PWM mode 1
Lightvalve 235:bfdf0f479a38 229 TIM1->PSC = 0x0; // no prescaler, timer counts up in sync with the peripheral clock
Lightvalve 232:e9c5ec04e378 230 TIM1->ARR = TMR1_COUNT-1; // set auto reload, 20 khz
Lightvalve 235:bfdf0f479a38 231 TIM1->CNT = 0;
Lightvalve 235:bfdf0f479a38 232 TIM1->SR = 0;
Lightvalve 240:3ffd78cbd029 233 TIM1->CR1 |= TIM_CR1_CEN; // enable TIM1
Lightvalve 240:3ffd78cbd029 234
Lightvalve 235:bfdf0f479a38 235
Lightvalve 241:c53d4c26b04a 236 ///////////////////PWM output by IRSM045MA/////////////////////////////////
Lightvalve 240:3ffd78cbd029 237 // RCC->APB2ENR |= RCC_APB2ENR_TIM1EN; // enable TIM1 clock
Lightvalve 240:3ffd78cbd029 238 //
Lightvalve 240:3ffd78cbd029 239 // FastPWM pwm_H1(PIN_H1);
Lightvalve 240:3ffd78cbd029 240 // FastPWM pwm_L1(PIN_L1);
Lightvalve 240:3ffd78cbd029 241 // FastPWM pwm_H2(PIN_H2);
Lightvalve 240:3ffd78cbd029 242 // FastPWM pwm_L2(PIN_L2);
Lightvalve 240:3ffd78cbd029 243 //
Lightvalve 240:3ffd78cbd029 244 //
Lightvalve 240:3ffd78cbd029 245 // TIM1->CR2 |= 0x20; //MMS = 010
Lightvalve 240:3ffd78cbd029 246 //
Lightvalve 240:3ffd78cbd029 247 //
Lightvalve 240:3ffd78cbd029 248 // TIM1->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 240:3ffd78cbd029 249 // TIM1->CR1 = 0x40; // CMS = 10, interrupt only when counting up // Center-aligned mode
Lightvalve 240:3ffd78cbd029 250 //// TIM1->CR1 = 0x10; // CMS = 10, interrupt only when counting up // Center-aligned mode
Lightvalve 240:3ffd78cbd029 251 // TIM1->CR1 |= TIM_CR1_UDIS;
Lightvalve 240:3ffd78cbd029 252 // TIM1->CR1 |= TIM_CR1_ARPE; // autoreload on,
Lightvalve 240:3ffd78cbd029 253 // TIM1->RCR |= 0x001; // update event once per up/down count of TIM1
Lightvalve 240:3ffd78cbd029 254 // TIM1->EGR |= TIM_EGR_UG;
Lightvalve 240:3ffd78cbd029 255 //
Lightvalve 240:3ffd78cbd029 256 // TIM1->CCMR1 |= 0x60; //CH1 - PWM mode 1
Lightvalve 240:3ffd78cbd029 257 // TIM1->CCMR1 |= 0x6000; //CH2 - PWM mode 1
Lightvalve 240:3ffd78cbd029 258 //
Lightvalve 240:3ffd78cbd029 259 // TIM1->PSC = 0x0; // no prescaler, timer counts up in sync with the peripheral clock
Lightvalve 240:3ffd78cbd029 260 // TIM1->ARR = TMR1_COUNT-1; // set auto reload, 20 khz
Lightvalve 240:3ffd78cbd029 261 // TIM1->CNT = 0;
Lightvalve 240:3ffd78cbd029 262 // TIM1->SR = 0;
Lightvalve 240:3ffd78cbd029 263 // TIM1->CCER |= 0x05; // CC1E = 1, CC1P = 0, CC1NE = 1, CC1NP = 0
Lightvalve 240:3ffd78cbd029 264 // TIM1->CCER |= 0x50; // CC2E = 1, CC2P = 0, CC2NE = 1, CC2NP = 0
Lightvalve 240:3ffd78cbd029 265 //
Lightvalve 240:3ffd78cbd029 266 // TIM1->BDTR |= 0x8000; // MOE = 1;
Lightvalve 240:3ffd78cbd029 267 //// TIM1->BDTR |= 0x7F; // Dead-time
Lightvalve 240:3ffd78cbd029 268 // TIM1->BDTR |= 0x05;
Lightvalve 240:3ffd78cbd029 269 // TIM1->CR1 |= TIM_CR1_CEN; // enable TIM1
Lightvalve 235:bfdf0f479a38 270 }
Lightvalve 235:bfdf0f479a38 271
Lightvalve 235:bfdf0f479a38 272 void Init_TIM4()
Lightvalve 235:bfdf0f479a38 273 {
Lightvalve 235:bfdf0f479a38 274 RCC->APB1ENR |= RCC_APB1ENR_TIM4EN; // enable TIM4 clock
Lightvalve 235:bfdf0f479a38 275
Lightvalve 235:bfdf0f479a38 276 NVIC_EnableIRQ(TIM4_IRQn); //Enable TIM4 IRQ
Lightvalve 235:bfdf0f479a38 277
Lightvalve 235:bfdf0f479a38 278 TIM4->DIER |= TIM_DIER_UIE; // enable update interrupt
Lightvalve 235:bfdf0f479a38 279 TIM4->CR1 = 0x10;
Lightvalve 235:bfdf0f479a38 280 TIM4->CR1 |= TIM_CR1_UDIS;
Lightvalve 235:bfdf0f479a38 281 TIM4->EGR |= TIM_EGR_UG;
Lightvalve 235:bfdf0f479a38 282
Lightvalve 241:c53d4c26b04a 283 // TIM4->PSC = 10-1; // 10 prescaler, 1kHz
Lightvalve 241:c53d4c26b04a 284 TIM4->PSC = 20-1; // 20 prescaler, 500Hz
Lightvalve 235:bfdf0f479a38 285 TIM4->ARR = 1;
Lightvalve 235:bfdf0f479a38 286 TIM4->CNT = 0;
Lightvalve 240:3ffd78cbd029 287 TIM4->SR = 0;
Lightvalve 235:bfdf0f479a38 288 TIM4->SMCR = 0x07; //External clock mode
Lightvalve 235:bfdf0f479a38 289 TIM4->CR1 |= TIM_CR1_CEN; // enable TIM4
Lightvalve 231:30896263bd8b 290 }