Andrew SaLoutos / mbed-dev-STM-lean

From Ben Katz mbed-dev library. Removed unnecessary target files to reduce the overall size by a factor of 10 to make it easier to import into the online IDE.

Dependents:   motor_driver motor_driver_screaming_fix

platform/CallChain.cpp@0:083111ae2a11, 2020-11-26 (annotated)

Committer:
saloutos
Date:
Thu Nov 26 04:08:56 2020 +0000
Revision:
0:083111ae2a11
first commit of leaned mbed dev lib

Who changed what in which revision?

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