From patchwork Sun Jan 12 10:27:44 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Geert Uytterhoeven X-Patchwork-Id: 3471021 Return-Path: X-Original-To: patchwork-linux-spi@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.19.201]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 57CB4C02DC for ; Sun, 12 Jan 2014 10:28:08 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 2B07120161 for ; Sun, 12 Jan 2014 10:28:06 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id B31252015E for ; Sun, 12 Jan 2014 10:28:04 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751114AbaALK14 (ORCPT ); Sun, 12 Jan 2014 05:27:56 -0500 Received: from gerard.telenet-ops.be ([195.130.132.48]:45083 "EHLO gerard.telenet-ops.be" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751137AbaALK1z (ORCPT ); Sun, 12 Jan 2014 05:27:55 -0500 Received: from ayla.of.borg ([84.193.72.141]) by gerard.telenet-ops.be with bizsmtp id CyTs1n01932ts5g0HyTsoA; Sun, 12 Jan 2014 11:27:52 +0100 Received: from geert by ayla.of.borg with local (Exim 4.76) (envelope-from ) id 1W2IGm-0000QX-Gu; Sun, 12 Jan 2014 11:27:52 +0100 From: Geert Uytterhoeven To: Mark Brown Cc: linux-spi@vger.kernel.org, linux-sh@vger.kernel.org, Geert Uytterhoeven Subject: [PATCH V2 8/8] spi: rspi: Add support for loopback mode Date: Sun, 12 Jan 2014 11:27:44 +0100 Message-Id: <1389522464-1569-9-git-send-email-geert@linux-m68k.org> X-Mailer: git-send-email 1.7.9.5 In-Reply-To: <1389522464-1569-1-git-send-email-geert@linux-m68k.org> References: <1389522464-1569-1-git-send-email-geert@linux-m68k.org> Sender: linux-spi-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-spi@vger.kernel.org X-Spam-Status: No, score=-7.0 required=5.0 tests=BAYES_00, RCVD_IN_DNSWL_HI, RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP From: Geert Uytterhoeven Add support for specifying loopback mode for RSPI only, based on the SDK reference code. Signed-off-by: Geert Uytterhoeven --- V2: - No changes drivers/spi/spi-rspi.c | 59 +++++++++++++++++++++++++++++++++++++++--------- 1 file changed, 48 insertions(+), 11 deletions(-) diff --git a/drivers/spi/spi-rspi.c b/drivers/spi/spi-rspi.c index 4b25c8617b02..04d512e1e894 100644 --- a/drivers/spi/spi-rspi.c +++ b/drivers/spi/spi-rspi.c @@ -170,8 +170,8 @@ #define SPCMD_CPHA 0x0001 /* Clock Phase Setting */ /* SPBFCR - Buffer Control Register */ -#define SPBFCR_TXRST 0x80 /* Transmit Buffer Data Reset (qspi only) */ -#define SPBFCR_RXRST 0x40 /* Receive Buffer Data Reset (qspi only) */ +#define SPBFCR_TXRST 0x80 /* Transmit Buffer Data Reset */ +#define SPBFCR_RXRST 0x40 /* Receive Buffer Data Reset */ #define SPBFCR_TXTRG_MASK 0x30 /* Transmit Buffer Data Triggering Number */ #define SPBFCR_RXTRG_MASK 0x07 /* Receive Buffer Data Triggering Number */ @@ -188,6 +188,7 @@ struct rspi_data { spinlock_t lock; struct clk *clk; u8 spsr; + u8 sppcr; u8 spdcr; u8 data_width; u16 spcmd; @@ -256,7 +257,7 @@ struct spi_ops { struct spi_transfer *t); int (*receive_pio)(struct rspi_data *rspi, struct spi_message *mesg, struct spi_transfer *t); - + u16 mode_bits; }; /* @@ -317,8 +318,8 @@ static int rspi_set_config_register(const struct rspi_data *rspi, { int spbr; - /* Sets output mode(CMOS) and MOSI signal(from previous transfer) */ - rspi_write8(rspi, 0x00, RSPI_SPPCR); + /* Sets output mode */ + rspi_write8(rspi, rspi->sppcr, RSPI_SPPCR); /* Sets transfer bit rate */ spbr = clk_get_rate(rspi->clk) / (2 * rspi->max_speed_hz) - 1; @@ -369,8 +370,8 @@ static int qspi_set_config_register(const struct rspi_data *rspi, u16 spcmd; int spbr; - /* Sets output mode(CMOS) and MOSI signal(from previous transfer) */ - rspi_write8(rspi, 0x00, RSPI_SPPCR); + /* Sets output mode */ + rspi_write8(rspi, rspi->sppcr, RSPI_SPPCR); /* Sets transfer bit rate */ spbr = clk_get_rate(rspi->clk) / (2 * rspi->max_speed_hz); @@ -413,6 +414,21 @@ static int qspi_set_config_register(const struct rspi_data *rspi, #define set_config_register(spi, n) spi->ops->set_config_register(spi, n) +static void rspi_clear_rxbuf(struct rspi_data *rspi) +{ + rspi_write8(rspi, rspi_read8(rspi, RSPI_SPBFCR) | SPBFCR_RXRST, + RSPI_SPBFCR); + rspi_write8(rspi, rspi_read8(rspi, RSPI_SPBFCR) & (~SPBFCR_RXRST), + RSPI_SPBFCR); +} +static void rspi_clear_txbuf(struct rspi_data *rspi) +{ + rspi_write8(rspi, rspi_read8(rspi, RSPI_SPBFCR) | SPBFCR_TXRST, + RSPI_SPBFCR); + rspi_write8(rspi, rspi_read8(rspi, RSPI_SPBFCR) & (~SPBFCR_TXRST), + RSPI_SPBFCR); +} + static void rspi_enable_irq(const struct rspi_data *rspi, u8 enable) { rspi_write8(rspi, rspi_read8(rspi, RSPI_SPCR) | enable, RSPI_SPCR); @@ -452,6 +468,13 @@ static int rspi_send_pio(struct rspi_data *rspi, struct spi_message *mesg, { int remain = t->len; const u8 *data = t->tx_buf; + + if (rspi->sppcr & SPPCR_SPLP) { + /* loopback mode */ + rspi_clear_txbuf(rspi); + rspi_clear_rxbuf(rspi); + } + while (remain > 0) { rspi_set_txmode(rspi); @@ -461,7 +484,8 @@ static int rspi_send_pio(struct rspi_data *rspi, struct spi_message *mesg, return -ETIMEDOUT; } - if (!rspi->txmode && remain != t->len) { + if (!rspi->txmode && remain != t->len && + !(rspi->sppcr & SPPCR_SPLP)) { if (rspi_wait_for_interrupt(rspi, SPSR_SPRF, SPCR_SPRIE) < 0) { dev_err(&rspi->master->dev, @@ -478,7 +502,7 @@ static int rspi_send_pio(struct rspi_data *rspi, struct spi_message *mesg, /* Waiting for the last transmition */ rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE); - if (!rspi->txmode) { + if (!rspi->txmode && !(rspi->sppcr & SPPCR_SPLP)) { if (rspi_wait_for_interrupt(rspi, SPSR_SPRF, SPCR_SPRIE) < 0) { dev_err(&rspi->master->dev, "%s: receive timeout\n", __func__); @@ -651,7 +675,7 @@ static void rspi_receive_init(const struct rspi_data *rspi) u8 spsr; spsr = rspi_read8(rspi, RSPI_SPSR); - if (spsr & SPSR_SPRF) + if (spsr & SPSR_SPRF && !(rspi->sppcr & SPPCR_SPLP)) rspi_read_data(rspi); /* dummy read */ if (spsr & SPSR_OVRF) rspi_write8(rspi, rspi_read8(rspi, RSPI_SPSR) & ~SPSR_OVRF, @@ -689,6 +713,12 @@ static int rspi_receive_pio(struct rspi_data *rspi, struct spi_message *mesg, remain--; } + if (rspi->sppcr & SPPCR_SPLP) { + /* loopback mode */ + rspi_clear_txbuf(rspi); + rspi_clear_rxbuf(rspi); + } + return 0; } @@ -918,6 +948,11 @@ static int rspi_setup(struct spi_device *spi) if (spi->mode & SPI_CPHA) rspi->spcmd |= SPCMD_CPHA; + /* CMOS output mode and MOSI signal from previous transfer */ + rspi->sppcr = 0; + if (spi->mode & SPI_LOOP) + rspi->sppcr |= SPPCR_SPLP; + set_config_register(rspi, 8); return 0; @@ -1095,7 +1130,7 @@ static int rspi_probe(struct platform_device *pdev) master->setup = rspi_setup; master->transfer = rspi_transfer; master->cleanup = rspi_cleanup; - master->mode_bits = SPI_CPHA | SPI_CPOL; + master->mode_bits = ops->mode_bits; ret = ops->parse_platform_data(rspi, rspi_pd); if (ret < 0) { @@ -1151,6 +1186,7 @@ static struct spi_ops rspi_ops = { .set_config_register = rspi_set_config_register, .send_pio = rspi_send_pio, .receive_pio = rspi_receive_pio, + .mode_bits = SPI_CPHA | SPI_CPOL | SPI_LOOP, }; static struct spi_ops qspi_ops = { @@ -1158,6 +1194,7 @@ static struct spi_ops qspi_ops = { .set_config_register = qspi_set_config_register, .send_pio = qspi_send_pio, .receive_pio = qspi_receive_pio, + .mode_bits = SPI_CPHA | SPI_CPOL, }; static struct platform_device_id spi_driver_ids[] = {