Tidy up of SpinDelay
This commit is contained in:
@@ -193,6 +193,8 @@ int BUTTON_HELD(int ms)
|
|||||||
return BUTTON_ERROR;
|
return BUTTON_ERROR;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// attempt at high resolution microsecond timer
|
||||||
|
// beware: timer counts in 21.3uS increments (1024/48Mhz)
|
||||||
void SpinDelayUs(int us)
|
void SpinDelayUs(int us)
|
||||||
{
|
{
|
||||||
int ticks = (48*us) >> 10;
|
int ticks = (48*us) >> 10;
|
||||||
@@ -207,29 +209,6 @@ void SpinDelayUs(int us)
|
|||||||
WORD start = (WORD)PWM_CH_COUNTER(0);
|
WORD start = (WORD)PWM_CH_COUNTER(0);
|
||||||
|
|
||||||
for(;;) {
|
for(;;) {
|
||||||
WORD now = (WORD)PWM_CH_COUNTER(0);
|
|
||||||
if(now == (WORD)(start + ticks)) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
WDT_HIT();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void SpinDelay(int ms)
|
|
||||||
{
|
|
||||||
int ticks = (48000*ms) >> 10;
|
|
||||||
|
|
||||||
// Borrow a PWM unit for my real-time clock
|
|
||||||
PWM_ENABLE = PWM_CHANNEL(0);
|
|
||||||
// 48 MHz / 1024 gives 46.875 kHz
|
|
||||||
PWM_CH_MODE(0) = PWM_CH_MODE_PRESCALER(10);
|
|
||||||
PWM_CH_DUTY_CYCLE(0) = 0;
|
|
||||||
PWM_CH_PERIOD(0) = 0xffff;
|
|
||||||
|
|
||||||
WORD start = (WORD)PWM_CH_COUNTER(0);
|
|
||||||
|
|
||||||
for(;;)
|
|
||||||
{
|
|
||||||
WORD now = (WORD)PWM_CH_COUNTER(0);
|
WORD now = (WORD)PWM_CH_COUNTER(0);
|
||||||
if (now == (WORD)(start + ticks))
|
if (now == (WORD)(start + ticks))
|
||||||
return;
|
return;
|
||||||
@@ -237,3 +216,9 @@ void SpinDelay(int ms)
|
|||||||
WDT_HIT();
|
WDT_HIT();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void SpinDelay(int ms)
|
||||||
|
{
|
||||||
|
// convert to uS and call microsecond delay function
|
||||||
|
SpinDelayUs(ms*1000);
|
||||||
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user