sb_putc.cpp

00001 /*
00002     Copyright (c) 2010 Andy Kirkham
00003  
00004     Permission is hereby granted, free of charge, to any person obtaining a copy
00005     of this software and associated documentation files (the "Software"), to deal
00006     in the Software without restriction, including without limitation the rights
00007     to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
00008     copies of the Software, and to permit persons to whom the Software is
00009     furnished to do so, subject to the following conditions:
00010  
00011     The above copyright notice and this permission notice shall be included in
00012     all copies or substantial portions of the Software.
00013  
00014     THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
00015     IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
00016     FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
00017     AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
00018     LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
00019     OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
00020     THE SOFTWARE.
00021 */
00022 
00023 #include "../SerialBuffered.h"
00024 #include "../sb_globals.h"
00025 
00026 int SerialBuffered::putc(int c, bool blocking) {
00027     if ((GET_REGISTER(SERIALBUFFERED_LSR) & 0x20) && (_tx_buffer_in[uart_number] == _tx_buffer_out[uart_number] && !_tx_buffer_full[uart_number])) {
00028         SET_REGISTER(SERIALBUFFERED_THR, (uint8_t)c);
00029     }
00030     else {
00031         if (_tx_buffer_full[uart_number]) {
00032             if (blocking) while (_tx_buffer_full[uart_number]) ; /* Blocks!!! */    
00033             else {
00034                 _tx_buffer_overflow[uart_number] = true;
00035                 return -1;
00036             }
00037         }  
00038         _tx_buffer[uart_number][_tx_buffer_in[uart_number]++] = (char)c;
00039         if (_tx_buffer_in[uart_number] >= _tx_buffer_size[uart_number]) {
00040             _tx_buffer_in[uart_number] = 0;
00041         }
00042         if (_tx_buffer_in[uart_number] == _tx_buffer_out[uart_number] && !_tx_buffer_full[uart_number]) _tx_buffer_full[uart_number] = true;
00043         SET_REGISTER(SERIALBUFFERED_IER, 0x3);        
00044     }
00045     return 0;
00046 }
00047 
00048 /** putc
00049  */
00050 int SerialBuffered::putc(int c) {
00051     return putc(c, true);
00052 }
00053 
00054 int SerialBuffered::writeable(void) {
00055     return (!_tx_buffer_full[uart_number] && !_tx_buffer_overflow[uart_number]) ? 1 : 0;
00056 }