mirror of
https://github.com/xcat2/xNBA.git
synced 2024-12-15 15:51:44 +00:00
166 lines
4.4 KiB
C
166 lines
4.4 KiB
C
|
/*
|
||
|
* Copyright (C) 2006 Michael Brown <mbrown@fensystems.co.uk>.
|
||
|
*
|
||
|
* 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 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||
|
*/
|
||
|
|
||
|
#include <stddef.h>
|
||
|
#include <stdint.h>
|
||
|
#include <string.h>
|
||
|
#include <errno.h>
|
||
|
#include <assert.h>
|
||
|
#include <timer.h>
|
||
|
#include <gpxe/bitbash.h>
|
||
|
#include <gpxe/spi.h>
|
||
|
|
||
|
/** @file
|
||
|
*
|
||
|
* SPI bit-bashing interface
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
/** Delay between SCLK changes and around SS changes */
|
||
|
static void spi_delay ( void ) {
|
||
|
udelay ( SPI_UDELAY );
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Select/deselect slave
|
||
|
*
|
||
|
* @v spi SPI bit-bashing interface
|
||
|
* @v slave Slave number
|
||
|
* @v state Slave select state
|
||
|
*
|
||
|
* @c state must be set to zero to select the specified slave, or to
|
||
|
* @c SPI_MODE_SSPOL to deselect the slave.
|
||
|
*/
|
||
|
static void spi_bit_set_slave_select ( struct spi_bit_basher *spibit,
|
||
|
unsigned int slave,
|
||
|
unsigned int state ) {
|
||
|
struct bit_basher *basher = &spibit->basher;
|
||
|
|
||
|
state ^= ( spibit->spi.mode & SPI_MODE_SSPOL );
|
||
|
DBG ( "Setting slave %d select %s\n", slave,
|
||
|
( state ? "high" : "low" ) );
|
||
|
|
||
|
spi_delay();
|
||
|
write_bit ( basher, SPI_BIT_SS ( slave ), state );
|
||
|
spi_delay();
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Select slave
|
||
|
*
|
||
|
* @v spi SPI interface
|
||
|
* @v slave Slave number
|
||
|
*/
|
||
|
static void spi_bit_select_slave ( struct spi_interface *spi,
|
||
|
unsigned int slave ) {
|
||
|
struct spi_bit_basher *spibit
|
||
|
= container_of ( spi, struct spi_bit_basher, spi );
|
||
|
|
||
|
spibit->slave = slave;
|
||
|
spi_bit_set_slave_select ( spibit, slave, 0 );
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Deselect slave
|
||
|
*
|
||
|
* @v spi SPI interface
|
||
|
*/
|
||
|
static void spi_bit_deselect_slave ( struct spi_interface *spi ) {
|
||
|
struct spi_bit_basher *spibit
|
||
|
= container_of ( spi, struct spi_bit_basher, spi );
|
||
|
|
||
|
spi_bit_set_slave_select ( spibit, spibit->slave, SPI_MODE_SSPOL );
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Transfer bits over SPI bit-bashing interface
|
||
|
*
|
||
|
* @v spi SPI interface
|
||
|
* @v data_out TX data buffer (or NULL)
|
||
|
* @v data_in RX data buffer (or NULL)
|
||
|
* @v len Length of transfer (in @b bits)
|
||
|
*
|
||
|
* This issues @c len clock cycles on the SPI bus, shifting out data
|
||
|
* from the @c data_out buffer to the MOSI line and shifting in data
|
||
|
* from the MISO line to the @c data_in buffer. If @c data_out is
|
||
|
* NULL, then the data sent will be all zeroes. If @c data_in is
|
||
|
* NULL, then the incoming data will be discarded.
|
||
|
*/
|
||
|
static void spi_bit_transfer ( struct spi_interface *spi, const void *data_out,
|
||
|
void *data_in, unsigned int len ) {
|
||
|
struct spi_bit_basher *spibit
|
||
|
= container_of ( spi, struct spi_bit_basher, spi );
|
||
|
struct bit_basher *basher = &spibit->basher;
|
||
|
unsigned int sclk = ( ( spi->mode & SPI_MODE_CPOL ) ? 1 : 0 );
|
||
|
unsigned int cpha = ( ( spi->mode & SPI_MODE_CPHA ) ? 1 : 0 );
|
||
|
unsigned int offset;
|
||
|
unsigned int mask;
|
||
|
unsigned int bit;
|
||
|
int step;
|
||
|
|
||
|
DBG ( "Transferring %d bits in mode %x\n", len, spi->mode );
|
||
|
|
||
|
for ( step = ( ( len * 2 ) - 1 ) ; step >= 0 ; step-- ) {
|
||
|
/* Calculate byte offset within data and bit mask */
|
||
|
offset = ( step / 16 );
|
||
|
mask = ( 1 << ( ( step % 16 ) / 2 ) );
|
||
|
|
||
|
/* Shift data in or out */
|
||
|
if ( sclk == cpha ) {
|
||
|
const uint8_t *byte;
|
||
|
|
||
|
/* Shift data out */
|
||
|
if ( data_out ) {
|
||
|
byte = ( data_out + offset );
|
||
|
bit = ( *byte & mask );
|
||
|
} else {
|
||
|
bit = 0;
|
||
|
}
|
||
|
write_bit ( basher, SPI_BIT_MOSI, bit );
|
||
|
} else {
|
||
|
uint8_t *byte;
|
||
|
|
||
|
/* Shift data in */
|
||
|
bit = read_bit ( basher, SPI_BIT_MISO );
|
||
|
if ( data_in ) {
|
||
|
byte = ( data_in + offset );
|
||
|
*byte &= ~mask;
|
||
|
*byte |= ( bit & mask );
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Toggle clock line */
|
||
|
spi_delay();
|
||
|
sclk = ~sclk;
|
||
|
write_bit ( basher, SPI_BIT_SCLK, sclk );
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Initialise SPI bit-bashing interface
|
||
|
*
|
||
|
* @v spibit SPI bit-bashing interface
|
||
|
*/
|
||
|
void init_spi_bit_basher ( struct spi_bit_basher *spibit ) {
|
||
|
assert ( &spibit->basher.read != NULL );
|
||
|
assert ( &spibit->basher.write != NULL );
|
||
|
spibit->spi.select_slave = spi_bit_select_slave;
|
||
|
spibit->spi.deselect_slave = spi_bit_deselect_slave;
|
||
|
spibit->spi.transfer = spi_bit_transfer;
|
||
|
}
|