Control a robot over the internet using UDP and a Wifly module (WiFi).

Dependencies:   Motor TextLCD WiflyInterface mbed-rtos mbed

Committer:
apatel336
Date:
Thu Oct 17 13:27:56 2013 +0000
Revision:
0:c0dc3a76f3d4
Initial Release

Who changed what in which revision?

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