|
@@ -93,14 +93,14 @@ Timer_clock4: Prescaler 128 -> 656.25kHz
|
93
|
93
|
* TODO: Calculate Timer prescale value, so we get the 32bit to adjust
|
94
|
94
|
*/
|
95
|
95
|
|
96
|
|
-void HAL_timer_start (uint8_t timer_num, uint32_t frequency) {
|
|
96
|
+void HAL_timer_start(uint8_t timer_num, uint32_t frequency) {
|
97
|
97
|
switch (timer_num) {
|
98
|
98
|
case STEP_TIMER_NUM:
|
99
|
99
|
StepperTimer.pause();
|
100
|
100
|
StepperTimer.setCount(0);
|
101
|
101
|
StepperTimer.setPrescaleFactor(STEPPER_TIMER_PRESCALE);
|
102
|
102
|
StepperTimer.setOverflow(0xFFFF);
|
103
|
|
- StepperTimer.setCompare (STEP_TIMER_CHAN, (HAL_STEPPER_TIMER_RATE / frequency));
|
|
103
|
+ StepperTimer.setCompare(STEP_TIMER_CHAN, uint32_t(HAL_STEPPER_TIMER_RATE) / frequency);
|
104
|
104
|
StepperTimer.refresh();
|
105
|
105
|
StepperTimer.resume();
|
106
|
106
|
break;
|
|
@@ -109,14 +109,14 @@ void HAL_timer_start (uint8_t timer_num, uint32_t frequency) {
|
109
|
109
|
TempTimer.setCount(0);
|
110
|
110
|
TempTimer.setPrescaleFactor(TEMP_TIMER_PRESCALE);
|
111
|
111
|
TempTimer.setOverflow(0xFFFF);
|
112
|
|
- TempTimer.setCompare (TEMP_TIMER_CHAN, ((F_CPU / TEMP_TIMER_PRESCALE) / frequency));
|
|
112
|
+ TempTimer.setCompare(TEMP_TIMER_CHAN, (F_CPU) / (TEMP_TIMER_PRESCALE) / frequency);
|
113
|
113
|
TempTimer.refresh();
|
114
|
114
|
TempTimer.resume();
|
115
|
115
|
break;
|
116
|
116
|
}
|
117
|
117
|
}
|
118
|
118
|
|
119
|
|
-void HAL_timer_enable_interrupt (uint8_t timer_num) {
|
|
119
|
+void HAL_timer_enable_interrupt(uint8_t timer_num) {
|
120
|
120
|
switch (timer_num) {
|
121
|
121
|
case STEP_TIMER_NUM:
|
122
|
122
|
StepperTimer.attachInterrupt(STEP_TIMER_CHAN, stepTC_Handler);
|
|
@@ -129,7 +129,7 @@ void HAL_timer_enable_interrupt (uint8_t timer_num) {
|
129
|
129
|
}
|
130
|
130
|
}
|
131
|
131
|
|
132
|
|
-void HAL_timer_disable_interrupt (uint8_t timer_num) {
|
|
132
|
+void HAL_timer_disable_interrupt(uint8_t timer_num) {
|
133
|
133
|
switch (timer_num) {
|
134
|
134
|
case STEP_TIMER_NUM:
|
135
|
135
|
StepperTimer.detachInterrupt(STEP_TIMER_CHAN);
|