Slingshot Controller

Dependencies:   ADXL345 DebounceIn USBDevice mbed

Committer:
Brandon
Date:
Wed Oct 17 16:33:04 2012 +0000
Revision:
1:2721dc2acc2c
Parent:
0:cf17ea89fd09
Updated comments, added names, cleaned old code.

Who changed what in which revision?

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