Mirrors_Framework/ardupilot
1
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot.git synced 2026-10-13 02:54:09 +08:00
Code Issues Packages Projects Releases Wiki Activity

desktop: added attachInterrupt() support

Browse Source
This commit is contained in:
Andrew Tridgell
2011-12-26 19:17:11 +11:00
parent a39a470d75
commit 9bb0bd0341
3 changed files with 27 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libraries/Desktop/support/Arduino.cpp
+25
View File
@@ -156,3 +156,28 @@ char *ltoa(long __val, char *__s, int __radix)
return __s;
}
#define ARRAY_LENGTH(x) (sizeof((x))/sizeof((x)[0]))
static struct {
void (*call)(void);
} interrupt_table[7];
void attachInterrupt(uint8_t inum, void (*call)(void), int mode)
{
if (inum >= ARRAY_LENGTH(interrupt_table)) {
fprintf(stderr, "Bad attachInterrupt to interrupt %u\n", inum);
exit(1);
}
interrupt_table[inum].call = call;
}
void runInterrupt(uint8_t inum)
{
if (inum >= ARRAY_LENGTH(interrupt_table)) {
fprintf(stderr, "Bad runInterrupt to interrupt %u\n", inum);
exit(1);
}
if (interrupt_table[inum].call != NULL) {
interrupt_table[inum].call();
}
}