diff options
Diffstat (limited to 'c/src/lib/libbsp/arm/lpc176x/misc/io.c')
-rw-r--r-- | c/src/lib/libbsp/arm/lpc176x/misc/io.c | 349 |
1 files changed, 0 insertions, 349 deletions
diff --git a/c/src/lib/libbsp/arm/lpc176x/misc/io.c b/c/src/lib/libbsp/arm/lpc176x/misc/io.c deleted file mode 100644 index c25fe94c0b..0000000000 --- a/c/src/lib/libbsp/arm/lpc176x/misc/io.c +++ /dev/null @@ -1,349 +0,0 @@ -/** - * @file io.c - * - * @ingroup lpc176x - * - * @brief Input/output module methods. - */ - -/* - * Copyright (c) 2014 Taller Technologies. - * - * @author Boretto Martin (martin.boretto@tallertechnologies.com) - * @author Diaz Marcos (marcos.diaz@tallertechnologies.com) - * @author Lenarduzzi Federico (federico.lenarduzzi@tallertechnologies.com) - * @author Daniel Chicco (daniel.chicco@tallertechnologies.com) - * - * The license and distribution terms for this file may be - * found in the file LICENSE in this distribution or at - * http://www.rtems.org/license/LICENSE. - */ - -#include <rtems/status-checks.h> -#include <bsp.h> -#include <bsp/io.h> -#include <bsp/start.h> -#include <bsp/system-clocks.h> - -/** - * @brief Modules table according to the LPC176x - */ -static const lpc176x_module_entry lpc176x_module_table[] = { - LPC176X_MODULE_ENTRY( LPC176X_MODULE_WD, 0, 1, 0 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_ADC, 1, 1, 12 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_CAN_0, 1, 1, 13 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_CAN_1, 1, 1, 14 ), - LPC176X_MODULE_ENTRY(LPC176X_MODULE_ACCF, 0, 1, 15), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_DAC, 0, 1, 11 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_GPDMA, 1, 1, 29 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_GPIO, 0, 1, 15 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_I2S, 1, 1, 27 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_MCI, 1, 1, 28 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_MCPWM, 1, 1, 17 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_PCB, 0, 1, 18 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_PWM_0, 1, 1, 5 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_PWM_1, 1, 1, 6 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_QEI, 1, 1, 18 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_RTC, 1, 1, 9 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_SYSCON, 0, 1, 30 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_TIMER_0, 1, 1, 1 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_TIMER_1, 1, 1, 2 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_TIMER_2, 1, 1, 22 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_TIMER_3, 1, 1, 23 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_UART_0, 1, 1, 3 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_UART_1, 1, 1, 4 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_UART_2, 1, 1, 24 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_UART_3, 1, 1, 25 ), - LPC176X_MODULE_ENTRY( LPC176X_MODULE_USB, 1, 0, 31 ) -}; - -inline void lpc176x_pin_select( - const uint32_t pin, - const lpc176x_pin_function function -) -{ - assert( pin <= LPC176X_IO_INDEX_MAX - && function < LPC176X_PIN_FUNCTION_COUNT ); - const uint32_t pin_selected = LPC176X_PIN_SELECT( pin ); - volatile uint32_t *const pinsel = &LPC176X_PINSEL[ pin_selected ]; - const uint32_t shift = LPC176X_PIN_SELECT_SHIFT( pin ); - *pinsel = SET_FIELD( *pinsel, function, - LPC176X_PIN_SELECT_MASK << shift, shift ); -} - -void lpc176x_pin_set_mode( - const uint32_t pin, - const lpc176x_pin_mode mode -) -{ - assert( pin <= LPC176X_IO_INDEX_MAX - && mode < LPC176X_PIN_MODE_COUNT ); - const uint32_t pin_selected = LPC176X_PIN_SELECT( pin ); - volatile uint32_t *const pinmode = &LPC176X_PINMODE[ pin_selected ]; - const uint32_t shift = LPC176X_PIN_SELECT_SHIFT( pin ); - *pinmode = SET_FIELD( *pinmode, mode, - LPC176X_PIN_SELECT_MASK << shift, shift ); -} - -/** - * @brief Checks if the module has power. - * - * @param has_power Power. - * @param index Index to shift. - * @param turn_on Turn on/off the power. - * @param level Interrupts value. - */ -static rtems_status_code check_power( - const bool has_power, - const unsigned index, - const bool turn_on, - rtems_interrupt_level level -) -{ - rtems_status_code status_code = RTEMS_INVALID_NUMBER; - - if ( index <= LPC176X_MODULE_BITS_COUNT ) { - if ( has_power ) { - rtems_interrupt_disable( level ); - - if ( turn_on ) { - LPC176X_SCB.pconp |= 1u << index; - } else { - LPC176X_SCB.pconp &= ~( 1u << index ); - } - - rtems_interrupt_enable( level ); - } - - /* else implies that the module has not power. Also, - there is nothing to do. */ - - status_code = RTEMS_SUCCESSFUL; - } - - /* else implies an invalid index number. Also, the function - does not return successful. */ - - return status_code; -} - -/** - * @brief Sets the correct value according to the specific peripheral clock. - * - * @param is_first_pclksel Represents the first pclksel. - * @param clock The clock to set for this module. - * @param clock_shift Value to clock shift. - */ -static inline void set_pclksel_value( - const uint32_t pclksel, - const lpc176x_module_clock clock, - const unsigned clock_shift -) -{ - assert( pclksel < LPC176X_SCB_PCLKSEL_COUNT ); - const uint32_t setclock = ( clock << clock_shift ); - const uint32_t mask = ~( LPC176X_MODULE_CLOCK_MASK << clock_shift ); - LPC176X_SCB.pclksel[ pclksel ] = ( LPC176X_SCB.pclksel[ pclksel ] & mask ) | - setclock; -} - -/** - * @brief Checks if the module has clock. - * - * @param has_clock Clock. - * @param index Index to shift. - * @param clock The clock to set for this module. - * @param level Interrupts value. - */ -static rtems_status_code check_clock( - const bool has_clock, - const unsigned index, - const lpc176x_module_clock clock, - rtems_interrupt_level level -) -{ - rtems_status_code status_code = RTEMS_INVALID_NUMBER; - - if ( index <= LPC176X_MODULE_BITS_COUNT ) { - if ( has_clock ) { - unsigned clock_shift = 2u * index; - rtems_interrupt_disable( level ); - - if ( clock_shift < LPC176X_MODULE_BITS_COUNT ) { - /* Sets the pclksel 0. */ - set_pclksel_value( LPC176X_SCB_PCLKSEL0, clock, clock_shift ); - } else { - /* Sets the pclksel 1. */ - clock_shift -= LPC176X_MODULE_BITS_COUNT; - set_pclksel_value( LPC176X_SCB_PCLKSEL1, clock, clock_shift ); - } - - rtems_interrupt_enable( level ); - } - - /* else implies that the module has not clock. Also, - there is nothing to do. */ - - status_code = RTEMS_SUCCESSFUL; - } - - /* else implies an invalid index number. Also, the function - does not return successful. */ - - return status_code; -} - -/** - * @brief Checks the usb module. - * - * @return RTEMS_SUCCESFUL if the usb module is correct. - */ -static rtems_status_code check_usb_module( void ) -{ - rtems_status_code status_code = RTEMS_INCORRECT_STATE; - const uint32_t pllclk = lpc176x_pllclk(); - const uint32_t usbclk = LPC176X_USB_CLOCK; - - if ( pllclk % usbclk == 0u ) { - const uint32_t usbdiv = pllclk / usbclk; - - LPC176X_SCB.usbclksel = LPC176X_SCB_USBCLKSEL_USBDIV( usbdiv ) | - LPC176X_SCB_USBCLKSEL_USBSEL( 1 ); - status_code = RTEMS_SUCCESSFUL; - } - - /* else implies that the module has an incorrect pllclk or usbclk value. - Also, there is nothing to do. */ - - return status_code; -} - -/** - * @brief Enables the current module. - * - * @param module Current module to enable/disable. - * @param clock The clock to set for this module. - * @param enable TRUE if the module is enable. - * @return RTEMS_SUCCESSFULL if the module was enabled successfully. - */ -static rtems_status_code enable_disable_module( - const lpc176x_module module, - const lpc176x_module_clock clock, - const bool enable -) -{ - rtems_status_code status_code; - rtems_interrupt_level level = 0u; - - const bool has_power = lpc176x_module_table[ module ].power; - const bool has_clock = lpc176x_module_table[ module ].clock; - const unsigned index = lpc176x_module_table[ module ].index; - - assert( index <= LPC176X_MODULE_BITS_COUNT ); - - /* Enable or disable module */ - if ( enable ) { - status_code = check_power( has_power, index, true, level ); - RTEMS_CHECK_SC( status_code, - "Checking index shift to turn on power of the module." ); - - if ( module != LPC176X_MODULE_USB ) { - status_code = check_clock( has_clock, index, clock, level ); - RTEMS_CHECK_SC( status_code, - "Checking index shift to set pclksel to the current module." ); - } else { - status_code = check_usb_module(); - RTEMS_CHECK_SC( status_code, - "Checking pll clock to set usb clock to the current module." ); - } - } else { - status_code = check_power( has_power, index, false, level ); - RTEMS_CHECK_SC( status_code, - "Checking index shift to turn off power of the module." ); - } - - return status_code; -} - -/** - * @brief Enables the module power and clock. - * - * @param module Device to enable. - * @param clock The clock to set for this module. - * @param enable Enable or disable the module. - * @return RTEMS_SUCCESSFULL if the module was enabled succesfully. - */ -static rtems_status_code lpc176x_module_do_enable( - const lpc176x_module module, - lpc176x_module_clock clock, - const bool enable -) -{ - rtems_status_code status_code = RTEMS_SUCCESSFUL; - - if ( (unsigned) module >= LPC176X_MODULE_COUNT ) { - return RTEMS_INVALID_ID; - } - - /* else implies that the module has a correct value. Also, - there is nothing to do. */ - - if ( clock == LPC176X_MODULE_PCLK_DEFAULT ) { -#if ( LPC176X_PCLKDIV == 1u ) - clock = LPC176X_MODULE_CCLK; -#elif ( LPC176X_PCLKDIV == 2u ) - clock = LPC176X_MODULE_CCLK_2; -#elif ( LPC176X_PCLKDIV == 4u ) - clock = LPC176X_MODULE_CCLK_4; -#elif ( LPC176X_PCLKDIV == 8u ) - clock = LPC176X_MODULE_CCLK_8; -#else -#error "Unexpected clock divisor." -#endif - } - - /* else implies that the clock has a correct divisor. */ - - if ( ( clock & ~LPC176X_MODULE_CLOCK_MASK ) == 0u ) { - status_code = enable_disable_module( module, clock, enable ); - RTEMS_CHECK_SC( status_code, "Checking the module to enable/disable." ); - } else { - status_code = RTEMS_INVALID_CLOCK; - } - - return status_code; -} - -inline rtems_status_code lpc176x_module_enable( - const lpc176x_module module, - lpc176x_module_clock clock -) -{ - return lpc176x_module_do_enable( module, clock, true ); -} - -inline rtems_status_code lpc176x_module_disable( const lpc176x_module module ) -{ - return lpc176x_module_do_enable( module, - LPC176X_MODULE_PCLK_DEFAULT, - false ); -} - -bool lpc176x_module_is_enabled( const lpc176x_module module ) -{ - assert( (unsigned) module < LPC176X_MODULE_COUNT ); - - const bool has_power = lpc176x_module_table[ module ].power; - bool enabled; - - if ( has_power ) { - const unsigned index = lpc176x_module_table[ module ].index; - const uint32_t pconp = LPC176X_SCB.pconp; - - enabled = ( pconp & ( 1u << index ) ) != 0u; - } else { - enabled = true; - } - - return enabled; -} |