|
4 | 4 |
|
5 | 5 | void ICACHE_RAM_ATTR interruptFunctional(void* arg)
|
6 | 6 | {
|
7 |
| - ArgStructure* localArg = static_cast<ArgStructure*>(arg); |
8 |
| - if (localArg->interruptInfo) |
9 |
| - { |
10 |
| - localArg->interruptInfo->value = digitalRead(localArg->interruptInfo->pin); |
11 |
| - localArg->interruptInfo->micro = micros(); |
12 |
| - } |
13 |
| - if (localArg->functionInfo->reqScheduledFunction) |
14 |
| - { |
15 |
| - schedule_function( |
16 |
| - [reqScheduledFunction = localArg->functionInfo->reqScheduledFunction, |
17 |
| - interruptInfo = *localArg->interruptInfo]() { reqScheduledFunction(interruptInfo); }); |
18 |
| - } |
19 |
| - else if (localArg->functionInfo->reqFunction) |
20 |
| - { |
21 |
| - localArg->functionInfo->reqFunction(); |
22 |
| - } |
| 7 | + ArgStructure* localArg = static_cast<ArgStructure*>(arg); |
| 8 | + if (localArg->interruptInfo) |
| 9 | + { |
| 10 | + localArg->interruptInfo->value = digitalRead(localArg->interruptInfo->pin); |
| 11 | + localArg->interruptInfo->micro = micros(); |
| 12 | + } |
| 13 | + if (localArg->functionInfo->reqScheduledFunction) |
| 14 | + { |
| 15 | + schedule_function( |
| 16 | + [reqScheduledFunction = localArg->functionInfo->reqScheduledFunction, |
| 17 | + interruptInfo = *localArg->interruptInfo]() |
| 18 | + { |
| 19 | + reqScheduledFunction(interruptInfo); |
| 20 | + }); |
| 21 | + } |
| 22 | + else if (localArg->functionInfo->reqFunction) |
| 23 | + { |
| 24 | + localArg->functionInfo->reqFunction(); |
| 25 | + } |
23 | 26 | }
|
24 | 27 |
|
25 | 28 | void cleanupFunctional(void* arg)
|
26 | 29 | {
|
27 |
| - ArgStructure* localArg = static_cast<ArgStructure*>(arg); |
28 |
| - delete localArg; |
| 30 | + ArgStructure* localArg = static_cast<ArgStructure*>(arg); |
| 31 | + delete localArg; |
29 | 32 | }
|
30 | 33 |
|
31 | 34 | void attachInterrupt(uint8_t pin, std::function<void(void)> intRoutine, int mode)
|
32 | 35 | {
|
33 |
| - // use the local interrupt routine which takes the ArgStructure as argument |
| 36 | + // use the local interrupt routine which takes the ArgStructure as argument |
34 | 37 |
|
35 |
| - void* localArg = detachInterruptArg(pin); |
36 |
| - if (localArg) cleanupFunctional(localArg); |
| 38 | + void* localArg = detachInterruptArg(pin); |
| 39 | + if (localArg) |
| 40 | + { |
| 41 | + cleanupFunctional(localArg); |
| 42 | + } |
37 | 43 |
|
38 |
| - FunctionInfo* fi = new FunctionInfo; |
39 |
| - fi->reqFunction = intRoutine; |
| 44 | + FunctionInfo* fi = new FunctionInfo; |
| 45 | + fi->reqFunction = intRoutine; |
40 | 46 |
|
41 |
| - ArgStructure* as = new ArgStructure; |
42 |
| - as->functionInfo = fi; |
| 47 | + ArgStructure* as = new ArgStructure; |
| 48 | + as->functionInfo = fi; |
43 | 49 |
|
44 |
| - attachInterruptArg (pin, interruptFunctional, as, mode); |
| 50 | + attachInterruptArg(pin, interruptFunctional, as, mode); |
45 | 51 | }
|
46 | 52 |
|
47 | 53 | void attachScheduledInterrupt(uint8_t pin, std::function<void(InterruptInfo)> scheduledIntRoutine, int mode)
|
48 | 54 | {
|
49 |
| - void* localArg = detachInterruptArg(pin); |
50 |
| - if (localArg) cleanupFunctional(localArg); |
| 55 | + void* localArg = detachInterruptArg(pin); |
| 56 | + if (localArg) |
| 57 | + { |
| 58 | + cleanupFunctional(localArg); |
| 59 | + } |
51 | 60 |
|
52 |
| - InterruptInfo* ii = new InterruptInfo(pin); |
| 61 | + InterruptInfo* ii = new InterruptInfo(pin); |
53 | 62 |
|
54 |
| - FunctionInfo* fi = new FunctionInfo; |
55 |
| - fi->reqScheduledFunction = scheduledIntRoutine; |
| 63 | + FunctionInfo* fi = new FunctionInfo; |
| 64 | + fi->reqScheduledFunction = scheduledIntRoutine; |
56 | 65 |
|
57 |
| - ArgStructure* as = new ArgStructure; |
58 |
| - as->interruptInfo = ii; |
59 |
| - as->functionInfo = fi; |
| 66 | + ArgStructure* as = new ArgStructure; |
| 67 | + as->interruptInfo = ii; |
| 68 | + as->functionInfo = fi; |
60 | 69 |
|
61 |
| - attachInterruptArg(pin, interruptFunctional, as, mode); |
| 70 | + attachInterruptArg(pin, interruptFunctional, as, mode); |
62 | 71 | }
|
63 | 72 |
|
64 | 73 | void detachFunctionalInterrupt(uint8_t pin)
|
65 | 74 | {
|
66 |
| - void* localArg = detachInterruptArg(pin); |
67 |
| - if (localArg) cleanupFunctional(localArg); |
| 75 | + void* localArg = detachInterruptArg(pin); |
| 76 | + if (localArg) |
| 77 | + { |
| 78 | + cleanupFunctional(localArg); |
| 79 | + } |
68 | 80 | }
|
0 commit comments