PES4 / Mbed OS Queue_02
Committer:
demayer
Date:
Sat Mar 28 15:28:19 2020 +0000
Revision:
0:6bf0743ece18
IMU Thread with an event-queue running parallel to handle tasks like a 5 times blinking LED. Button with interrupt detected.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /* mbed Microcontroller Library
demayer 0:6bf0743ece18 2 * Copyright (c) 2006-2013 ARM Limited
demayer 0:6bf0743ece18 3 *
demayer 0:6bf0743ece18 4 * Licensed under the Apache License, Version 2.0 (the "License");
demayer 0:6bf0743ece18 5 * you may not use this file except in compliance with the License.
demayer 0:6bf0743ece18 6 * You may obtain a copy of the License at
demayer 0:6bf0743ece18 7 *
demayer 0:6bf0743ece18 8 * http://www.apache.org/licenses/LICENSE-2.0
demayer 0:6bf0743ece18 9 *
demayer 0:6bf0743ece18 10 * Unless required by applicable law or agreed to in writing, software
demayer 0:6bf0743ece18 11 * distributed under the License is distributed on an "AS IS" BASIS,
demayer 0:6bf0743ece18 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
demayer 0:6bf0743ece18 13 * See the License for the specific language governing permissions and
demayer 0:6bf0743ece18 14 * limitations under the License.
demayer 0:6bf0743ece18 15 */
demayer 0:6bf0743ece18 16 #include "drivers/SerialBase.h"
demayer 0:6bf0743ece18 17 #include "platform/mbed_wait_api.h"
demayer 0:6bf0743ece18 18 #include "platform/mbed_critical.h"
demayer 0:6bf0743ece18 19 #include "platform/mbed_sleep.h"
demayer 0:6bf0743ece18 20
demayer 0:6bf0743ece18 21 #if DEVICE_SERIAL
demayer 0:6bf0743ece18 22
demayer 0:6bf0743ece18 23 namespace mbed {
demayer 0:6bf0743ece18 24
demayer 0:6bf0743ece18 25 SerialBase::SerialBase(PinName tx, PinName rx, int baud) :
demayer 0:6bf0743ece18 26 #if DEVICE_SERIAL_ASYNCH
demayer 0:6bf0743ece18 27 _thunk_irq(this), _tx_usage(DMA_USAGE_NEVER),
demayer 0:6bf0743ece18 28 _rx_usage(DMA_USAGE_NEVER), _tx_callback(NULL),
demayer 0:6bf0743ece18 29 _rx_callback(NULL),
demayer 0:6bf0743ece18 30 #endif
demayer 0:6bf0743ece18 31 _serial(), _baud(baud) {
demayer 0:6bf0743ece18 32 // No lock needed in the constructor
demayer 0:6bf0743ece18 33
demayer 0:6bf0743ece18 34 for (size_t i = 0; i < sizeof _irq / sizeof _irq[0]; i++) {
demayer 0:6bf0743ece18 35 _irq[i] = NULL;
demayer 0:6bf0743ece18 36 }
demayer 0:6bf0743ece18 37
demayer 0:6bf0743ece18 38 serial_init(&_serial, tx, rx);
demayer 0:6bf0743ece18 39 serial_baud(&_serial, _baud);
demayer 0:6bf0743ece18 40 serial_irq_handler(&_serial, SerialBase::_irq_handler, (uint32_t)this);
demayer 0:6bf0743ece18 41 }
demayer 0:6bf0743ece18 42
demayer 0:6bf0743ece18 43 void SerialBase::baud(int baudrate) {
demayer 0:6bf0743ece18 44 lock();
demayer 0:6bf0743ece18 45 serial_baud(&_serial, baudrate);
demayer 0:6bf0743ece18 46 _baud = baudrate;
demayer 0:6bf0743ece18 47 unlock();
demayer 0:6bf0743ece18 48 }
demayer 0:6bf0743ece18 49
demayer 0:6bf0743ece18 50 void SerialBase::format(int bits, Parity parity, int stop_bits) {
demayer 0:6bf0743ece18 51 lock();
demayer 0:6bf0743ece18 52 serial_format(&_serial, bits, (SerialParity)parity, stop_bits);
demayer 0:6bf0743ece18 53 unlock();
demayer 0:6bf0743ece18 54 }
demayer 0:6bf0743ece18 55
demayer 0:6bf0743ece18 56 int SerialBase::readable() {
demayer 0:6bf0743ece18 57 lock();
demayer 0:6bf0743ece18 58 int ret = serial_readable(&_serial);
demayer 0:6bf0743ece18 59 unlock();
demayer 0:6bf0743ece18 60 return ret;
demayer 0:6bf0743ece18 61 }
demayer 0:6bf0743ece18 62
demayer 0:6bf0743ece18 63
demayer 0:6bf0743ece18 64 int SerialBase::writeable() {
demayer 0:6bf0743ece18 65 lock();
demayer 0:6bf0743ece18 66 int ret = serial_writable(&_serial);
demayer 0:6bf0743ece18 67 unlock();
demayer 0:6bf0743ece18 68 return ret;
demayer 0:6bf0743ece18 69 }
demayer 0:6bf0743ece18 70
demayer 0:6bf0743ece18 71 void SerialBase::attach(Callback<void()> func, IrqType type) {
demayer 0:6bf0743ece18 72 lock();
demayer 0:6bf0743ece18 73 // Disable interrupts when attaching interrupt handler
demayer 0:6bf0743ece18 74 core_util_critical_section_enter();
demayer 0:6bf0743ece18 75 if (func) {
demayer 0:6bf0743ece18 76 // lock deep sleep only the first time
demayer 0:6bf0743ece18 77 if (!_irq[type]) {
demayer 0:6bf0743ece18 78 sleep_manager_lock_deep_sleep();
demayer 0:6bf0743ece18 79 }
demayer 0:6bf0743ece18 80 _irq[type] = func;
demayer 0:6bf0743ece18 81 serial_irq_set(&_serial, (SerialIrq)type, 1);
demayer 0:6bf0743ece18 82 } else {
demayer 0:6bf0743ece18 83 // unlock deep sleep only the first time
demayer 0:6bf0743ece18 84 if (_irq[type]) {
demayer 0:6bf0743ece18 85 sleep_manager_unlock_deep_sleep();
demayer 0:6bf0743ece18 86 }
demayer 0:6bf0743ece18 87 _irq[type] = NULL;
demayer 0:6bf0743ece18 88 serial_irq_set(&_serial, (SerialIrq)type, 0);
demayer 0:6bf0743ece18 89 }
demayer 0:6bf0743ece18 90 core_util_critical_section_exit();
demayer 0:6bf0743ece18 91 unlock();
demayer 0:6bf0743ece18 92 }
demayer 0:6bf0743ece18 93
demayer 0:6bf0743ece18 94 void SerialBase::_irq_handler(uint32_t id, SerialIrq irq_type) {
demayer 0:6bf0743ece18 95 SerialBase *handler = (SerialBase*)id;
demayer 0:6bf0743ece18 96 if (handler->_irq[irq_type]) {
demayer 0:6bf0743ece18 97 handler->_irq[irq_type]();
demayer 0:6bf0743ece18 98 }
demayer 0:6bf0743ece18 99 }
demayer 0:6bf0743ece18 100
demayer 0:6bf0743ece18 101 int SerialBase::_base_getc() {
demayer 0:6bf0743ece18 102 // Mutex is already held
demayer 0:6bf0743ece18 103 return serial_getc(&_serial);
demayer 0:6bf0743ece18 104 }
demayer 0:6bf0743ece18 105
demayer 0:6bf0743ece18 106 int SerialBase::_base_putc(int c) {
demayer 0:6bf0743ece18 107 // Mutex is already held
demayer 0:6bf0743ece18 108 serial_putc(&_serial, c);
demayer 0:6bf0743ece18 109 return c;
demayer 0:6bf0743ece18 110 }
demayer 0:6bf0743ece18 111
demayer 0:6bf0743ece18 112 void SerialBase::send_break() {
demayer 0:6bf0743ece18 113 lock();
demayer 0:6bf0743ece18 114 // Wait for 1.5 frames before clearing the break condition
demayer 0:6bf0743ece18 115 // This will have different effects on our platforms, but should
demayer 0:6bf0743ece18 116 // ensure that we keep the break active for at least one frame.
demayer 0:6bf0743ece18 117 // We consider a full frame (1 start bit + 8 data bits bits +
demayer 0:6bf0743ece18 118 // 1 parity bit + 2 stop bits = 12 bits) for computation.
demayer 0:6bf0743ece18 119 // One bit time (in us) = 1000000/_baud
demayer 0:6bf0743ece18 120 // Twelve bits: 12000000/baud delay
demayer 0:6bf0743ece18 121 // 1.5 frames: 18000000/baud delay
demayer 0:6bf0743ece18 122 serial_break_set(&_serial);
demayer 0:6bf0743ece18 123 wait_us(18000000/_baud);
demayer 0:6bf0743ece18 124 serial_break_clear(&_serial);
demayer 0:6bf0743ece18 125 unlock();
demayer 0:6bf0743ece18 126 }
demayer 0:6bf0743ece18 127
demayer 0:6bf0743ece18 128 void SerialBase::lock() {
demayer 0:6bf0743ece18 129 // Stub
demayer 0:6bf0743ece18 130 }
demayer 0:6bf0743ece18 131
demayer 0:6bf0743ece18 132 void SerialBase:: unlock() {
demayer 0:6bf0743ece18 133 // Stub
demayer 0:6bf0743ece18 134 }
demayer 0:6bf0743ece18 135
demayer 0:6bf0743ece18 136 SerialBase::~SerialBase()
demayer 0:6bf0743ece18 137 {
demayer 0:6bf0743ece18 138 // No lock needed in destructor
demayer 0:6bf0743ece18 139
demayer 0:6bf0743ece18 140 // Detaching interrupts releases the sleep lock if it was locked
demayer 0:6bf0743ece18 141 for (int irq = 0; irq < IrqCnt; irq++) {
demayer 0:6bf0743ece18 142 attach(NULL, (IrqType)irq);
demayer 0:6bf0743ece18 143 }
demayer 0:6bf0743ece18 144 }
demayer 0:6bf0743ece18 145
demayer 0:6bf0743ece18 146 #if DEVICE_SERIAL_FC
demayer 0:6bf0743ece18 147 void SerialBase::set_flow_control(Flow type, PinName flow1, PinName flow2) {
demayer 0:6bf0743ece18 148 lock();
demayer 0:6bf0743ece18 149 FlowControl flow_type = (FlowControl)type;
demayer 0:6bf0743ece18 150 switch(type) {
demayer 0:6bf0743ece18 151 case RTS:
demayer 0:6bf0743ece18 152 serial_set_flow_control(&_serial, flow_type, flow1, NC);
demayer 0:6bf0743ece18 153 break;
demayer 0:6bf0743ece18 154
demayer 0:6bf0743ece18 155 case CTS:
demayer 0:6bf0743ece18 156 serial_set_flow_control(&_serial, flow_type, NC, flow1);
demayer 0:6bf0743ece18 157 break;
demayer 0:6bf0743ece18 158
demayer 0:6bf0743ece18 159 case RTSCTS:
demayer 0:6bf0743ece18 160 case Disabled:
demayer 0:6bf0743ece18 161 serial_set_flow_control(&_serial, flow_type, flow1, flow2);
demayer 0:6bf0743ece18 162 break;
demayer 0:6bf0743ece18 163
demayer 0:6bf0743ece18 164 default:
demayer 0:6bf0743ece18 165 break;
demayer 0:6bf0743ece18 166 }
demayer 0:6bf0743ece18 167 unlock();
demayer 0:6bf0743ece18 168 }
demayer 0:6bf0743ece18 169 #endif
demayer 0:6bf0743ece18 170
demayer 0:6bf0743ece18 171 #if DEVICE_SERIAL_ASYNCH
demayer 0:6bf0743ece18 172
demayer 0:6bf0743ece18 173 int SerialBase::write(const uint8_t *buffer, int length, const event_callback_t& callback, int event)
demayer 0:6bf0743ece18 174 {
demayer 0:6bf0743ece18 175 if (serial_tx_active(&_serial)) {
demayer 0:6bf0743ece18 176 return -1; // transaction ongoing
demayer 0:6bf0743ece18 177 }
demayer 0:6bf0743ece18 178 start_write((void *)buffer, length, 8, callback, event);
demayer 0:6bf0743ece18 179 return 0;
demayer 0:6bf0743ece18 180 }
demayer 0:6bf0743ece18 181
demayer 0:6bf0743ece18 182 int SerialBase::write(const uint16_t *buffer, int length, const event_callback_t& callback, int event)
demayer 0:6bf0743ece18 183 {
demayer 0:6bf0743ece18 184 if (serial_tx_active(&_serial)) {
demayer 0:6bf0743ece18 185 return -1; // transaction ongoing
demayer 0:6bf0743ece18 186 }
demayer 0:6bf0743ece18 187 start_write((void *)buffer, length, 16, callback, event);
demayer 0:6bf0743ece18 188 return 0;
demayer 0:6bf0743ece18 189 }
demayer 0:6bf0743ece18 190
demayer 0:6bf0743ece18 191 void SerialBase::start_write(const void *buffer, int buffer_size, char buffer_width, const event_callback_t& callback, int event)
demayer 0:6bf0743ece18 192 {
demayer 0:6bf0743ece18 193 _tx_callback = callback;
demayer 0:6bf0743ece18 194
demayer 0:6bf0743ece18 195 _thunk_irq.callback(&SerialBase::interrupt_handler_asynch);
demayer 0:6bf0743ece18 196 sleep_manager_lock_deep_sleep();
demayer 0:6bf0743ece18 197 serial_tx_asynch(&_serial, buffer, buffer_size, buffer_width, _thunk_irq.entry(), event, _tx_usage);
demayer 0:6bf0743ece18 198 }
demayer 0:6bf0743ece18 199
demayer 0:6bf0743ece18 200 void SerialBase::abort_write(void)
demayer 0:6bf0743ece18 201 {
demayer 0:6bf0743ece18 202 // rx might still be active
demayer 0:6bf0743ece18 203 if (_rx_callback) {
demayer 0:6bf0743ece18 204 sleep_manager_unlock_deep_sleep();
demayer 0:6bf0743ece18 205 }
demayer 0:6bf0743ece18 206 _tx_callback = NULL;
demayer 0:6bf0743ece18 207 serial_tx_abort_asynch(&_serial);
demayer 0:6bf0743ece18 208 }
demayer 0:6bf0743ece18 209
demayer 0:6bf0743ece18 210 void SerialBase::abort_read(void)
demayer 0:6bf0743ece18 211 {
demayer 0:6bf0743ece18 212 // tx might still be active
demayer 0:6bf0743ece18 213 if (_tx_callback) {
demayer 0:6bf0743ece18 214 sleep_manager_unlock_deep_sleep();
demayer 0:6bf0743ece18 215 }
demayer 0:6bf0743ece18 216 _rx_callback = NULL;
demayer 0:6bf0743ece18 217 serial_rx_abort_asynch(&_serial);
demayer 0:6bf0743ece18 218 }
demayer 0:6bf0743ece18 219
demayer 0:6bf0743ece18 220 int SerialBase::set_dma_usage_tx(DMAUsage usage)
demayer 0:6bf0743ece18 221 {
demayer 0:6bf0743ece18 222 if (serial_tx_active(&_serial)) {
demayer 0:6bf0743ece18 223 return -1;
demayer 0:6bf0743ece18 224 }
demayer 0:6bf0743ece18 225 _tx_usage = usage;
demayer 0:6bf0743ece18 226 return 0;
demayer 0:6bf0743ece18 227 }
demayer 0:6bf0743ece18 228
demayer 0:6bf0743ece18 229 int SerialBase::set_dma_usage_rx(DMAUsage usage)
demayer 0:6bf0743ece18 230 {
demayer 0:6bf0743ece18 231 if (serial_tx_active(&_serial)) {
demayer 0:6bf0743ece18 232 return -1;
demayer 0:6bf0743ece18 233 }
demayer 0:6bf0743ece18 234 _rx_usage = usage;
demayer 0:6bf0743ece18 235 return 0;
demayer 0:6bf0743ece18 236 }
demayer 0:6bf0743ece18 237
demayer 0:6bf0743ece18 238 int SerialBase::read(uint8_t *buffer, int length, const event_callback_t& callback, int event, unsigned char char_match)
demayer 0:6bf0743ece18 239 {
demayer 0:6bf0743ece18 240 if (serial_rx_active(&_serial)) {
demayer 0:6bf0743ece18 241 return -1; // transaction ongoing
demayer 0:6bf0743ece18 242 }
demayer 0:6bf0743ece18 243 start_read((void*)buffer, length, 8, callback, event, char_match);
demayer 0:6bf0743ece18 244 return 0;
demayer 0:6bf0743ece18 245 }
demayer 0:6bf0743ece18 246
demayer 0:6bf0743ece18 247
demayer 0:6bf0743ece18 248 int SerialBase::read(uint16_t *buffer, int length, const event_callback_t& callback, int event, unsigned char char_match)
demayer 0:6bf0743ece18 249 {
demayer 0:6bf0743ece18 250 if (serial_rx_active(&_serial)) {
demayer 0:6bf0743ece18 251 return -1; // transaction ongoing
demayer 0:6bf0743ece18 252 }
demayer 0:6bf0743ece18 253 start_read((void*)buffer, length, 16, callback, event, char_match);
demayer 0:6bf0743ece18 254 return 0;
demayer 0:6bf0743ece18 255 }
demayer 0:6bf0743ece18 256
demayer 0:6bf0743ece18 257
demayer 0:6bf0743ece18 258 void SerialBase::start_read(void *buffer, int buffer_size, char buffer_width, const event_callback_t& callback, int event, unsigned char char_match)
demayer 0:6bf0743ece18 259 {
demayer 0:6bf0743ece18 260 _rx_callback = callback;
demayer 0:6bf0743ece18 261 _thunk_irq.callback(&SerialBase::interrupt_handler_asynch);
demayer 0:6bf0743ece18 262 sleep_manager_lock_deep_sleep();
demayer 0:6bf0743ece18 263 serial_rx_asynch(&_serial, buffer, buffer_size, buffer_width, _thunk_irq.entry(), event, char_match, _rx_usage);
demayer 0:6bf0743ece18 264 }
demayer 0:6bf0743ece18 265
demayer 0:6bf0743ece18 266 void SerialBase::interrupt_handler_asynch(void)
demayer 0:6bf0743ece18 267 {
demayer 0:6bf0743ece18 268 int event = serial_irq_handler_asynch(&_serial);
demayer 0:6bf0743ece18 269 int rx_event = event & SERIAL_EVENT_RX_MASK;
demayer 0:6bf0743ece18 270 bool unlock_deepsleep = false;
demayer 0:6bf0743ece18 271
demayer 0:6bf0743ece18 272 if (_rx_callback && rx_event) {
demayer 0:6bf0743ece18 273 unlock_deepsleep = true;
demayer 0:6bf0743ece18 274 _rx_callback.call(rx_event);
demayer 0:6bf0743ece18 275 }
demayer 0:6bf0743ece18 276
demayer 0:6bf0743ece18 277 int tx_event = event & SERIAL_EVENT_TX_MASK;
demayer 0:6bf0743ece18 278 if (_tx_callback && tx_event) {
demayer 0:6bf0743ece18 279 unlock_deepsleep = true;
demayer 0:6bf0743ece18 280 _tx_callback.call(tx_event);
demayer 0:6bf0743ece18 281 }
demayer 0:6bf0743ece18 282 // unlock if tx or rx events are generated
demayer 0:6bf0743ece18 283 if (unlock_deepsleep) {
demayer 0:6bf0743ece18 284 sleep_manager_unlock_deep_sleep();
demayer 0:6bf0743ece18 285 }
demayer 0:6bf0743ece18 286 }
demayer 0:6bf0743ece18 287
demayer 0:6bf0743ece18 288 #endif
demayer 0:6bf0743ece18 289
demayer 0:6bf0743ece18 290 } // namespace mbed
demayer 0:6bf0743ece18 291
demayer 0:6bf0743ece18 292 #endif