From 276afd2b4812bef2476456476af7e5392102d8a6 Mon Sep 17 00:00:00 2001 From: Sebastian Huber Date: Mon, 23 Apr 2018 09:48:52 +0200 Subject: bsps: Move SPI drivers to bsps This patch is a part of the BSP source reorganization. Update #3285. --- c/src/lib/libbsp/powerpc/tqm8xx/Makefile.am | 2 +- c/src/lib/libbsp/powerpc/tqm8xx/spi/spi.c | 873 ---------------------------- 2 files changed, 1 insertion(+), 874 deletions(-) delete mode 100644 c/src/lib/libbsp/powerpc/tqm8xx/spi/spi.c (limited to 'c/src/lib/libbsp/powerpc/tqm8xx') diff --git a/c/src/lib/libbsp/powerpc/tqm8xx/Makefile.am b/c/src/lib/libbsp/powerpc/tqm8xx/Makefile.am index bc7e02426b..3775b32268 100644 --- a/c/src/lib/libbsp/powerpc/tqm8xx/Makefile.am +++ b/c/src/lib/libbsp/powerpc/tqm8xx/Makefile.am @@ -34,7 +34,7 @@ librtemsbsp_a_SOURCES +=../../../../../../bsps/powerpc/tqm8xx/clock/p_clock.c # console librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/tqm8xx/console/console.c # spi -librtemsbsp_a_SOURCES += spi/spi.c +librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/tqm8xx/spi/spi.c # timer librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/tqm8xx/btimer/btimer.c # startup diff --git a/c/src/lib/libbsp/powerpc/tqm8xx/spi/spi.c b/c/src/lib/libbsp/powerpc/tqm8xx/spi/spi.c deleted file mode 100644 index 0b82242898..0000000000 --- a/c/src/lib/libbsp/powerpc/tqm8xx/spi/spi.c +++ /dev/null @@ -1,873 +0,0 @@ -/*===============================================================*\ -| Project: RTEMS support for tqm8xx | -+-----------------------------------------------------------------+ -| Copyright (c) 2009 | -| Embedded Brains GmbH | -| Obere Lagerstr. 30 | -| D-82178 Puchheim | -| Germany | -| rtems@embedded-brains.de | -+-----------------------------------------------------------------+ -| 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. | -| | -+-----------------------------------------------------------------+ -| this file contains the MPC8xx SPI driver | -\*===============================================================*/ -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#define M8xx_PB_SPI_MISO_MSK (1<<(31-28)) -#define M8xx_PB_SPI_MOSI_MSK (1<<(31-29)) -#define M8xx_PB_SPI_CLK_MSK (1<<(31-30)) - -#undef DEBUG - -/* - * this is a dummy receive buffer for sequences, - * where only send data are available - */ -uint8_t m8xx_spi_dummy_rxbuf[2]; -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_status_code m8xx_spi_baud_to_mode -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| determine proper divider value | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - uint32_t baudrate, /* desired baudrate */ - uint32_t *spimode /* result value */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ - uint32_t divider; - uint16_t tmpmode = 0; - /* - * determine clock divider and DIV16 bit - */ - divider = BSP_bus_frequency/baudrate; - if (divider > 64) { - tmpmode = M8xx_SPMODE_DIV16; - divider /= 16; - } - if ((divider < 1) || - (divider > 64)) { - return RTEMS_INVALID_NUMBER; - } - else { - tmpmode |= M8xx_SPMODE_PM(divider/4-1); - } - *spimode = tmpmode; - return RTEMS_SUCCESSFUL; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_status_code m8xx_spi_char_mode -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| determine proper value for character size | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - m8xx_spi_softc_t *softc_ptr, /* handle */ - uint32_t bits_per_char, /* bits per character */ - bool lsb_first, /* TRUE: send LSB first */ - uint16_t *spimode /* result value */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ - uint16_t tmpmode; - - /* - * calculate data format - */ - if ((bits_per_char >= 4) && - (bits_per_char <= 16)) { - tmpmode = M8xx_SPMODE_CLEN( bits_per_char-1); - } - else { - return RTEMS_INVALID_NUMBER; - } - - *spimode = tmpmode; - return 0; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static int m8xx_spi_wait -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| wait for spi to become idle | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - m8xx_spi_softc_t *softc_ptr /* handle */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ - uint16_t act_status; - rtems_status_code rc; - uint32_t tout; - -#if defined(DEBUG) - printk("m8xx_spi_wait called... "); -#endif - if (softc_ptr->initialized) { - /* - * allow interrupts, when receiver is not empty - */ - m8xx.spim = (M8xx_SPIE_TXE | M8xx_SPIE_TXB | - M8xx_SPIE_BSY | M8xx_SPIE_MME); - - rc = rtems_semaphore_obtain(softc_ptr->irq_sema_id, - RTEMS_WAIT, - RTEMS_NO_TIMEOUT); - if (rc != RTEMS_SUCCESSFUL) { - return rc; - } - } - else { - tout = 0; - do { - if (tout++ > 1000000) { -#if defined(DEBUG) - printk("... exit with RTEMS_TIMEOUT\r\n"); -#endif - return RTEMS_TIMEOUT; - } - /* - * wait for SPI to terminate - */ - } while (!(m8xx.spie & M8xx_SPIE_TXB)); - } - - act_status = m8xx.spie; - if ((act_status & (M8xx_SPIE_TXE | M8xx_SPIE_TXB | - M8xx_SPIE_BSY | M8xx_SPIE_MME))!= M8xx_SPIE_TXB) { -#if defined(DEBUG) - printk("... exit with RTEMS_IO_ERROR," - "act_status=0x%04x,mask=0x%04x,desired_status=0x%04x\r\n", - act_status,status_mask,desired_status); -#endif - return RTEMS_IO_ERROR; - } -#if defined(DEBUG) - printk("... exit OK\r\n"); -#endif - return RTEMS_SUCCESSFUL; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_isr m8xx_spi_irq_handler -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| handle interrupts | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - void *arg -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| | -\*=========================================================================*/ -{ - m8xx_spi_softc_t *softc_ptr = arg; - - /* - * disable interrupt mask - */ - m8xx.spim = 0; - if (softc_ptr->initialized) { - rtems_semaphore_release(softc_ptr->irq_sema_id); - } -} - -static void -mpc8xx_spi_irq_on(const rtems_irq_connect_data *irq) -{ -} - -static void -mpc8xx_spi_irq_off(const rtems_irq_connect_data *irq) -{ -} - -static int -mpc8xx_spi_irq_isOn(const rtems_irq_connect_data *irq) -{ - return 1; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static void m8xx_spi_install_irq_handler -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| install the interrupt handler | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - m8xx_spi_softc_t *softc_ptr, /* ptr to control structure */ - int install /* TRUE: install, FALSE: remove */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| | -\*=========================================================================*/ -{ - rtems_status_code rc = RTEMS_SUCCESSFUL; - - /* - * install handler for SPI device - */ - /* - * create semaphore for IRQ synchronization - */ - rc = rtems_semaphore_create(rtems_build_name('s','p','i','s'), - 0, - RTEMS_FIFO - | RTEMS_SIMPLE_BINARY_SEMAPHORE, - 0, - &softc_ptr->irq_sema_id); - if (rc != RTEMS_SUCCESSFUL) { - rtems_panic("SPI: cannot create semaphore"); - } - if (rc == RTEMS_SUCCESSFUL) { - rtems_irq_connect_data irq_conn_data = { - BSP_CPM_IRQ_SPI, - m8xx_spi_irq_handler, /* rtems_irq_hdl */ - (rtems_irq_hdl_param)softc_ptr, /* (rtems_irq_hdl_param) */ - mpc8xx_spi_irq_on, /* (rtems_irq_enable) */ - mpc8xx_spi_irq_off, /* (rtems_irq_disable) */ - mpc8xx_spi_irq_isOn /* (rtems_irq_is_enabled) */ - }; - if (!BSP_install_rtems_irq_handler (&irq_conn_data)) { - rtems_panic("SPI: cannot install IRQ handler"); - } - } -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -rtems_status_code m8xx_spi_init -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| initialize the driver | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh /* bus specifier structure */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ - m8xx_spi_softc_t *softc_ptr = &(((m8xx_spi_desc_t *)(bh))->softc); - rtems_status_code rc = RTEMS_SUCCESSFUL; - -#if defined(DEBUG) - printk("m8xx_spi_init called... "); -#endif - /* - * init HW registers: - */ - /* - * FIXME: set default mode in SPMODE - */ - - /* - * allocate BDs (1x RX, 1x TX) - */ - if (rc == RTEMS_SUCCESSFUL) { - softc_ptr->rx_bd = m8xx_bd_allocate (1); - softc_ptr->tx_bd = m8xx_bd_allocate (1); - if ((softc_ptr->rx_bd == NULL) || - (softc_ptr->tx_bd == NULL)) { - rc = RTEMS_NO_MEMORY; - } - } - /* - * set parameter RAM - */ - m8xx.spip.rbase = (char *)softc_ptr->rx_bd - (char *)&m8xx; - m8xx.spip.tbase = (char *)softc_ptr->tx_bd - (char *)&m8xx; - m8xx.spip.rfcr = M8xx_RFCR_MOT | M8xx_RFCR_DMA_SPACE(0); - m8xx.spip.tfcr = M8xx_RFCR_MOT | M8xx_RFCR_DMA_SPACE(0); - m8xx.spip.mrblr = 2; - - /* - * issue "InitRxTx" Command to CP - */ - m8xx_cp_execute_cmd (M8xx_CR_OP_INIT_RX_TX | M8xx_CR_CHAN_SPI); - - /* - * init interrupt stuff - */ - if (rc == RTEMS_SUCCESSFUL) { - m8xx_spi_install_irq_handler(softc_ptr,TRUE); - } - if (rc == RTEMS_SUCCESSFUL) { - /* - * set up ports - * LINE PAR DIR DAT - * ----------------------- - * MOSI 1 1 x - * MISO 1 1 x - * CLK 1 1 x - */ - - /* set Port B Pin Assignment Register... */ - m8xx.pbpar = - m8xx.pbpar - | M8xx_PB_SPI_MISO_MSK - | M8xx_PB_SPI_MOSI_MSK - | M8xx_PB_SPI_CLK_MSK; - - /* set Port B Data Direction Register... */ - m8xx.pbdir = - m8xx.pbdir - | M8xx_PB_SPI_MISO_MSK - | M8xx_PB_SPI_MOSI_MSK - | M8xx_PB_SPI_CLK_MSK; - } - /* - * mark, that we have initialized - */ - if (rc == RTEMS_SUCCESSFUL) { - softc_ptr->initialized = TRUE; - } -#if defined(DEBUG) - printk("... exit OK\r\n"); -#endif - return rc; -} - - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static int m8xx_spi_read_write_bytes -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| transmit/receive some bytes from SPI device | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh, /* bus specifier structure */ - unsigned char *rbuf, /* buffer to store bytes */ - const unsigned char *tbuf, /* buffer to send bytes */ - int len /* number of bytes to transceive */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| number of bytes received or (negative) error code | -\*=========================================================================*/ -{ - m8xx_spi_softc_t *softc_ptr = &(((m8xx_spi_desc_t *)(bh))->softc); - rtems_status_code rc = RTEMS_SUCCESSFUL; - int bc = 0; - -#if defined(DEBUG) - printk("m8xx_spi_read_write_bytes called... "); -#endif - - /* - * prepare RxBD - */ - if (rc == RTEMS_SUCCESSFUL) { - if (rbuf == NULL) { - /* - * no Tx buffer: receive to dummy buffer - */ - m8xx.spip.mrblr = sizeof(m8xx_spi_dummy_rxbuf); - softc_ptr->rx_bd->buffer = m8xx_spi_dummy_rxbuf; - softc_ptr->rx_bd->length = 0; - softc_ptr->rx_bd->status = (M8xx_BD_EMPTY | M8xx_BD_WRAP | - M8xx_BD_CONTINUOUS); - } - else { - m8xx.spip.mrblr = len; - softc_ptr->rx_bd->buffer = rbuf; - softc_ptr->rx_bd->length = 0; - softc_ptr->rx_bd->status = (M8xx_BD_EMPTY | M8xx_BD_WRAP); - } - } - /* - * prepare TxBD - */ - if (rc == RTEMS_SUCCESSFUL) { - if (tbuf == NULL) { - /* - * no Tx buffer: transmit from dummy buffer - */ - softc_ptr->tx_bd->buffer = m8xx_spi_dummy_rxbuf; - softc_ptr->tx_bd->length = len; - softc_ptr->tx_bd->status = (M8xx_BD_READY | M8xx_BD_WRAP | - M8xx_BD_CONTINUOUS); - } - else { - softc_ptr->tx_bd->buffer = (char *)tbuf; - softc_ptr->tx_bd->length = len; - softc_ptr->tx_bd->status = (M8xx_BD_READY | M8xx_BD_WRAP); - } - } - - if (rc == RTEMS_SUCCESSFUL) { - /* - * set START command - */ - m8xx.spcom = M8xx_SPCOM_STR; - /* - * wait for SPI to finish - */ - rc = m8xx_spi_wait(softc_ptr); - } -#if defined(DEBUG) - printk("... exit OK, rc=%d\r\n",bc); -#endif - return (rc == RTEMS_SUCCESSFUL) ? bc : -rc; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -int m8xx_spi_read_bytes -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| receive some bytes from SPI device | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh, /* bus specifier structure */ - unsigned char *buf, /* buffer to store bytes */ - int len /* number of bytes to receive */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| number of bytes received or (negative) error code | -\*=========================================================================*/ -{ - return m8xx_spi_read_write_bytes(bh,buf,NULL,len); -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -int m8xx_spi_write_bytes -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| send some bytes to SPI device | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh, /* bus specifier structure */ - unsigned char *buf, /* buffer to send */ - int len /* number of bytes to send */ - -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| number of bytes sent or (negative) error code | -\*=========================================================================*/ -{ - return m8xx_spi_read_write_bytes(bh,NULL,buf,len); -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -rtems_status_code m8xx_spi_set_tfr_mode -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| set SPI to desired baudrate/clock mode/character mode | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh, /* bus specifier structure */ - const rtems_libi2c_tfr_mode_t *tfr_mode /* transfer mode info */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| rtems_status_code | -\*=========================================================================*/ -{ - m8xx_spi_softc_t *softc_ptr = &(((m8xx_spi_desc_t *)(bh))->softc); - uint32_t spimode_baud; - uint16_t spimode; - rtems_status_code rc = RTEMS_SUCCESSFUL; - /* - * FIXME: set proper mode - */ - if (rc == RTEMS_SUCCESSFUL) { - rc = m8xx_spi_baud_to_mode(tfr_mode->baudrate,&spimode_baud); - } - if (rc == RTEMS_SUCCESSFUL) { - rc = m8xx_spi_char_mode(softc_ptr, - tfr_mode->bits_per_char, - tfr_mode->lsb_first, - &spimode); - } - if (rc == RTEMS_SUCCESSFUL) { - spimode |= spimode_baud; - spimode |= M8xx_SPMODE_MASTER; /* set master mode */ - if (!tfr_mode->lsb_first) { - spimode |= M8xx_SPMODE_REV; - } - if (tfr_mode->clock_inv) { - spimode |= M8xx_SPMODE_CI; - } - if (tfr_mode->clock_phs) { - spimode |= M8xx_SPMODE_CP; - } - } - - if (rc == RTEMS_SUCCESSFUL) { - /* - * disable SPI - */ - m8xx.spmode &= ~M8xx_SPMODE_EN; - /* - * set new mode and reenable SPI - */ - m8xx.spmode = spimode | M8xx_SPMODE_EN; - } - return rc; -} - - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -int m8xx_spi_ioctl -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| perform selected ioctl function for SPI | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh, /* bus specifier structure */ - int cmd, /* ioctl command code */ - void *arg /* additional argument array */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| rtems_status_code | -\*=========================================================================*/ -{ - int ret_val = -1; - - switch(cmd) { - case RTEMS_LIBI2C_IOCTL_SET_TFRMODE: - ret_val = - -m8xx_spi_set_tfr_mode(bh, - (const rtems_libi2c_tfr_mode_t *)arg); - break; - case RTEMS_LIBI2C_IOCTL_READ_WRITE: - ret_val = - m8xx_spi_read_write_bytes(bh, - ((rtems_libi2c_read_write_t *)arg)->rd_buf, - ((rtems_libi2c_read_write_t *)arg)->wr_buf, - ((rtems_libi2c_read_write_t *)arg)->byte_cnt); - break; - default: - ret_val = -RTEMS_NOT_DEFINED; - break; - } - return ret_val; -} - -/*=========================================================================*\ -| Board-specific adaptation functions | -\*=========================================================================*/ - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_status_code bsp_spi_send_start -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| dummy function, SPI has no start condition | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh /* bus specifier structure */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ - return RTEMS_SUCCESSFUL; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_status_code bsp_spi_sel_addr -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| address a slave device on the bus | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh, /* bus specifier structure */ - uint32_t addr, /* address to send on bus */ - int rw /* 0=write,1=read */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| rtems_status_code | -\*=========================================================================*/ -{ -#if defined(PGHPLUS) - pbdat_val = m8xx.pbdat | (PGHPLUS_SPI_PB_DISP4_RS_MSK | - PGHPLUS_SPI_PB_DISP4_CE_MSK | - PGHPLUS_SPI_PB_EEP_CE_MSK); - /* - * select given device - */ - switch(addr) { - case PGHPLUS_SPI_ADDR_EEPROM: - pbdat_val &= ~PGHPLUS_SPI_PB_EEP_CE_MSK; - break; - case PGHPLUS_SPI_ADDR_DISP4_DATA: - pbdat_val = (m8xx.pbdat - & ~(PGHPLUS_PB_SPI_DISP4_CE_MSK | - PGHPLUS_PB_SPI_DISP4_RS_MSK)); - break; - case PGHPLUS_SPI_ADDR_DISP4_CTRL: - pbdat_val = (m8xx.pbdat - & ~(PGHPLUS_PB_SPI_DISP4_CE_MSK) - | PGHPLUS_PB_SPI_DISP4_RS_MSK); - break; - default: - return RTEMS_INVALID_NUMBER; - } - m8xx_pbdat = pbdat_val -#endif /* PGHPLUS */ - return RTEMS_SUCCESSFUL; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_status_code bsp_spi_send_stop -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| deselect SPI | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - rtems_libi2c_bus_t *bh /* bus specifier structure */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ -#if defined(DEBUG) - printk("bsp_spi_send_stop called... "); -#endif - m8xx.pbdat = (m8xx.pbdat - | PGHPLUS_PB_SPI_DISP4_CE_MSK - | PGHPLUS_PB_SPI_EEP_CE_MSK); -#if defined(DEBUG) - printk("... exit OK\r\n"); -#endif - return RTEMS_SUCCESSFUL; -} - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -static rtems_status_code bsp_spi_init -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| do board specific init: | -| - initialize pins for addressing | -| - register further drivers | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - int spi_busno -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| o = ok or error code | -\*=========================================================================*/ -{ - int ret_code; - -#if defined(DEBUG) - printk("bsp_spi_init called... "); -#endif - - /* - * init port pins used to address/select SPI devices - */ - - /* - * set up ports - * LINE PAR DIR DAT - * ----------------------- - * EEP_CE 0 1 act-high - * DISP4_CS 0 1 act-high - * DISP4_RS 0 1 active - */ - - /* set Port B Pin Assignment Register... */ - m8xx.pbpar = - (m8xx.pbpar - & ~(PGHPLUS_PB_SPI_EEP_CE_MSK - | PGHPLUS_PB_SPI_DISP4_CE_MSK - | PGHPLUS_PB_SPI_DISP4_RS_MSK)); - - /* set Port B Data Direction Register... */ - m8xx.pbdir = - m8xx.pbdir - | PGHPLUS_PB_SPI_EEP_CE_MSK - | PGHPLUS_PB_SPI_DISP4_CE_MSK - | PGHPLUS_PB_SPI_DISP4_RS_MSK; - - /* set Port B Data Register to inactive CE state */ - m8xx.pbdat = - m8xx.pbdat - | PGHPLUS_PB_SPI_DISP4_CE_MSK - | PGHPLUS_PB_SPI_DISP4_RS_MSK; - - /* - * register devices - */ - ret_code = rtems_libi2c_register_drv("disp", - disp_hcms29xx_driver_descriptor, - spi_busno,PGHPLUS_SPI_ADDR_DISP4); - if (ret_code < 0) { - return -ret_code; - } - -#if defined(DEBUG) - printk("... exit OK\r\n"); -#endif - return RTEMS_SUCCESSFUL; -} - -/*=========================================================================*\ -| list of handlers | -\*=========================================================================*/ - -rtems_libi2c_bus_ops_t bsp_spi_ops = { - init: m8xx_spi_init, - send_start: bsp_spi_send_start, - send_stop: bsp_spi_send_stop, - send_addr: bsp_spi_sel_addr, - read_bytes: m8xx_spi_read_bytes, - write_bytes: m8xx_spi_write_bytes, - ioctl: m8xx_spi_ioctl -}; - -static m8xx_spi_desc_t bsp_spi_bus_desc = { - {/* public fields */ - ops: &bsp_spi_ops, - size: sizeof(bsp_spi_bus_desc) - }, - { /* our private fields */ - initialized: FALSE - } -}; - -/*=========================================================================*\ -| initialization | -\*=========================================================================*/ - -/*=========================================================================*\ -| Function: | -\*-------------------------------------------------------------------------*/ -rtems_status_code bsp_register_spi -( -/*-------------------------------------------------------------------------*\ -| Purpose: | -| register SPI bus and devices | -+---------------------------------------------------------------------------+ -| Input Parameters: | -\*-------------------------------------------------------------------------*/ - void /* */ -) -/*-------------------------------------------------------------------------*\ -| Return Value: | -| 0 or error code | -\*=========================================================================*/ -{ - int ret_code; - int spi_busno; - - /* - * init I2C library (if not already done) - */ - rtems_libi2c_initialize (); - - - /* - * register SPI bus - */ - ret_code = rtems_libi2c_register_bus("/dev/spi", - &(bsp_spi_bus_desc.bus_desc)); - if (ret_code < 0) { - return -ret_code; - } - spi_busno = ret_code; - - bsp_spi_init(spi_busno); - /* - * FIXME: further drivers, when available - */ - return RTEMS_SUCCESSFUL; -} - - -- cgit v1.2.3