sb_aux.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 void SerialBuffered::format(int bits, int parity, int stopbits) {
00027     SET_REGISTER(SERIALBUFFERED_LCR, (bits | parity | stopbits) & 0x7F);
00028 }
00029 
00030 void SerialBuffered::baud(int baud) {
00031     uint16_t rate = calculate_baud(baud, uart_number);        
00032     SET_REGISTER(SERIALBUFFERED_LCR, GET_REGISTER(SERIALBUFFERED_LCR) | 0x80);
00033     SET_REGISTER(SERIALBUFFERED_DML, (rate >> 8) & 0xFF);
00034     SET_REGISTER(SERIALBUFFERED_DLL, (rate &0xFF));
00035     SET_REGISTER(SERIALBUFFERED_LCR, GET_REGISTER(SERIALBUFFERED_LCR) & 0x7F);
00036 }
00037 
00038 uint16_t SerialBuffered::calculate_baud(int baud, int uart) {
00039     static int multipliers[4] = { 4, 1, 2, 8 };
00040     int clock = 0;
00041     
00042     switch (uart) {
00043         case 0: clock = (LPC_SC->PCLKSEL0 >>  6) & 0x3; break;
00044         case 1: clock = (LPC_SC->PCLKSEL0 >>  8) & 0x3; break;
00045         case 2: clock = (LPC_SC->PCLKSEL1 >> 16) & 0x3; break;
00046         case 3: clock = (LPC_SC->PCLKSEL1 >> 18) & 0x3; break;
00047     }
00048     
00049     return (uint16_t)(((SystemCoreClock / 16 / baud) * multipliers[clock]) & 0xFFFF);
00050 }
00051 
00052 void SerialBuffered::set_tx_buffer_size(int buffer_size, char *buffer) {
00053     SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 2));
00054     SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 2) | 1);
00055     _tx_buffer_size[uart_number] = buffer_size;
00056     if (_tx_buffer_used_malloc[uart_number] && _tx_buffer[uart_number]) {
00057         free(_tx_buffer[uart_number]);
00058         _tx_buffer_used_malloc[uart_number] = false;
00059     }
00060     if (buffer == (char *)NULL) {
00061         _tx_buffer[uart_number] = (char *)malloc(buffer_size);
00062         _tx_buffer_used_malloc[uart_number] = true;
00063     }
00064     else {
00065         _tx_buffer[uart_number] = buffer;
00066         _tx_buffer_used_malloc[uart_number] = false;
00067     }
00068     _tx_buffer_in[uart_number] = _tx_buffer_out[uart_number] = 0;
00069     _tx_buffer_full[uart_number] = false;
00070     SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) | 0x2);
00071 }
00072 
00073 void SerialBuffered::set_tx_buffer_size(int buffer_size) {
00074     set_tx_buffer_size(buffer_size, (char *)NULL);
00075 }
00076 
00077 /**
00078  */
00079 void SerialBuffered::set_rx_buffer_size(int buffer_size, char *buffer) {
00080     SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 1));
00081     SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 1) | 1);
00082     _rx_buffer_size[uart_number] = buffer_size;
00083     if (_rx_buffer_used_malloc[uart_number] && _rx_buffer[uart_number]) {
00084         free(_rx_buffer[uart_number]);
00085         _rx_buffer_used_malloc[uart_number] = false;
00086     }
00087     if (buffer == (char *)NULL) {
00088         _rx_buffer[uart_number] = (char *)malloc(buffer_size);
00089         _rx_buffer_used_malloc[uart_number] = true;
00090     }
00091     else {
00092         _rx_buffer[uart_number] = buffer;
00093         _rx_buffer_used_malloc[uart_number] = false;
00094     }
00095     _rx_buffer_in[uart_number] = _rx_buffer_out[uart_number] = 0;
00096     _rx_buffer_full[uart_number] = false;
00097     SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) | 0x1); 
00098 }
00099 
00100 void SerialBuffered::set_rx_buffer_size(int buffer_size) {
00101     set_rx_buffer_size(buffer_size, (char *)NULL);
00102 }
00103 
00104 
00105 void SerialBuffered::reset_uart_tx(int uart_number) {
00106     SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 1));
00107     SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 2) | 1);
00108     if (_tx_buffer_used_malloc[uart_number] && _tx_buffer[uart_number]) {
00109         free(_tx_buffer[uart_number]);
00110         _tx_buffer[uart_number] = (char *)NULL;
00111         _tx_buffer_used_malloc[uart_number] = false;
00112     }
00113     _tx_buffer_in[uart_number] = _tx_buffer_out[uart_number] = 0;
00114     _tx_buffer_full[uart_number] = false;
00115 }
00116 
00117 void SerialBuffered::reset_uart_rx(int uart_number) {
00118     SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 0));
00119     SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 1) | 1);    
00120     if (_rx_buffer_used_malloc[uart_number] && _rx_buffer[uart_number]) {
00121         free(_rx_buffer[uart_number]);
00122         _rx_buffer[uart_number] = (char *)NULL;
00123         _rx_buffer_used_malloc[uart_number] = false;
00124     }
00125     _rx_buffer_in[uart_number] = _rx_buffer_out[uart_number] = 0;
00126     _rx_buffer_full[uart_number] = false;
00127 }