Marco Mayer / Mbed OS Queue
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 /* Socket
demayer 0:6bf0743ece18 2 * Copyright (c) 2015 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
demayer 0:6bf0743ece18 17 #include "TCPServer.h"
demayer 0:6bf0743ece18 18 #include "mbed.h"
demayer 0:6bf0743ece18 19
demayer 0:6bf0743ece18 20 TCPServer::TCPServer()
demayer 0:6bf0743ece18 21 : _pending(0), _accept_sem(0)
demayer 0:6bf0743ece18 22 {
demayer 0:6bf0743ece18 23 }
demayer 0:6bf0743ece18 24
demayer 0:6bf0743ece18 25 TCPServer::~TCPServer()
demayer 0:6bf0743ece18 26 {
demayer 0:6bf0743ece18 27 close();
demayer 0:6bf0743ece18 28 }
demayer 0:6bf0743ece18 29
demayer 0:6bf0743ece18 30 nsapi_protocol_t TCPServer::get_proto()
demayer 0:6bf0743ece18 31 {
demayer 0:6bf0743ece18 32 return NSAPI_TCP;
demayer 0:6bf0743ece18 33 }
demayer 0:6bf0743ece18 34
demayer 0:6bf0743ece18 35 nsapi_error_t TCPServer::listen(int backlog)
demayer 0:6bf0743ece18 36 {
demayer 0:6bf0743ece18 37 _lock.lock();
demayer 0:6bf0743ece18 38 nsapi_error_t ret;
demayer 0:6bf0743ece18 39
demayer 0:6bf0743ece18 40 if (!_socket) {
demayer 0:6bf0743ece18 41 ret = NSAPI_ERROR_NO_SOCKET;
demayer 0:6bf0743ece18 42 } else {
demayer 0:6bf0743ece18 43 ret = _stack->socket_listen(_socket, backlog);
demayer 0:6bf0743ece18 44 }
demayer 0:6bf0743ece18 45
demayer 0:6bf0743ece18 46 _lock.unlock();
demayer 0:6bf0743ece18 47 return ret;
demayer 0:6bf0743ece18 48 }
demayer 0:6bf0743ece18 49
demayer 0:6bf0743ece18 50 nsapi_error_t TCPServer::accept(TCPSocket *connection, SocketAddress *address)
demayer 0:6bf0743ece18 51 {
demayer 0:6bf0743ece18 52 _lock.lock();
demayer 0:6bf0743ece18 53 nsapi_error_t ret;
demayer 0:6bf0743ece18 54
demayer 0:6bf0743ece18 55 while (true) {
demayer 0:6bf0743ece18 56 if (!_socket) {
demayer 0:6bf0743ece18 57 ret = NSAPI_ERROR_NO_SOCKET;
demayer 0:6bf0743ece18 58 break;
demayer 0:6bf0743ece18 59 }
demayer 0:6bf0743ece18 60
demayer 0:6bf0743ece18 61 _pending = 0;
demayer 0:6bf0743ece18 62 void *socket;
demayer 0:6bf0743ece18 63 ret = _stack->socket_accept(_socket, &socket, address);
demayer 0:6bf0743ece18 64
demayer 0:6bf0743ece18 65 if (0 == ret) {
demayer 0:6bf0743ece18 66 connection->_lock.lock();
demayer 0:6bf0743ece18 67
demayer 0:6bf0743ece18 68 if (connection->_socket) {
demayer 0:6bf0743ece18 69 connection->close();
demayer 0:6bf0743ece18 70 }
demayer 0:6bf0743ece18 71
demayer 0:6bf0743ece18 72 connection->_stack = _stack;
demayer 0:6bf0743ece18 73 connection->_socket = socket;
demayer 0:6bf0743ece18 74 connection->_event = Callback<void()>(connection, &TCPSocket::event);
demayer 0:6bf0743ece18 75 _stack->socket_attach(socket, &Callback<void()>::thunk, &connection->_event);
demayer 0:6bf0743ece18 76
demayer 0:6bf0743ece18 77 connection->_lock.unlock();
demayer 0:6bf0743ece18 78 break;
demayer 0:6bf0743ece18 79 } else if (NSAPI_ERROR_WOULD_BLOCK != ret) {
demayer 0:6bf0743ece18 80 break;
demayer 0:6bf0743ece18 81 } else {
demayer 0:6bf0743ece18 82 int32_t count;
demayer 0:6bf0743ece18 83
demayer 0:6bf0743ece18 84 // Release lock before blocking so other threads
demayer 0:6bf0743ece18 85 // accessing this object aren't blocked
demayer 0:6bf0743ece18 86 _lock.unlock();
demayer 0:6bf0743ece18 87 count = _accept_sem.wait(_timeout);
demayer 0:6bf0743ece18 88 _lock.lock();
demayer 0:6bf0743ece18 89
demayer 0:6bf0743ece18 90 if (count < 1) {
demayer 0:6bf0743ece18 91 // Semaphore wait timed out so break out and return
demayer 0:6bf0743ece18 92 ret = NSAPI_ERROR_WOULD_BLOCK;
demayer 0:6bf0743ece18 93 break;
demayer 0:6bf0743ece18 94 }
demayer 0:6bf0743ece18 95 }
demayer 0:6bf0743ece18 96 }
demayer 0:6bf0743ece18 97
demayer 0:6bf0743ece18 98 _lock.unlock();
demayer 0:6bf0743ece18 99 return ret;
demayer 0:6bf0743ece18 100 }
demayer 0:6bf0743ece18 101
demayer 0:6bf0743ece18 102 void TCPServer::event()
demayer 0:6bf0743ece18 103 {
demayer 0:6bf0743ece18 104 int32_t acount = _accept_sem.wait(0);
demayer 0:6bf0743ece18 105 if (acount <= 1) {
demayer 0:6bf0743ece18 106 _accept_sem.release();
demayer 0:6bf0743ece18 107 }
demayer 0:6bf0743ece18 108
demayer 0:6bf0743ece18 109 _pending += 1;
demayer 0:6bf0743ece18 110 if (_callback && _pending == 1) {
demayer 0:6bf0743ece18 111 _callback();
demayer 0:6bf0743ece18 112 }
demayer 0:6bf0743ece18 113 }