|  | /* | 
|  | * Copyright (c) 2001 Navin Boppuri / Prashant Patel | 
|  | *	<nboppuri@trinetcommunication.com>, | 
|  | *	<pmpatel@trinetcommunication.com> | 
|  | * Copyright (c) 2001 Gerd Mennchen <Gerd.Mennchen@icn.siemens.de> | 
|  | * Copyright (c) 2001 Wolfgang Denk, DENX Software Engineering, <wd@denx.de>. | 
|  | * | 
|  | * See file CREDITS for list of people who contributed to this | 
|  | * project. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or | 
|  | * modify it under the terms of the GNU General Public License as | 
|  | * published by the Free Software Foundation; either version 2 of | 
|  | * the License, or (at your option) any later version. | 
|  | * | 
|  | * This program is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | * GNU General Public License for more details. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * along with this program; if not, write to the Free Software | 
|  | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | 
|  | * MA 02111-1307 USA | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * MPC8xx CPM SPI interface. | 
|  | * | 
|  | * Parts of this code are probably not portable and/or specific to | 
|  | * the board which I used for the tests. Please send fixes/complaints | 
|  | * to wd@denx.de | 
|  | * | 
|  | */ | 
|  |  | 
|  | #include <common.h> | 
|  | #include <mpc8xx.h> | 
|  | #include <commproc.h> | 
|  | #include <linux/ctype.h> | 
|  | #include <malloc.h> | 
|  | #include <post.h> | 
|  | #include <serial.h> | 
|  |  | 
|  | #if (defined(CONFIG_SPI)) || (CONFIG_POST & CONFIG_SYS_POST_SPI) | 
|  |  | 
|  | /* Warning: | 
|  | * You cannot enable DEBUG for early system initalization, i. e. when | 
|  | * this driver is used to read environment parameters like "baudrate" | 
|  | * from EEPROM which are used to initialize the serial port which is | 
|  | * needed to print the debug messages... | 
|  | */ | 
|  | #undef	DEBUG | 
|  |  | 
|  | #define SPI_EEPROM_WREN		0x06 | 
|  | #define SPI_EEPROM_RDSR		0x05 | 
|  | #define SPI_EEPROM_READ		0x03 | 
|  | #define SPI_EEPROM_WRITE	0x02 | 
|  |  | 
|  | /* --------------------------------------------------------------- | 
|  | * Offset for initial SPI buffers in DPRAM: | 
|  | * We need a 520 byte scratch DPRAM area to use at an early stage. | 
|  | * It is used between the two initialization calls (spi_init_f() | 
|  | * and spi_init_r()). | 
|  | * The value 0xb00 makes it far enough from the start of the data | 
|  | * area (as well as from the stack pointer). | 
|  | * --------------------------------------------------------------- */ | 
|  | #ifndef	CONFIG_SYS_SPI_INIT_OFFSET | 
|  | #define	CONFIG_SYS_SPI_INIT_OFFSET	0xB00 | 
|  | #endif | 
|  |  | 
|  | #ifdef	DEBUG | 
|  |  | 
|  | #define	DPRINT(a)	printf a; | 
|  | /* ----------------------------------------------- | 
|  | * Helper functions to peek into tx and rx buffers | 
|  | * ----------------------------------------------- */ | 
|  | static const char * const hex_digit = "0123456789ABCDEF"; | 
|  |  | 
|  | static char quickhex (int i) | 
|  | { | 
|  | return hex_digit[i]; | 
|  | } | 
|  |  | 
|  | static void memdump (void *pv, int num) | 
|  | { | 
|  | int i; | 
|  | unsigned char *pc = (unsigned char *) pv; | 
|  |  | 
|  | for (i = 0; i < num; i++) | 
|  | printf ("%c%c ", quickhex (pc[i] >> 4), quickhex (pc[i] & 0x0f)); | 
|  | printf ("\t"); | 
|  | for (i = 0; i < num; i++) | 
|  | printf ("%c", isprint (pc[i]) ? pc[i] : '.'); | 
|  | printf ("\n"); | 
|  | } | 
|  | #else	/* !DEBUG */ | 
|  |  | 
|  | #define	DPRINT(a) | 
|  |  | 
|  | #endif	/* DEBUG */ | 
|  |  | 
|  | /* ------------------- | 
|  | * Function prototypes | 
|  | * ------------------- */ | 
|  | void spi_init (void); | 
|  |  | 
|  | ssize_t spi_read (uchar *, int, uchar *, int); | 
|  | ssize_t spi_write (uchar *, int, uchar *, int); | 
|  | ssize_t spi_xfer (size_t); | 
|  |  | 
|  | /* ------------------- | 
|  | * Variables | 
|  | * ------------------- */ | 
|  |  | 
|  | #define MAX_BUFFER	0x104 | 
|  |  | 
|  | /* ---------------------------------------------------------------------- | 
|  | * Initially we place the RX and TX buffers at a fixed location in DPRAM! | 
|  | * ---------------------------------------------------------------------- */ | 
|  | static uchar *rxbuf = | 
|  | (uchar *)&((cpm8xx_t *)&((immap_t *)CONFIG_SYS_IMMR)->im_cpm)->cp_dpmem | 
|  | [CONFIG_SYS_SPI_INIT_OFFSET]; | 
|  | static uchar *txbuf = | 
|  | (uchar *)&((cpm8xx_t *)&((immap_t *)CONFIG_SYS_IMMR)->im_cpm)->cp_dpmem | 
|  | [CONFIG_SYS_SPI_INIT_OFFSET+MAX_BUFFER]; | 
|  |  | 
|  | /* ************************************************************************** | 
|  | * | 
|  | *  Function:    spi_init_f | 
|  | * | 
|  | *  Description: Init SPI-Controller (ROM part) | 
|  | * | 
|  | *  return:      --- | 
|  | * | 
|  | * *********************************************************************** */ | 
|  | void spi_init_f (void) | 
|  | { | 
|  | unsigned int dpaddr; | 
|  |  | 
|  | volatile spi_t *spi; | 
|  | volatile immap_t *immr; | 
|  | volatile cpic8xx_t *cpi; | 
|  | volatile cpm8xx_t *cp; | 
|  | volatile iop8xx_t *iop; | 
|  | volatile cbd_t *tbdf, *rbdf; | 
|  |  | 
|  | immr = (immap_t *)  CONFIG_SYS_IMMR; | 
|  | cpi  = (cpic8xx_t *)&immr->im_cpic; | 
|  | iop  = (iop8xx_t *) &immr->im_ioport; | 
|  | cp   = (cpm8xx_t *) &immr->im_cpm; | 
|  |  | 
|  | #ifdef CONFIG_SYS_SPI_UCODE_PATCH | 
|  | spi  = (spi_t *)&cp->cp_dpmem[spi->spi_rpbase]; | 
|  | #else | 
|  | spi  = (spi_t *)&cp->cp_dparam[PROFF_SPI]; | 
|  | /* Disable relocation */ | 
|  | spi->spi_rpbase = 0; | 
|  | #endif | 
|  |  | 
|  | /* 1 */ | 
|  | /* ------------------------------------------------ | 
|  | * Initialize Port B SPI pins -> page 34-8 MPC860UM | 
|  | * (we are only in Master Mode !) | 
|  | * ------------------------------------------------ */ | 
|  |  | 
|  | /* -------------------------------------------- | 
|  | * GPIO or per. Function | 
|  | * PBPAR[28] = 1 [0x00000008] -> PERI: (SPIMISO) | 
|  | * PBPAR[29] = 1 [0x00000004] -> PERI: (SPIMOSI) | 
|  | * PBPAR[30] = 1 [0x00000002] -> PERI: (SPICLK) | 
|  | * PBPAR[31] = 0 [0x00000001] -> GPIO: (CS for PCUE/CCM-EEPROM) | 
|  | * -------------------------------------------- */ | 
|  | cp->cp_pbpar |=  0x0000000E;	/* set  bits	*/ | 
|  | cp->cp_pbpar &= ~0x00000001;	/* reset bit	*/ | 
|  |  | 
|  | /* ---------------------------------------------- | 
|  | * In/Out or per. Function 0/1 | 
|  | * PBDIR[28] = 1 [0x00000008] -> PERI1: SPIMISO | 
|  | * PBDIR[29] = 1 [0x00000004] -> PERI1: SPIMOSI | 
|  | * PBDIR[30] = 1 [0x00000002] -> PERI1: SPICLK | 
|  | * PBDIR[31] = 1 [0x00000001] -> GPIO OUT: CS for PCUE/CCM-EEPROM | 
|  | * ---------------------------------------------- */ | 
|  | cp->cp_pbdir |= 0x0000000F; | 
|  |  | 
|  | /* ---------------------------------------------- | 
|  | * open drain or active output | 
|  | * PBODR[28] = 1 [0x00000008] -> open drain: SPIMISO | 
|  | * PBODR[29] = 0 [0x00000004] -> active output SPIMOSI | 
|  | * PBODR[30] = 0 [0x00000002] -> active output: SPICLK | 
|  | * PBODR[31] = 0 [0x00000001] -> active output: GPIO OUT: CS for PCUE/CCM | 
|  | * ---------------------------------------------- */ | 
|  |  | 
|  | cp->cp_pbodr |=  0x00000008; | 
|  | cp->cp_pbodr &= ~0x00000007; | 
|  |  | 
|  | /* Initialize the parameter ram. | 
|  | * We need to make sure many things are initialized to zero | 
|  | */ | 
|  | spi->spi_rstate	= 0; | 
|  | spi->spi_rdp	= 0; | 
|  | spi->spi_rbptr	= 0; | 
|  | spi->spi_rbc	= 0; | 
|  | spi->spi_rxtmp	= 0; | 
|  | spi->spi_tstate	= 0; | 
|  | spi->spi_tdp	= 0; | 
|  | spi->spi_tbptr	= 0; | 
|  | spi->spi_tbc	= 0; | 
|  | spi->spi_txtmp	= 0; | 
|  |  | 
|  | /* Allocate space for one transmit and one receive buffer | 
|  | * descriptor in the DP ram | 
|  | */ | 
|  | #ifdef CONFIG_SYS_ALLOC_DPRAM | 
|  | dpaddr = dpram_alloc_align (sizeof(cbd_t)*2, 8); | 
|  | #else | 
|  | dpaddr = CPM_SPI_BASE; | 
|  | #endif | 
|  |  | 
|  | /* 3 */ | 
|  | /* Set up the SPI parameters in the parameter ram */ | 
|  | spi->spi_rbase = dpaddr; | 
|  | spi->spi_tbase = dpaddr + sizeof (cbd_t); | 
|  |  | 
|  | /***********IMPORTANT******************/ | 
|  |  | 
|  | /* | 
|  | * Setting transmit and receive buffer descriptor pointers | 
|  | * initially to rbase and tbase. Only the microcode patches | 
|  | * documentation talks about initializing this pointer. This | 
|  | * is missing from the sample I2C driver. If you dont | 
|  | * initialize these pointers, the kernel hangs. | 
|  | */ | 
|  | spi->spi_rbptr = spi->spi_rbase; | 
|  | spi->spi_tbptr = spi->spi_tbase; | 
|  |  | 
|  | /* 4 */ | 
|  | #ifdef CONFIG_SYS_SPI_UCODE_PATCH | 
|  | /* | 
|  | *  Initialize required parameters if using microcode patch. | 
|  | */ | 
|  | spi->spi_rstate = 0; | 
|  | spi->spi_tstate = 0; | 
|  | #else | 
|  | /* Init SPI Tx + Rx Parameters */ | 
|  | while (cp->cp_cpcr & CPM_CR_FLG) | 
|  | ; | 
|  | cp->cp_cpcr = mk_cr_cmd(CPM_CR_CH_SPI, CPM_CR_INIT_TRX) | CPM_CR_FLG; | 
|  | while (cp->cp_cpcr & CPM_CR_FLG) | 
|  | ; | 
|  | #endif	/* CONFIG_SYS_SPI_UCODE_PATCH */ | 
|  |  | 
|  | /* 5 */ | 
|  | /* Set SDMA configuration register */ | 
|  | immr->im_siu_conf.sc_sdcr = 0x0001; | 
|  |  | 
|  | /* 6 */ | 
|  | /* Set to big endian. */ | 
|  | spi->spi_tfcr = SMC_EB; | 
|  | spi->spi_rfcr = SMC_EB; | 
|  |  | 
|  | /* 7 */ | 
|  | /* Set maximum receive size. */ | 
|  | spi->spi_mrblr = MAX_BUFFER; | 
|  |  | 
|  | /* 8 + 9 */ | 
|  | /* tx and rx buffer descriptors */ | 
|  | tbdf = (cbd_t *) & cp->cp_dpmem[spi->spi_tbase]; | 
|  | rbdf = (cbd_t *) & cp->cp_dpmem[spi->spi_rbase]; | 
|  |  | 
|  | tbdf->cbd_sc &= ~BD_SC_READY; | 
|  | rbdf->cbd_sc &= ~BD_SC_EMPTY; | 
|  |  | 
|  | /* Set the bd's rx and tx buffer address pointers */ | 
|  | rbdf->cbd_bufaddr = (ulong) rxbuf; | 
|  | tbdf->cbd_bufaddr = (ulong) txbuf; | 
|  |  | 
|  | /* 10 + 11 */ | 
|  | cp->cp_spim = 0;			/* Mask  all SPI events */ | 
|  | cp->cp_spie = SPI_EMASK;		/* Clear all SPI events	*/ | 
|  |  | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* ************************************************************************** | 
|  | * | 
|  | *  Function:    spi_init_r | 
|  | * | 
|  | *  Description: Init SPI-Controller (RAM part) - | 
|  | *		 The malloc engine is ready and we can move our buffers to | 
|  | *		 normal RAM | 
|  | * | 
|  | *  return:      --- | 
|  | * | 
|  | * *********************************************************************** */ | 
|  | void spi_init_r (void) | 
|  | { | 
|  | volatile cpm8xx_t *cp; | 
|  | volatile spi_t *spi; | 
|  | volatile immap_t *immr; | 
|  | volatile cbd_t *tbdf, *rbdf; | 
|  |  | 
|  | immr = (immap_t *)  CONFIG_SYS_IMMR; | 
|  | cp   = (cpm8xx_t *) &immr->im_cpm; | 
|  |  | 
|  | #ifdef CONFIG_SYS_SPI_UCODE_PATCH | 
|  | spi  = (spi_t *)&cp->cp_dpmem[spi->spi_rpbase]; | 
|  | #else | 
|  | spi  = (spi_t *)&cp->cp_dparam[PROFF_SPI]; | 
|  | /* Disable relocation */ | 
|  | spi->spi_rpbase = 0; | 
|  | #endif | 
|  |  | 
|  | /* tx and rx buffer descriptors */ | 
|  | tbdf = (cbd_t *) & cp->cp_dpmem[spi->spi_tbase]; | 
|  | rbdf = (cbd_t *) & cp->cp_dpmem[spi->spi_rbase]; | 
|  |  | 
|  | /* Allocate memory for RX and TX buffers */ | 
|  | rxbuf = (uchar *) malloc (MAX_BUFFER); | 
|  | txbuf = (uchar *) malloc (MAX_BUFFER); | 
|  |  | 
|  | rbdf->cbd_bufaddr = (ulong) rxbuf; | 
|  | tbdf->cbd_bufaddr = (ulong) txbuf; | 
|  |  | 
|  | return; | 
|  | } | 
|  |  | 
|  | /**************************************************************************** | 
|  | *  Function:    spi_write | 
|  | **************************************************************************** */ | 
|  | ssize_t spi_write (uchar *addr, int alen, uchar *buffer, int len) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | memset(rxbuf, 0, MAX_BUFFER); | 
|  | memset(txbuf, 0, MAX_BUFFER); | 
|  | *txbuf = SPI_EEPROM_WREN;		/* write enable		*/ | 
|  | spi_xfer(1); | 
|  | memcpy(txbuf, addr, alen); | 
|  | *txbuf = SPI_EEPROM_WRITE;		/* WRITE memory array	*/ | 
|  | memcpy(alen + txbuf, buffer, len); | 
|  | spi_xfer(alen + len); | 
|  | /* ignore received data	*/ | 
|  | for (i = 0; i < 1000; i++) { | 
|  | *txbuf = SPI_EEPROM_RDSR;	/* read status		*/ | 
|  | txbuf[1] = 0; | 
|  | spi_xfer(2); | 
|  | if (!(rxbuf[1] & 1)) { | 
|  | break; | 
|  | } | 
|  | udelay(1000); | 
|  | } | 
|  | if (i >= 1000) { | 
|  | printf ("*** spi_write: Time out while writing!\n"); | 
|  | } | 
|  |  | 
|  | return len; | 
|  | } | 
|  |  | 
|  | /**************************************************************************** | 
|  | *  Function:    spi_read | 
|  | **************************************************************************** */ | 
|  | ssize_t spi_read (uchar *addr, int alen, uchar *buffer, int len) | 
|  | { | 
|  | memset(rxbuf, 0, MAX_BUFFER); | 
|  | memset(txbuf, 0, MAX_BUFFER); | 
|  | memcpy(txbuf, addr, alen); | 
|  | *txbuf = SPI_EEPROM_READ;		/* READ memory array	*/ | 
|  |  | 
|  | /* | 
|  | * There is a bug in 860T (?) that cuts the last byte of input | 
|  | * if we're reading into DPRAM. The solution we choose here is | 
|  | * to always read len+1 bytes (we have one extra byte at the | 
|  | * end of the buffer). | 
|  | */ | 
|  | spi_xfer(alen + len + 1); | 
|  | memcpy(buffer, alen + rxbuf, len); | 
|  |  | 
|  | return len; | 
|  | } | 
|  |  | 
|  | /**************************************************************************** | 
|  | *  Function:    spi_xfer | 
|  | **************************************************************************** */ | 
|  | ssize_t spi_xfer (size_t count) | 
|  | { | 
|  | volatile immap_t *immr; | 
|  | volatile cpm8xx_t *cp; | 
|  | volatile spi_t *spi; | 
|  | cbd_t *tbdf, *rbdf; | 
|  | ushort loop; | 
|  | int tm; | 
|  |  | 
|  | DPRINT (("*** spi_xfer entered ***\n")); | 
|  |  | 
|  | immr = (immap_t *) CONFIG_SYS_IMMR; | 
|  | cp   = (cpm8xx_t *) &immr->im_cpm; | 
|  |  | 
|  | #ifdef CONFIG_SYS_SPI_UCODE_PATCH | 
|  | spi  = (spi_t *)&cp->cp_dpmem[spi->spi_rpbase]; | 
|  | #else | 
|  | spi  = (spi_t *)&cp->cp_dparam[PROFF_SPI]; | 
|  | /* Disable relocation */ | 
|  | spi->spi_rpbase = 0; | 
|  | #endif | 
|  |  | 
|  | tbdf = (cbd_t *) & cp->cp_dpmem[spi->spi_tbase]; | 
|  | rbdf = (cbd_t *) & cp->cp_dpmem[spi->spi_rbase]; | 
|  |  | 
|  | /* Set CS for device */ | 
|  | cp->cp_pbdat &= ~0x0001; | 
|  |  | 
|  | /* Setting tx bd status and data length */ | 
|  | tbdf->cbd_sc  = BD_SC_READY | BD_SC_LAST | BD_SC_WRAP; | 
|  | tbdf->cbd_datlen = count; | 
|  |  | 
|  | DPRINT (("*** spi_xfer: Bytes to be xferred: %d ***\n", | 
|  | tbdf->cbd_datlen)); | 
|  |  | 
|  | /* Setting rx bd status and data length */ | 
|  | rbdf->cbd_sc = BD_SC_EMPTY | BD_SC_WRAP; | 
|  | rbdf->cbd_datlen = 0;	 /* rx length has no significance */ | 
|  |  | 
|  | loop = cp->cp_spmode & SPMODE_LOOP; | 
|  | cp->cp_spmode = /*SPMODE_DIV16	|*/	/* BRG/16 mode not used here */ | 
|  | loop		| | 
|  | SPMODE_REV	| | 
|  | SPMODE_MSTR	| | 
|  | SPMODE_EN	| | 
|  | SPMODE_LEN(8)	|	/* 8 Bits per char */ | 
|  | SPMODE_PM(0x8) ;	/* medium speed */ | 
|  | cp->cp_spim = 0;			/* Mask  all SPI events */ | 
|  | cp->cp_spie = SPI_EMASK;		/* Clear all SPI events	*/ | 
|  |  | 
|  | /* start spi transfer */ | 
|  | DPRINT (("*** spi_xfer: Performing transfer ...\n")); | 
|  | cp->cp_spcom |= SPI_STR;		/* Start transmit */ | 
|  |  | 
|  | /* -------------------------------- | 
|  | * Wait for SPI transmit to get out | 
|  | * or time out (1 second = 1000 ms) | 
|  | * -------------------------------- */ | 
|  | for (tm=0; tm<1000; ++tm) { | 
|  | if (cp->cp_spie & SPI_TXB) {	/* Tx Buffer Empty */ | 
|  | DPRINT (("*** spi_xfer: Tx buffer empty\n")); | 
|  | break; | 
|  | } | 
|  | if ((tbdf->cbd_sc & BD_SC_READY) == 0) { | 
|  | DPRINT (("*** spi_xfer: Tx BD done\n")); | 
|  | break; | 
|  | } | 
|  | udelay (1000); | 
|  | } | 
|  | if (tm >= 1000) { | 
|  | printf ("*** spi_xfer: Time out while xferring to/from SPI!\n"); | 
|  | } | 
|  | DPRINT (("*** spi_xfer: ... transfer ended\n")); | 
|  |  | 
|  | #ifdef	DEBUG | 
|  | printf ("\nspi_xfer: txbuf after xfer\n"); | 
|  | memdump ((void *) txbuf, 16);	/* dump of txbuf before transmit */ | 
|  | printf ("spi_xfer: rxbuf after xfer\n"); | 
|  | memdump ((void *) rxbuf, 16);	/* dump of rxbuf after transmit */ | 
|  | printf ("\n"); | 
|  | #endif | 
|  |  | 
|  | /* Clear CS for device */ | 
|  | cp->cp_pbdat |= 0x0001; | 
|  |  | 
|  | return count; | 
|  | } | 
|  | #endif	/* CONFIG_SPI || (CONFIG_POST & CONFIG_SYS_POST_SPI) */ | 
|  |  | 
|  | /* | 
|  | * SPI test | 
|  | * | 
|  | * The Serial Peripheral Interface (SPI) is tested in the local loopback mode. | 
|  | * The interface is configured accordingly and several packets | 
|  | * are transfered. The configurable test parameters are: | 
|  | *   TEST_MIN_LENGTH - minimum size of packet to transfer | 
|  | *   TEST_MAX_LENGTH - maximum size of packet to transfer | 
|  | *   TEST_NUM - number of tests | 
|  | */ | 
|  |  | 
|  | #if CONFIG_POST & CONFIG_SYS_POST_SPI | 
|  |  | 
|  | #define TEST_MIN_LENGTH		1 | 
|  | #define TEST_MAX_LENGTH		MAX_BUFFER | 
|  | #define TEST_NUM		1 | 
|  |  | 
|  | static void packet_fill (char * packet, int length) | 
|  | { | 
|  | char c = (char) length; | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < length; i++) | 
|  | { | 
|  | packet[i] = c++; | 
|  | } | 
|  | } | 
|  |  | 
|  | static int packet_check (char * packet, int length) | 
|  | { | 
|  | char c = (char) length; | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < length; i++) { | 
|  | if (packet[i] != c++) return -1; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int spi_post_test (int flags) | 
|  | { | 
|  | int res = -1; | 
|  | volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR; | 
|  | volatile cpm8xx_t *cp = (cpm8xx_t *) & immr->im_cpm; | 
|  | int i; | 
|  | int l; | 
|  |  | 
|  | spi_init_f (); | 
|  | spi_init_r (); | 
|  |  | 
|  | cp->cp_spmode |= SPMODE_LOOP; | 
|  |  | 
|  | for (i = 0; i < TEST_NUM; i++) { | 
|  | for (l = TEST_MIN_LENGTH; l <= TEST_MAX_LENGTH; l += 8) { | 
|  | packet_fill ((char *)txbuf, l); | 
|  |  | 
|  | spi_xfer (l); | 
|  |  | 
|  | if (packet_check ((char *)rxbuf, l) < 0) { | 
|  | goto Done; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | res = 0; | 
|  |  | 
|  | Done: | 
|  |  | 
|  | cp->cp_spmode &= ~SPMODE_LOOP; | 
|  |  | 
|  | /* | 
|  | * SCC2 parameter RAM space overlaps | 
|  | * the SPI parameter RAM space. So we need to restore | 
|  | * the SCC2 configuration if it is used by UART. | 
|  | */ | 
|  |  | 
|  | #if !defined(CONFIG_8xx_CONS_NONE) | 
|  | serial_reinit_all (); | 
|  | #endif | 
|  |  | 
|  | if (res != 0) { | 
|  | post_log ("SPI test failed\n"); | 
|  | } | 
|  |  | 
|  | return res; | 
|  | } | 
|  | #endif	/* CONFIG_POST & CONFIG_SYS_POST_SPI */ |