Derek Fukumori / MODSERIAL

Fork of MODSERIAL by Andy K

Committer:
dfukumori
Date:
Fri Jul 13 01:09:23 2012 +0000
Revision:
23:1236d0b64e71
Parent:
0:eb2522b41db8
Required commit -- no changes

Who changed what in which revision?

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