JEK changes enabling proper recording of IMU/GPS datastrams - 02-APR-2013

Dependencies:   mbed

Fork of GPS_Incremental by Dan Matthews

Committer:
jekain314
Date:
Fri Apr 19 16:21:27 2013 +0000
Revision:
9:b45feb91ba38
Parent:
0:c746ee34feae
update to allow better imu gps data collection

Who changed what in which revision?

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