Graham Cantin / MODSERIAL

trying to make telnetserver repo public

Fork of MODSERIAL by Andy K

INIT.cpp@0:eb2522b41db8, 2010-11-20 (annotated)

Committer:
AjK
Date:
Sat Nov 20 16:54:05 2010 +0000
Revision:
0:eb2522b41db8
Child:
2:b936b4acbd92
1.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AjK 0:eb2522b41db8 1 /*
AjK 0:eb2522b41db8 2 Copyright (c) 2010 Andy Kirkham
AjK 0:eb2522b41db8 3
AjK 0:eb2522b41db8 4 Permission is hereby granted, free of charge, to any person obtaining a copy
AjK 0:eb2522b41db8 5 of this software and associated documentation files (the "Software"), to deal
AjK 0:eb2522b41db8 6 in the Software without restriction, including without limitation the rights
AjK 0:eb2522b41db8 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
AjK 0:eb2522b41db8 8 copies of the Software, and to permit persons to whom the Software is
AjK 0:eb2522b41db8 9 furnished to do so, subject to the following conditions:
AjK 0:eb2522b41db8 10
AjK 0:eb2522b41db8 11 The above copyright notice and this permission notice shall be included in
AjK 0:eb2522b41db8 12 all copies or substantial portions of the Software.
AjK 0:eb2522b41db8 13
AjK 0:eb2522b41db8 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
AjK 0:eb2522b41db8 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
AjK 0:eb2522b41db8 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
AjK 0:eb2522b41db8 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
AjK 0:eb2522b41db8 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
AjK 0:eb2522b41db8 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
AjK 0:eb2522b41db8 20 THE SOFTWARE.
AjK 0:eb2522b41db8 21 */
AjK 0:eb2522b41db8 22
AjK 0:eb2522b41db8 23 #include "MODSERIAL.h"
AjK 0:eb2522b41db8 24 #include "MACROS.h"
AjK 0:eb2522b41db8 25
AjK 0:eb2522b41db8 26 namespace AjK {
AjK 0:eb2522b41db8 27
AjK 0:eb2522b41db8 28 void
AjK 0:eb2522b41db8 29 MODSERIAL::init(int txSize, int rxSize)
AjK 0:eb2522b41db8 30 {
AjK 0:eb2522b41db8 31 disableIrq();
AjK 0:eb2522b41db8 32
AjK 0:eb2522b41db8 33 setBase();
AjK 0:eb2522b41db8 34
AjK 0:eb2522b41db8 35 if (_base != NULL) {
AjK 0:eb2522b41db8 36 buffer_size[RxIrq] = rxSize;
AjK 0:eb2522b41db8 37 buffer[RxIrq] = (char *)malloc(buffer_size[RxIrq]);
AjK 0:eb2522b41db8 38 buffer_in[RxIrq] = 0;
AjK 0:eb2522b41db8 39 buffer_out[RxIrq] = 0;
AjK 0:eb2522b41db8 40 buffer_count[RxIrq] = 0;
AjK 0:eb2522b41db8 41 buffer_overflow[RxIrq] = 0;
AjK 0:eb2522b41db8 42 Serial::attach(this, &MODSERIAL::isr_rx, Serial::RxIrq);
AjK 0:eb2522b41db8 43
AjK 0:eb2522b41db8 44 buffer_size[TxIrq] = txSize;
AjK 0:eb2522b41db8 45 buffer[TxIrq] = (char *)malloc(buffer_size[TxIrq]);
AjK 0:eb2522b41db8 46 buffer_in[TxIrq] = 0;
AjK 0:eb2522b41db8 47 buffer_out[TxIrq] = 0;
AjK 0:eb2522b41db8 48 buffer_count[TxIrq] = 0;
AjK 0:eb2522b41db8 49 buffer_overflow[TxIrq] = 0;
AjK 0:eb2522b41db8 50 Serial::attach(this, &MODSERIAL::isr_tx, Serial::TxIrq);
AjK 0:eb2522b41db8 51 }
AjK 0:eb2522b41db8 52
AjK 0:eb2522b41db8 53 if (!txBufferSane()) {
AjK 0:eb2522b41db8 54 error("Failed to allocate memory for TX buffer");
AjK 0:eb2522b41db8 55 }
AjK 0:eb2522b41db8 56
AjK 0:eb2522b41db8 57 if (!rxBufferSane()) {
AjK 0:eb2522b41db8 58 error("Failed to allocate memory for RX buffer");
AjK 0:eb2522b41db8 59 }
AjK 0:eb2522b41db8 60
AjK 0:eb2522b41db8 61 _FCR = MODSERIAL_FIFO_ENABLE | MODSERIAL_FIFO_RX_RESET | MODSERIAL_FIFO_TX_RESET;
AjK 0:eb2522b41db8 62
AjK 0:eb2522b41db8 63 enableIrq();
AjK 0:eb2522b41db8 64 }
AjK 0:eb2522b41db8 65
AjK 0:eb2522b41db8 66 void
AjK 0:eb2522b41db8 67 MODSERIAL::setBase(void)
AjK 0:eb2522b41db8 68 {
AjK 0:eb2522b41db8 69 switch(_uidx) {
AjK 0:eb2522b41db8 70 case 0: _base = LPC_UART0; break;
AjK 0:eb2522b41db8 71 case 1: _base = LPC_UART1; break;
AjK 0:eb2522b41db8 72 case 2: _base = LPC_UART2; break;
AjK 0:eb2522b41db8 73 case 3: _base = LPC_UART3; break;
AjK 0:eb2522b41db8 74 default : _base = NULL; break;
AjK 0:eb2522b41db8 75 }
AjK 0:eb2522b41db8 76 }
AjK 0:eb2522b41db8 77
AjK 0:eb2522b41db8 78 }; // namespace AjK ends