Jordi Solsona / MODSERIAL

haptics version

Fork of MODSERIAL by Andy K

GETC.cpp@8:775f860e94d3, 2010-11-22 (annotated)

Committer:
AjK
Date:
Mon Nov 22 09:58:34 2010 +0000
Revision:
8:775f860e94d3
Parent:
1:b7e435fbfe8e
Child:
22:c11ea36f17f9
1.8

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 int
AjK 0:eb2522b41db8 29 MODSERIAL::__getc(bool block)
AjK 0:eb2522b41db8 30 {
AjK 8:775f860e94d3 31 // If no buffer is in use fall back to standard RX FIFO usage.
AjK 8:775f860e94d3 32 // Note, we must block in this case and ignore bool "block"
AjK 8:775f860e94d3 33 // so as to maintain compat with Mbed Serial.
AjK 8:775f860e94d3 34 if (buffer_size[RxIrq] == 0 || buffer[RxIrq] == (char *)NULL) {
AjK 8:775f860e94d3 35 while(! MODSERIAL_RBR_HAS_DATA ) ;
AjK 8:775f860e94d3 36 return (int)(_RBR & 0xFF);
AjK 8:775f860e94d3 37 }
AjK 8:775f860e94d3 38
AjK 0:eb2522b41db8 39 if (block) { while ( MODSERIAL_RX_BUFFER_EMPTY ) ; } // Blocks.
AjK 0:eb2522b41db8 40 else if ( MODSERIAL_RX_BUFFER_EMPTY ) return -1;
AjK 0:eb2522b41db8 41
AjK 0:eb2522b41db8 42 int c = buffer[RxIrq][buffer_out[RxIrq]];
AjK 0:eb2522b41db8 43 buffer_out[RxIrq]++;
AjK 0:eb2522b41db8 44 if (buffer_out[RxIrq] >= buffer_size[RxIrq]) {
AjK 0:eb2522b41db8 45 buffer_out[RxIrq] = 0;
AjK 0:eb2522b41db8 46 }
AjK 0:eb2522b41db8 47
AjK 0:eb2522b41db8 48 // If we have made space in the RX Buffer then copy over
AjK 0:eb2522b41db8 49 // any characters in the RX FIFO that my reside there.
AjK 0:eb2522b41db8 50 // Temporarily disable the RX IRQ so that we do not re-enter
AjK 0:eb2522b41db8 51 // it under interrupts.
AjK 0:eb2522b41db8 52 if ( ! MODSERIAL_RX_BUFFER_FULL ) {
AjK 0:eb2522b41db8 53 uint32_t ier = _IER;
AjK 0:eb2522b41db8 54 _IER &= ~(1UL << 0);
AjK 0:eb2522b41db8 55 isr_rx();
AjK 0:eb2522b41db8 56 _IER = ier;
AjK 0:eb2522b41db8 57 }
AjK 0:eb2522b41db8 58
AjK 0:eb2522b41db8 59 buffer_count[RxIrq]--;
AjK 0:eb2522b41db8 60 return c;
AjK 0:eb2522b41db8 61 }
AjK 0:eb2522b41db8 62
AjK 0:eb2522b41db8 63 }; // namespace AjK ends