Sensor reporting over USB CDC

Dependencies:   MAG3110 MMA8451Q SLCD- TSI USBDevice mbed

Committer:
wue
Date:
Wed Apr 16 12:20:12 2014 +0000
Revision:
0:7b58cdacf811
Sensor reporting over USB CDC

Who changed what in which revision?

UserRevisionLine numberNew contents of line
wue 0:7b58cdacf811 1 /* Copyright (c) 2010-2011 mbed.org, MIT License
wue 0:7b58cdacf811 2 *
wue 0:7b58cdacf811 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
wue 0:7b58cdacf811 4 * and associated documentation files (the "Software"), to deal in the Software without
wue 0:7b58cdacf811 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
wue 0:7b58cdacf811 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
wue 0:7b58cdacf811 7 * Software is furnished to do so, subject to the following conditions:
wue 0:7b58cdacf811 8 *
wue 0:7b58cdacf811 9 * The above copyright notice and this permission notice shall be included in all copies or
wue 0:7b58cdacf811 10 * substantial portions of the Software.
wue 0:7b58cdacf811 11 *
wue 0:7b58cdacf811 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
wue 0:7b58cdacf811 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
wue 0:7b58cdacf811 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
wue 0:7b58cdacf811 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
wue 0:7b58cdacf811 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
wue 0:7b58cdacf811 17 */
wue 0:7b58cdacf811 18
wue 0:7b58cdacf811 19 #ifndef CIRCBUFFER_H
wue 0:7b58cdacf811 20 #define CIRCBUFFER_H
wue 0:7b58cdacf811 21
wue 0:7b58cdacf811 22 template <class T>
wue 0:7b58cdacf811 23 class CircBuffer {
wue 0:7b58cdacf811 24 public:
wue 0:7b58cdacf811 25 CircBuffer(int length) {
wue 0:7b58cdacf811 26 write = 0;
wue 0:7b58cdacf811 27 read = 0;
wue 0:7b58cdacf811 28 size = length + 1;
wue 0:7b58cdacf811 29 buf = (T *)malloc(size * sizeof(T));
wue 0:7b58cdacf811 30 };
wue 0:7b58cdacf811 31
wue 0:7b58cdacf811 32 ~CircBuffer() {
wue 0:7b58cdacf811 33 free(buf);
wue 0:7b58cdacf811 34 }
wue 0:7b58cdacf811 35
wue 0:7b58cdacf811 36 bool isFull() {
wue 0:7b58cdacf811 37 return ((write + 1) % size == read);
wue 0:7b58cdacf811 38 };
wue 0:7b58cdacf811 39
wue 0:7b58cdacf811 40 bool isEmpty() {
wue 0:7b58cdacf811 41 return (read == write);
wue 0:7b58cdacf811 42 };
wue 0:7b58cdacf811 43
wue 0:7b58cdacf811 44 void queue(T k) {
wue 0:7b58cdacf811 45 if (isFull()) {
wue 0:7b58cdacf811 46 read++;
wue 0:7b58cdacf811 47 read %= size;
wue 0:7b58cdacf811 48 }
wue 0:7b58cdacf811 49 buf[write++] = k;
wue 0:7b58cdacf811 50 write %= size;
wue 0:7b58cdacf811 51 }
wue 0:7b58cdacf811 52
wue 0:7b58cdacf811 53 uint16_t available() {
wue 0:7b58cdacf811 54 return (write >= read) ? write - read : size - read + write;
wue 0:7b58cdacf811 55 };
wue 0:7b58cdacf811 56
wue 0:7b58cdacf811 57 bool dequeue(T * c) {
wue 0:7b58cdacf811 58 bool empty = isEmpty();
wue 0:7b58cdacf811 59 if (!empty) {
wue 0:7b58cdacf811 60 *c = buf[read++];
wue 0:7b58cdacf811 61 read %= size;
wue 0:7b58cdacf811 62 }
wue 0:7b58cdacf811 63 return(!empty);
wue 0:7b58cdacf811 64 };
wue 0:7b58cdacf811 65
wue 0:7b58cdacf811 66 private:
wue 0:7b58cdacf811 67 volatile uint16_t write;
wue 0:7b58cdacf811 68 volatile uint16_t read;
wue 0:7b58cdacf811 69 uint16_t size;
wue 0:7b58cdacf811 70 T * buf;
wue 0:7b58cdacf811 71 };
wue 0:7b58cdacf811 72
wue 0:7b58cdacf811 73 #endif