akcelerometr i czujnik swiatla

Dependencies:   MAG3110 MMA8451Q SLCD- TSI USBDevice mbed

Committer:
zochmen
Date:
Wed Apr 16 12:20:13 2014 +0000
Revision:
0:9f7e045dcaa5
akcelerometr; czujnika swiatla;

Who changed what in which revision?

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