001

Committer:
ganlikun
Date:
Sun Jun 12 14:02:44 2022 +0000
Revision:
0:13413ea9a877
00

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ganlikun 0:13413ea9a877 1 #include "platform/CallChain.h"
ganlikun 0:13413ea9a877 2 #include "cmsis.h"
ganlikun 0:13413ea9a877 3 #include "platform/mbed_critical.h"
ganlikun 0:13413ea9a877 4
ganlikun 0:13413ea9a877 5 namespace mbed {
ganlikun 0:13413ea9a877 6
ganlikun 0:13413ea9a877 7 class CallChainLink {
ganlikun 0:13413ea9a877 8 public:
ganlikun 0:13413ea9a877 9 CallChainLink(): cb(), next(NULL) {
ganlikun 0:13413ea9a877 10 // No work to do
ganlikun 0:13413ea9a877 11 }
ganlikun 0:13413ea9a877 12
ganlikun 0:13413ea9a877 13 CallChainLink(Callback<void()> &callback): cb(callback), next(NULL) {
ganlikun 0:13413ea9a877 14 // No work to do
ganlikun 0:13413ea9a877 15 }
ganlikun 0:13413ea9a877 16 Callback<void()> cb;
ganlikun 0:13413ea9a877 17 CallChainLink * next;
ganlikun 0:13413ea9a877 18 };
ganlikun 0:13413ea9a877 19
ganlikun 0:13413ea9a877 20 CallChain::CallChain(int size) : _chain(NULL) {
ganlikun 0:13413ea9a877 21 // No work to do
ganlikun 0:13413ea9a877 22 }
ganlikun 0:13413ea9a877 23
ganlikun 0:13413ea9a877 24 CallChain::~CallChain() {
ganlikun 0:13413ea9a877 25 clear();
ganlikun 0:13413ea9a877 26 }
ganlikun 0:13413ea9a877 27
ganlikun 0:13413ea9a877 28 pFunctionPointer_t CallChain::add(Callback<void()> func) {
ganlikun 0:13413ea9a877 29 CallChainLink *new_link = new CallChainLink(func);
ganlikun 0:13413ea9a877 30 if (NULL == _chain) {
ganlikun 0:13413ea9a877 31 _chain = new_link;
ganlikun 0:13413ea9a877 32 return &new_link->cb;
ganlikun 0:13413ea9a877 33 }
ganlikun 0:13413ea9a877 34
ganlikun 0:13413ea9a877 35 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 36 while (true) {
ganlikun 0:13413ea9a877 37 if (NULL == link->next) {
ganlikun 0:13413ea9a877 38 link->next = new_link;
ganlikun 0:13413ea9a877 39 return &new_link->cb;
ganlikun 0:13413ea9a877 40 }
ganlikun 0:13413ea9a877 41 link = link->next;
ganlikun 0:13413ea9a877 42 }
ganlikun 0:13413ea9a877 43 }
ganlikun 0:13413ea9a877 44
ganlikun 0:13413ea9a877 45 pFunctionPointer_t CallChain::add_front(Callback<void()> func) {
ganlikun 0:13413ea9a877 46 CallChainLink *link = new CallChainLink(func);
ganlikun 0:13413ea9a877 47 link->next = _chain;
ganlikun 0:13413ea9a877 48 _chain = link;
ganlikun 0:13413ea9a877 49 return &link->cb;
ganlikun 0:13413ea9a877 50 }
ganlikun 0:13413ea9a877 51
ganlikun 0:13413ea9a877 52 int CallChain::size() const {
ganlikun 0:13413ea9a877 53 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 54 int elements = 0;
ganlikun 0:13413ea9a877 55 while (link != NULL) {
ganlikun 0:13413ea9a877 56 elements++;
ganlikun 0:13413ea9a877 57 link = link->next;
ganlikun 0:13413ea9a877 58 }
ganlikun 0:13413ea9a877 59 return elements;
ganlikun 0:13413ea9a877 60 }
ganlikun 0:13413ea9a877 61
ganlikun 0:13413ea9a877 62 pFunctionPointer_t CallChain::get(int idx) const {
ganlikun 0:13413ea9a877 63 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 64 for (int i = 0; i < idx; i++) {
ganlikun 0:13413ea9a877 65 if (NULL == link) {
ganlikun 0:13413ea9a877 66 break;
ganlikun 0:13413ea9a877 67 }
ganlikun 0:13413ea9a877 68 link = link->next;
ganlikun 0:13413ea9a877 69 }
ganlikun 0:13413ea9a877 70 return &link->cb;
ganlikun 0:13413ea9a877 71 }
ganlikun 0:13413ea9a877 72
ganlikun 0:13413ea9a877 73 int CallChain::find(pFunctionPointer_t f) const {
ganlikun 0:13413ea9a877 74 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 75 int i = 0;
ganlikun 0:13413ea9a877 76 while (link != NULL) {
ganlikun 0:13413ea9a877 77 if (f == &link->cb) {
ganlikun 0:13413ea9a877 78 return i;
ganlikun 0:13413ea9a877 79 }
ganlikun 0:13413ea9a877 80 i++;
ganlikun 0:13413ea9a877 81 link = link->next;
ganlikun 0:13413ea9a877 82 }
ganlikun 0:13413ea9a877 83 return -1;
ganlikun 0:13413ea9a877 84 }
ganlikun 0:13413ea9a877 85
ganlikun 0:13413ea9a877 86 void CallChain::clear() {
ganlikun 0:13413ea9a877 87 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 88 _chain = NULL;
ganlikun 0:13413ea9a877 89 while (link != NULL) {
ganlikun 0:13413ea9a877 90 CallChainLink *temp = link->next;
ganlikun 0:13413ea9a877 91 delete link;
ganlikun 0:13413ea9a877 92 link = temp;
ganlikun 0:13413ea9a877 93 }
ganlikun 0:13413ea9a877 94 }
ganlikun 0:13413ea9a877 95
ganlikun 0:13413ea9a877 96 bool CallChain::remove(pFunctionPointer_t f) {
ganlikun 0:13413ea9a877 97 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 98 while (link != NULL) {
ganlikun 0:13413ea9a877 99 if (f == &link->cb) {
ganlikun 0:13413ea9a877 100 delete link;
ganlikun 0:13413ea9a877 101 return true;
ganlikun 0:13413ea9a877 102 }
ganlikun 0:13413ea9a877 103 link = link->next;
ganlikun 0:13413ea9a877 104 }
ganlikun 0:13413ea9a877 105 return false;
ganlikun 0:13413ea9a877 106 }
ganlikun 0:13413ea9a877 107
ganlikun 0:13413ea9a877 108 void CallChain::call() {
ganlikun 0:13413ea9a877 109 CallChainLink *link = _chain;
ganlikun 0:13413ea9a877 110 while (link != NULL) {
ganlikun 0:13413ea9a877 111 link->cb.call();
ganlikun 0:13413ea9a877 112 link = link->next;
ganlikun 0:13413ea9a877 113 }
ganlikun 0:13413ea9a877 114 }
ganlikun 0:13413ea9a877 115
ganlikun 0:13413ea9a877 116 } // namespace mbed
ganlikun 0:13413ea9a877 117