aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_HAL_AVR: fix implementation of delay in scheduler

Browse Source
This commit is contained in:
Pat Hickey 2012-12-04 16:34:04 -08:00 committed by Andrew Tridgell
parent 0b7a55b9f6
commit 88f09d100a
1 changed files with 9 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
libraries/AP_HAL_AVR/Scheduler.cpp
View File

@ -160,9 +160,11 @@ uint32_t AVRScheduler::micros() {
* so we can use it from inside _timer_event() without virtual dispatch. */
uint32_t AVRScheduler::_micros() {
uint32_t m;
uint8_t oldSREG = SREG, t;
uint8_t t;
uint8_t oldSREG = SREG;
cli();
m = timer0_overflow_count;
t = TCNT0;
@ -176,16 +178,16 @@ uint32_t AVRScheduler::_micros() {
void AVRScheduler::delay(uint32_t ms)
{
uint16_t start = (uint16_t)micros();
uint32_t start = _micros();
while (ms > 0) {
if (((uint16_t)micros() - start) >= 1000) {
while ((micros() - start) >= 1000) {
ms--;
start += 1000;
if (_min_delay_cb_ms >= ms) {
if (_delay_cb) {
_delay_cb();
}
}
if (_min_delay_cb_ms <= ms) {
if (_delay_cb) {
_delay_cb();
}
}
}