mirror of https://github.com/ArduPilot/ardupilot
31 lines
478 B
C++
31 lines
478 B
C++
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <time.h>
|
|
#include <sys/time.h>
|
|
#include <sched.h>
|
|
#include <wiring.h>
|
|
|
|
void setup(void);
|
|
void loop(void);
|
|
|
|
struct timeval sketch_start_time;
|
|
|
|
int main(void)
|
|
{
|
|
gettimeofday(&sketch_start_time, NULL);
|
|
setup();
|
|
while (true) {
|
|
struct timeval tv;
|
|
unsigned long t1, t2;
|
|
t1 = micros();
|
|
loop();
|
|
t2 = micros();
|
|
if (t2 - t1 < 2) {
|
|
tv.tv_sec = 0;
|
|
tv.tv_usec = 1;
|
|
select(0, NULL, NULL, NULL, &tv);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|