モータードライバとWi-FiモジュールESP-WROOM-02をmbed LPC1114FN28に繋げて、RCWControllerからコントロールするプログラム

Dependencies:   mbed

Committer:
jksoft
Date:
Fri Jul 22 05:36:02 2016 +0000
Revision:
0:3c24a40c2343
??

Who changed what in which revision?

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