Clément BENOIT / Pyrn3GModem

Implementation of 3G USB Modem Huawei E372

Dependents:   PYRN

core/MtxCircBuffer.h@2:61ac95f0af72, 2015-04-14 (annotated)

Committer:
clemounet
Date:
Tue Apr 14 13:27:07 2015 +0000
Revision:
2:61ac95f0af72
.up (working)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
clemounet 2:61ac95f0af72 1 /* MtxCircBuf.h */
clemounet 2:61ac95f0af72 2 /* Copyright (C) 2012 mbed.org, MIT License
clemounet 2:61ac95f0af72 3 *
clemounet 2:61ac95f0af72 4 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
clemounet 2:61ac95f0af72 5 * and associated documentation files (the "Software"), to deal in the Software without restriction,
clemounet 2:61ac95f0af72 6 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
clemounet 2:61ac95f0af72 7 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
clemounet 2:61ac95f0af72 8 * furnished to do so, subject to the following conditions:
clemounet 2:61ac95f0af72 9 *
clemounet 2:61ac95f0af72 10 * The above copyright notice and this permission notice shall be included in all copies or
clemounet 2:61ac95f0af72 11 * substantial portions of the Software.
clemounet 2:61ac95f0af72 12 *
clemounet 2:61ac95f0af72 13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
clemounet 2:61ac95f0af72 14 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
clemounet 2:61ac95f0af72 15 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
clemounet 2:61ac95f0af72 16 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
clemounet 2:61ac95f0af72 17 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
clemounet 2:61ac95f0af72 18 */
clemounet 2:61ac95f0af72 19
clemounet 2:61ac95f0af72 20 #ifndef MTXCIRCBUFFER_H
clemounet 2:61ac95f0af72 21 #define MTXCIRCBUFFER_H
clemounet 2:61ac95f0af72 22
clemounet 2:61ac95f0af72 23 #include "fwk.h"
clemounet 2:61ac95f0af72 24
clemounet 2:61ac95f0af72 25 #include "rtos.h"
clemounet 2:61ac95f0af72 26
clemounet 2:61ac95f0af72 27 //Mutex protected circualr buffer
clemounet 2:61ac95f0af72 28 template<typename T, int size>
clemounet 2:61ac95f0af72 29 class MtxCircBuffer
clemounet 2:61ac95f0af72 30 {
clemounet 2:61ac95f0af72 31 public:
clemounet 2:61ac95f0af72 32 MtxCircBuffer() //:
clemounet 2:61ac95f0af72 33 //mtx()
clemounet 2:61ac95f0af72 34 {
clemounet 2:61ac95f0af72 35 write = 0;
clemounet 2:61ac95f0af72 36 read = 0;
clemounet 2:61ac95f0af72 37 }
clemounet 2:61ac95f0af72 38
clemounet 2:61ac95f0af72 39 bool isFull()
clemounet 2:61ac95f0af72 40 {
clemounet 2:61ac95f0af72 41 mtx.lock();
clemounet 2:61ac95f0af72 42 bool r = (((write + 1) % size) == read);
clemounet 2:61ac95f0af72 43 mtx.unlock();
clemounet 2:61ac95f0af72 44 return r;
clemounet 2:61ac95f0af72 45 }
clemounet 2:61ac95f0af72 46
clemounet 2:61ac95f0af72 47 bool isEmpty()
clemounet 2:61ac95f0af72 48 {
clemounet 2:61ac95f0af72 49 mtx.lock();
clemounet 2:61ac95f0af72 50 bool r = (read == write);
clemounet 2:61ac95f0af72 51 mtx.unlock();
clemounet 2:61ac95f0af72 52 return r;
clemounet 2:61ac95f0af72 53 }
clemounet 2:61ac95f0af72 54
clemounet 2:61ac95f0af72 55 void queue(T k)
clemounet 2:61ac95f0af72 56 {
clemounet 2:61ac95f0af72 57 mtx.lock();
clemounet 2:61ac95f0af72 58 while (((write + 1) % size) == read) //if (isFull())
clemounet 2:61ac95f0af72 59 {
clemounet 2:61ac95f0af72 60 /*while((((write + 1) % size) == read))
clemounet 2:61ac95f0af72 61 {*/
clemounet 2:61ac95f0af72 62 mtx.unlock();
clemounet 2:61ac95f0af72 63 Thread::wait(10);
clemounet 2:61ac95f0af72 64 mtx.lock();
clemounet 2:61ac95f0af72 65 /*}*/
clemounet 2:61ac95f0af72 66 //read++;
clemounet 2:61ac95f0af72 67 //read %= size;
clemounet 2:61ac95f0af72 68 }
clemounet 2:61ac95f0af72 69 buf[write++] = k;
clemounet 2:61ac95f0af72 70 write %= size;
clemounet 2:61ac95f0af72 71 mtx.unlock();
clemounet 2:61ac95f0af72 72 }
clemounet 2:61ac95f0af72 73
clemounet 2:61ac95f0af72 74 uint16_t available()
clemounet 2:61ac95f0af72 75 {
clemounet 2:61ac95f0af72 76 mtx.lock();
clemounet 2:61ac95f0af72 77 uint16_t a = (write >= read) ? (write - read) : (size - read + write);
clemounet 2:61ac95f0af72 78 mtx.unlock();
clemounet 2:61ac95f0af72 79 return a;
clemounet 2:61ac95f0af72 80 }
clemounet 2:61ac95f0af72 81
clemounet 2:61ac95f0af72 82 bool dequeue(T * c)
clemounet 2:61ac95f0af72 83 {
clemounet 2:61ac95f0af72 84 mtx.lock();
clemounet 2:61ac95f0af72 85 bool empty = (read == write);
clemounet 2:61ac95f0af72 86 if (!empty)
clemounet 2:61ac95f0af72 87 {
clemounet 2:61ac95f0af72 88 *c = buf[read++];
clemounet 2:61ac95f0af72 89 read %= size;
clemounet 2:61ac95f0af72 90 }
clemounet 2:61ac95f0af72 91 mtx.unlock();
clemounet 2:61ac95f0af72 92 return (!empty);
clemounet 2:61ac95f0af72 93 }
clemounet 2:61ac95f0af72 94
clemounet 2:61ac95f0af72 95 private:
clemounet 2:61ac95f0af72 96 volatile uint16_t write;
clemounet 2:61ac95f0af72 97 volatile uint16_t read;
clemounet 2:61ac95f0af72 98 volatile T buf[size];
clemounet 2:61ac95f0af72 99 Mutex mtx;
clemounet 2:61ac95f0af72 100 };
clemounet 2:61ac95f0af72 101
clemounet 2:61ac95f0af72 102 #endif
clemounet 2:61ac95f0af72 103