Mike Panetta / MODSERIAL

Modified MODSERIAL library

Dependents:   BeaconAvoid

RESIZE.cpp@0:ef4645a79fca, 2012-09-09 (annotated)

Committer:
mpanetta
Date:
Sun Sep 09 22:28:07 2012 +0000
Revision:
0:ef4645a79fca
[mbed] converted /BeaconAvoid/MODSERIAL

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mpanetta 0:ef4645a79fca 1 /*
mpanetta 0:ef4645a79fca 2 Copyright (c) 2010 Andy Kirkham
mpanetta 0:ef4645a79fca 3
mpanetta 0:ef4645a79fca 4 Permission is hereby granted, free of charge, to any person obtaining a copy
mpanetta 0:ef4645a79fca 5 of this software and associated documentation files (the "Software"), to deal
mpanetta 0:ef4645a79fca 6 in the Software without restriction, including without limitation the rights
mpanetta 0:ef4645a79fca 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
mpanetta 0:ef4645a79fca 8 copies of the Software, and to permit persons to whom the Software is
mpanetta 0:ef4645a79fca 9 furnished to do so, subject to the following conditions:
mpanetta 0:ef4645a79fca 10
mpanetta 0:ef4645a79fca 11 The above copyright notice and this permission notice shall be included in
mpanetta 0:ef4645a79fca 12 all copies or substantial portions of the Software.
mpanetta 0:ef4645a79fca 13
mpanetta 0:ef4645a79fca 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
mpanetta 0:ef4645a79fca 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
mpanetta 0:ef4645a79fca 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
mpanetta 0:ef4645a79fca 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
mpanetta 0:ef4645a79fca 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
mpanetta 0:ef4645a79fca 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
mpanetta 0:ef4645a79fca 20 THE SOFTWARE.
mpanetta 0:ef4645a79fca 21 */
mpanetta 0:ef4645a79fca 22
mpanetta 0:ef4645a79fca 23 #include "MODSERIAL.h"
mpanetta 0:ef4645a79fca 24 #include "MACROS.h"
mpanetta 0:ef4645a79fca 25
mpanetta 0:ef4645a79fca 26 namespace AjK {
mpanetta 0:ef4645a79fca 27
mpanetta 0:ef4645a79fca 28 int
mpanetta 0:ef4645a79fca 29 MODSERIAL::resizeBuffer(int size, IrqType type, bool memory_check)
mpanetta 0:ef4645a79fca 30 {
mpanetta 0:ef4645a79fca 31 int rval = Ok;
mpanetta 0:ef4645a79fca 32
mpanetta 0:ef4645a79fca 33 // If the requested size is the same as the current size there's nothing to do,
mpanetta 0:ef4645a79fca 34 // just continue to use the same buffer as it's fine as it is.
mpanetta 0:ef4645a79fca 35 if (buffer_size[type] == size) return rval;
mpanetta 0:ef4645a79fca 36
mpanetta 0:ef4645a79fca 37 // Make sure the ISR cannot use the buffers while we are manipulating them.
mpanetta 0:ef4645a79fca 38 disableIrq();
mpanetta 0:ef4645a79fca 39
mpanetta 0:ef4645a79fca 40 // If the requested buffer size is larger than the current size,
mpanetta 0:ef4645a79fca 41 // attempt to create a new buffer and use it.
mpanetta 0:ef4645a79fca 42 if (buffer_size[type] < size) {
mpanetta 0:ef4645a79fca 43 rval = upSizeBuffer(size, type, memory_check);
mpanetta 0:ef4645a79fca 44 }
mpanetta 0:ef4645a79fca 45 else if (buffer_size[type] > size) {
mpanetta 0:ef4645a79fca 46 rval = downSizeBuffer(size, type, memory_check);
mpanetta 0:ef4645a79fca 47 }
mpanetta 0:ef4645a79fca 48
mpanetta 0:ef4645a79fca 49 // Start the ISR system again with the new buffers.
mpanetta 0:ef4645a79fca 50 enableIrq();
mpanetta 0:ef4645a79fca 51
mpanetta 0:ef4645a79fca 52 return rval;
mpanetta 0:ef4645a79fca 53 }
mpanetta 0:ef4645a79fca 54
mpanetta 0:ef4645a79fca 55 int
mpanetta 0:ef4645a79fca 56 MODSERIAL::downSizeBuffer(int size, IrqType type, bool memory_check)
mpanetta 0:ef4645a79fca 57 {
mpanetta 0:ef4645a79fca 58 if (size >= buffer_count[type]) {
mpanetta 0:ef4645a79fca 59 return BufferOversize;
mpanetta 0:ef4645a79fca 60 }
mpanetta 0:ef4645a79fca 61
mpanetta 0:ef4645a79fca 62 char *s = (char *)malloc(size);
mpanetta 0:ef4645a79fca 63
mpanetta 0:ef4645a79fca 64 if (s == (char *)NULL) {
mpanetta 0:ef4645a79fca 65 if (memory_check) {
mpanetta 0:ef4645a79fca 66 error("Failed to allocate memory for %s buffer", type == TxIrq ? "TX" : "RX");
mpanetta 0:ef4645a79fca 67 }
mpanetta 0:ef4645a79fca 68 return NoMemory;
mpanetta 0:ef4645a79fca 69 }
mpanetta 0:ef4645a79fca 70
mpanetta 0:ef4645a79fca 71 int c, new_in = 0;
mpanetta 0:ef4645a79fca 72
mpanetta 0:ef4645a79fca 73 do {
mpanetta 0:ef4645a79fca 74 c = __getc(false);
mpanetta 0:ef4645a79fca 75 if (c != -1) s[new_in++] = (char)c;
mpanetta 0:ef4645a79fca 76 if (new_in >= size) new_in = 0;
mpanetta 0:ef4645a79fca 77 }
mpanetta 0:ef4645a79fca 78 while (c != -1);
mpanetta 0:ef4645a79fca 79
mpanetta 0:ef4645a79fca 80 free((char *)buffer[type]);
mpanetta 0:ef4645a79fca 81 buffer[type] = s;
mpanetta 0:ef4645a79fca 82 buffer_in[type] = new_in;
mpanetta 0:ef4645a79fca 83 buffer_out[type] = 0;
mpanetta 0:ef4645a79fca 84 return Ok;
mpanetta 0:ef4645a79fca 85 }
mpanetta 0:ef4645a79fca 86
mpanetta 0:ef4645a79fca 87 int
mpanetta 0:ef4645a79fca 88 MODSERIAL::upSizeBuffer(int size, IrqType type, bool memory_check)
mpanetta 0:ef4645a79fca 89 {
mpanetta 0:ef4645a79fca 90 char *s = (char *)malloc(size);
mpanetta 0:ef4645a79fca 91
mpanetta 0:ef4645a79fca 92 if (s == (char *)NULL) {
mpanetta 0:ef4645a79fca 93 if (memory_check) {
mpanetta 0:ef4645a79fca 94 error("Failed to allocate memory for %s buffer", type == TxIrq ? "TX" : "RX");
mpanetta 0:ef4645a79fca 95 }
mpanetta 0:ef4645a79fca 96 return NoMemory;
mpanetta 0:ef4645a79fca 97 }
mpanetta 0:ef4645a79fca 98
mpanetta 0:ef4645a79fca 99 if (buffer_count[type] == 0) { // Current buffer empty?
mpanetta 0:ef4645a79fca 100 free((char *)buffer[type]);
mpanetta 0:ef4645a79fca 101 buffer[type] = s;
mpanetta 0:ef4645a79fca 102 buffer_in[type] = 0;
mpanetta 0:ef4645a79fca 103 buffer_out[type] = 0;
mpanetta 0:ef4645a79fca 104 }
mpanetta 0:ef4645a79fca 105 else { // Copy the current contents into the new buffer.
mpanetta 0:ef4645a79fca 106 int c, new_in = 0;
mpanetta 0:ef4645a79fca 107 do {
mpanetta 0:ef4645a79fca 108 c = __getc(false);
mpanetta 0:ef4645a79fca 109 if (c != -1) s[new_in++] = (char)c;
mpanetta 0:ef4645a79fca 110 if (new_in >= size) new_in = 0; // Shouldn't happen, but be sure.
mpanetta 0:ef4645a79fca 111 }
mpanetta 0:ef4645a79fca 112 while (c != -1);
mpanetta 0:ef4645a79fca 113 free((char *)buffer[type]);
mpanetta 0:ef4645a79fca 114 buffer[type] = s;
mpanetta 0:ef4645a79fca 115 buffer_in[type] = new_in;
mpanetta 0:ef4645a79fca 116 buffer_out[type] = 0;
mpanetta 0:ef4645a79fca 117 }
mpanetta 0:ef4645a79fca 118
mpanetta 0:ef4645a79fca 119 buffer_size[type] = size;
mpanetta 0:ef4645a79fca 120 return Ok;
mpanetta 0:ef4645a79fca 121 }
mpanetta 0:ef4645a79fca 122
mpanetta 0:ef4645a79fca 123 }; // namespace AjK ends