Commit 8b136baa authored by Jarkko Nikula's avatar Jarkko Nikula Committed by Mark Brown

spi: pxa2xx: Detect number of enabled Intel LPSS SPI chip select signals

SPI capabilities register located in private registers space of newer
Intel LPSS SPI host controllers tell in register bits 12:9 which chip
select signals are enabled.

Use that information for detecting the number of chip selects. For
simplicity we assume chip selects are enabled one after another without
disabled chip selects between. For instance CS0 | CS1 | CS2 but not
CS0 | CS1 | CS3.
Signed-off-by: default avatarJarkko Nikula <jarkko.nikula@linux.intel.com>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent d0283eb2
...@@ -13,6 +13,7 @@ ...@@ -13,6 +13,7 @@
* GNU General Public License for more details. * GNU General Public License for more details.
*/ */
#include <linux/bitops.h>
#include <linux/init.h> #include <linux/init.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/device.h> #include <linux/device.h>
...@@ -66,6 +67,8 @@ MODULE_ALIAS("platform:pxa2xx-spi"); ...@@ -66,6 +67,8 @@ MODULE_ALIAS("platform:pxa2xx-spi");
#define LPSS_CS_CONTROL_CS_HIGH BIT(1) #define LPSS_CS_CONTROL_CS_HIGH BIT(1)
#define LPSS_CS_CONTROL_CS_SEL_SHIFT 8 #define LPSS_CS_CONTROL_CS_SEL_SHIFT 8
#define LPSS_CS_CONTROL_CS_SEL_MASK (3 << LPSS_CS_CONTROL_CS_SEL_SHIFT) #define LPSS_CS_CONTROL_CS_SEL_MASK (3 << LPSS_CS_CONTROL_CS_SEL_SHIFT)
#define LPSS_CAPS_CS_EN_SHIFT 9
#define LPSS_CAPS_CS_EN_MASK (0xf << LPSS_CAPS_CS_EN_SHIFT)
struct lpss_config { struct lpss_config {
/* LPSS offset from drv_data->ioaddr */ /* LPSS offset from drv_data->ioaddr */
...@@ -74,6 +77,7 @@ struct lpss_config { ...@@ -74,6 +77,7 @@ struct lpss_config {
int reg_general; int reg_general;
int reg_ssp; int reg_ssp;
int reg_cs_ctrl; int reg_cs_ctrl;
int reg_capabilities;
/* FIFO thresholds */ /* FIFO thresholds */
u32 rx_threshold; u32 rx_threshold;
u32 tx_threshold_lo; u32 tx_threshold_lo;
...@@ -87,6 +91,7 @@ static const struct lpss_config lpss_platforms[] = { ...@@ -87,6 +91,7 @@ static const struct lpss_config lpss_platforms[] = {
.reg_general = 0x08, .reg_general = 0x08,
.reg_ssp = 0x0c, .reg_ssp = 0x0c,
.reg_cs_ctrl = 0x18, .reg_cs_ctrl = 0x18,
.reg_capabilities = -1,
.rx_threshold = 64, .rx_threshold = 64,
.tx_threshold_lo = 160, .tx_threshold_lo = 160,
.tx_threshold_hi = 224, .tx_threshold_hi = 224,
...@@ -96,6 +101,7 @@ static const struct lpss_config lpss_platforms[] = { ...@@ -96,6 +101,7 @@ static const struct lpss_config lpss_platforms[] = {
.reg_general = 0x08, .reg_general = 0x08,
.reg_ssp = 0x0c, .reg_ssp = 0x0c,
.reg_cs_ctrl = 0x18, .reg_cs_ctrl = 0x18,
.reg_capabilities = -1,
.rx_threshold = 64, .rx_threshold = 64,
.tx_threshold_lo = 160, .tx_threshold_lo = 160,
.tx_threshold_hi = 224, .tx_threshold_hi = 224,
...@@ -105,6 +111,7 @@ static const struct lpss_config lpss_platforms[] = { ...@@ -105,6 +111,7 @@ static const struct lpss_config lpss_platforms[] = {
.reg_general = -1, .reg_general = -1,
.reg_ssp = 0x20, .reg_ssp = 0x20,
.reg_cs_ctrl = 0x24, .reg_cs_ctrl = 0x24,
.reg_capabilities = 0xfc,
.rx_threshold = 1, .rx_threshold = 1,
.tx_threshold_lo = 32, .tx_threshold_lo = 32,
.tx_threshold_hi = 56, .tx_threshold_hi = 56,
...@@ -1400,6 +1407,7 @@ static int pxa2xx_spi_probe(struct platform_device *pdev) ...@@ -1400,6 +1407,7 @@ static int pxa2xx_spi_probe(struct platform_device *pdev)
struct spi_master *master; struct spi_master *master;
struct driver_data *drv_data; struct driver_data *drv_data;
struct ssp_device *ssp; struct ssp_device *ssp;
const struct lpss_config *config;
int status; int status;
u32 tmp; u32 tmp;
...@@ -1439,7 +1447,6 @@ static int pxa2xx_spi_probe(struct platform_device *pdev) ...@@ -1439,7 +1447,6 @@ static int pxa2xx_spi_probe(struct platform_device *pdev)
master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LOOP; master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LOOP;
master->bus_num = ssp->port_id; master->bus_num = ssp->port_id;
master->num_chipselect = platform_info->num_chipselect;
master->dma_alignment = DMA_ALIGNMENT; master->dma_alignment = DMA_ALIGNMENT;
master->cleanup = cleanup; master->cleanup = cleanup;
master->setup = setup; master->setup = setup;
...@@ -1525,6 +1532,19 @@ static int pxa2xx_spi_probe(struct platform_device *pdev) ...@@ -1525,6 +1532,19 @@ static int pxa2xx_spi_probe(struct platform_device *pdev)
if (is_lpss_ssp(drv_data)) if (is_lpss_ssp(drv_data))
lpss_ssp_setup(drv_data); lpss_ssp_setup(drv_data);
if (is_lpss_ssp(drv_data)) {
lpss_ssp_setup(drv_data);
config = lpss_get_config(drv_data);
if (config->reg_capabilities >= 0) {
tmp = __lpss_ssp_read_priv(drv_data,
config->reg_capabilities);
tmp &= LPSS_CAPS_CS_EN_MASK;
tmp >>= LPSS_CAPS_CS_EN_SHIFT;
platform_info->num_chipselect = ffz(tmp);
}
}
master->num_chipselect = platform_info->num_chipselect;
tasklet_init(&drv_data->pump_transfers, pump_transfers, tasklet_init(&drv_data->pump_transfers, pump_transfers,
(unsigned long)drv_data); (unsigned long)drv_data);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment