Prof Greg Egan
/
UAVXArm-GKE
UAVX Multicopter Flight Controller.
Diff: Methods/sb_aux.cpp
- Revision:
- 0:62a1c91a859a
diff -r 000000000000 -r 62a1c91a859a Methods/sb_aux.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Methods/sb_aux.cpp Fri Feb 18 22:28:05 2011 +0000 @@ -0,0 +1,127 @@ +/* + Copyright (c) 2010 Andy Kirkham + + Permission is hereby granted, free of charge, to any person obtaining a copy + of this software and associated documentation files (the "Software"), to deal + in the Software without restriction, including without limitation the rights + to use, copy, modify, merge, publish, distribute, sublicense, and/or sell + copies of the Software, and to permit persons to whom the Software is + furnished to do so, subject to the following conditions: + + The above copyright notice and this permission notice shall be included in + all copies or substantial portions of the Software. + + THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE + AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER + LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN + THE SOFTWARE. +*/ + +#include "../SerialBuffered.h" +#include "../sb_globals.h" + +void SerialBuffered::format(int bits, int parity, int stopbits) { + SET_REGISTER(SERIALBUFFERED_LCR, (bits | parity | stopbits) & 0x7F); +} + +void SerialBuffered::baud(int baud) { + uint16_t rate = calculate_baud(baud, uart_number); + SET_REGISTER(SERIALBUFFERED_LCR, GET_REGISTER(SERIALBUFFERED_LCR) | 0x80); + SET_REGISTER(SERIALBUFFERED_DML, (rate >> 8) & 0xFF); + SET_REGISTER(SERIALBUFFERED_DLL, (rate &0xFF)); + SET_REGISTER(SERIALBUFFERED_LCR, GET_REGISTER(SERIALBUFFERED_LCR) & 0x7F); +} + +uint16_t SerialBuffered::calculate_baud(int baud, int uart) { + static int multipliers[4] = { 4, 1, 2, 8 }; + int clock = 0; + + switch (uart) { + case 0: clock = (LPC_SC->PCLKSEL0 >> 6) & 0x3; break; + case 1: clock = (LPC_SC->PCLKSEL0 >> 8) & 0x3; break; + case 2: clock = (LPC_SC->PCLKSEL1 >> 16) & 0x3; break; + case 3: clock = (LPC_SC->PCLKSEL1 >> 18) & 0x3; break; + } + + return (uint16_t)(((SystemCoreClock / 16 / baud) * multipliers[clock]) & 0xFFFF); +} + +void SerialBuffered::set_tx_buffer_size(int buffer_size, char *buffer) { + SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 2)); + SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 2) | 1); + _tx_buffer_size[uart_number] = buffer_size; + if (_tx_buffer_used_malloc[uart_number] && _tx_buffer[uart_number]) { + free(_tx_buffer[uart_number]); + _tx_buffer_used_malloc[uart_number] = false; + } + if (buffer == (char *)NULL) { + _tx_buffer[uart_number] = (char *)malloc(buffer_size); + _tx_buffer_used_malloc[uart_number] = true; + } + else { + _tx_buffer[uart_number] = buffer; + _tx_buffer_used_malloc[uart_number] = false; + } + _tx_buffer_in[uart_number] = _tx_buffer_out[uart_number] = 0; + _tx_buffer_full[uart_number] = false; + SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) | 0x2); +} + +void SerialBuffered::set_tx_buffer_size(int buffer_size) { + set_tx_buffer_size(buffer_size, (char *)NULL); +} + +/** + */ +void SerialBuffered::set_rx_buffer_size(int buffer_size, char *buffer) { + SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 1)); + SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 1) | 1); + _rx_buffer_size[uart_number] = buffer_size; + if (_rx_buffer_used_malloc[uart_number] && _rx_buffer[uart_number]) { + free(_rx_buffer[uart_number]); + _rx_buffer_used_malloc[uart_number] = false; + } + if (buffer == (char *)NULL) { + _rx_buffer[uart_number] = (char *)malloc(buffer_size); + _rx_buffer_used_malloc[uart_number] = true; + } + else { + _rx_buffer[uart_number] = buffer; + _rx_buffer_used_malloc[uart_number] = false; + } + _rx_buffer_in[uart_number] = _rx_buffer_out[uart_number] = 0; + _rx_buffer_full[uart_number] = false; + SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) | 0x1); +} + +void SerialBuffered::set_rx_buffer_size(int buffer_size) { + set_rx_buffer_size(buffer_size, (char *)NULL); +} + + +void SerialBuffered::reset_uart_tx(int uart_number) { + SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 1)); + SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 2) | 1); + if (_tx_buffer_used_malloc[uart_number] && _tx_buffer[uart_number]) { + free(_tx_buffer[uart_number]); + _tx_buffer[uart_number] = (char *)NULL; + _tx_buffer_used_malloc[uart_number] = false; + } + _tx_buffer_in[uart_number] = _tx_buffer_out[uart_number] = 0; + _tx_buffer_full[uart_number] = false; +} + +void SerialBuffered::reset_uart_rx(int uart_number) { + SET_REGISTER(SERIALBUFFERED_IER, GET_REGISTER(SERIALBUFFERED_IER) & (1UL << 0)); + SET_REGISTER(SERIALBUFFERED_FCR, (1UL << 1) | 1); + if (_rx_buffer_used_malloc[uart_number] && _rx_buffer[uart_number]) { + free(_rx_buffer[uart_number]); + _rx_buffer[uart_number] = (char *)NULL; + _rx_buffer_used_malloc[uart_number] = false; + } + _rx_buffer_in[uart_number] = _rx_buffer_out[uart_number] = 0; + _rx_buffer_full[uart_number] = false; +}