spi: mpc52xx-psc: Modernize probe
Merge series from Rob Herring <robh@kernel.org>: This started as just removing open coded parsing and address translation of "reg", and ended up with cleaning up the probe functions to use modern, preferred APIs for driver probe. It is compile tested only.
This commit is contained in:
Mark Brown
commit
e8e83f61b4
@ -14,15 +14,12 @@
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/of_irq.h>
|
||||
#include <linux/of_platform.h>
|
||||
#include <linux/completion.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/spi/spi.h>
|
||||
#include <linux/fsl_devices.h>
|
||||
#include <asm/mpc52xx_psc.h>
|
||||
|
||||
enum {
|
||||
@ -51,8 +48,6 @@ enum {
|
||||
__ret; })
|
||||
|
||||
struct mpc512x_psc_spi {
|
||||
void (*cs_control)(struct spi_device *spi, bool on);
|
||||
|
||||
/* driver internal data */
|
||||
int type;
|
||||
void __iomem *psc;
|
||||
@ -128,26 +123,16 @@ static void mpc512x_psc_spi_activate_cs(struct spi_device *spi)
|
||||
mps->bits_per_word = cs->bits_per_word;
|
||||
|
||||
if (spi->cs_gpiod) {
|
||||
if (mps->cs_control)
|
||||
/* boardfile override */
|
||||
mps->cs_control(spi, (spi->mode & SPI_CS_HIGH) ? 1 : 0);
|
||||
else
|
||||
/* gpiolib will deal with the inversion */
|
||||
gpiod_set_value(spi->cs_gpiod, 1);
|
||||
/* gpiolib will deal with the inversion */
|
||||
gpiod_set_value(spi->cs_gpiod, 1);
|
||||
}
|
||||
}
|
||||
|
||||
static void mpc512x_psc_spi_deactivate_cs(struct spi_device *spi)
|
||||
{
|
||||
struct mpc512x_psc_spi *mps = spi_master_get_devdata(spi->master);
|
||||
|
||||
if (spi->cs_gpiod) {
|
||||
if (mps->cs_control)
|
||||
/* boardfile override */
|
||||
mps->cs_control(spi, (spi->mode & SPI_CS_HIGH) ? 0 : 1);
|
||||
else
|
||||
/* gpiolib will deal with the inversion */
|
||||
gpiod_set_value(spi->cs_gpiod, 0);
|
||||
/* gpiolib will deal with the inversion */
|
||||
gpiod_set_value(spi->cs_gpiod, 0);
|
||||
}
|
||||
}
|
||||
|
||||
@ -471,30 +456,22 @@ static irqreturn_t mpc512x_psc_spi_isr(int irq, void *dev_id)
|
||||
return IRQ_NONE;
|
||||
}
|
||||
|
||||
static int mpc512x_psc_spi_do_probe(struct device *dev, u32 regaddr,
|
||||
u32 size, unsigned int irq)
|
||||
static int mpc512x_psc_spi_of_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct fsl_spi_platform_data *pdata = dev_get_platdata(dev);
|
||||
struct device *dev = &pdev->dev;
|
||||
struct mpc512x_psc_spi *mps;
|
||||
struct spi_master *master;
|
||||
int ret;
|
||||
void *tempp;
|
||||
struct clk *clk;
|
||||
|
||||
master = spi_alloc_master(dev, sizeof(*mps));
|
||||
master = devm_spi_alloc_master(dev, sizeof(*mps));
|
||||
if (master == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
dev_set_drvdata(dev, master);
|
||||
mps = spi_master_get_devdata(master);
|
||||
mps->type = (int)of_device_get_match_data(dev);
|
||||
mps->irq = irq;
|
||||
|
||||
if (pdata) {
|
||||
mps->cs_control = pdata->cs_control;
|
||||
master->bus_num = pdata->bus_num;
|
||||
master->num_chipselect = pdata->max_chipselect;
|
||||
}
|
||||
mps->type = (int)device_get_match_data(dev);
|
||||
|
||||
master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LSB_FIRST;
|
||||
master->setup = mpc512x_psc_spi_setup;
|
||||
@ -505,29 +482,27 @@ static int mpc512x_psc_spi_do_probe(struct device *dev, u32 regaddr,
|
||||
master->cleanup = mpc512x_psc_spi_cleanup;
|
||||
master->dev.of_node = dev->of_node;
|
||||
|
||||
tempp = devm_ioremap(dev, regaddr, size);
|
||||
if (!tempp) {
|
||||
dev_err(dev, "could not ioremap I/O port range\n");
|
||||
ret = -EFAULT;
|
||||
goto free_master;
|
||||
}
|
||||
tempp = devm_platform_get_and_ioremap_resource(pdev, 0, NULL);
|
||||
if (!tempp)
|
||||
return dev_err_probe(dev, -EFAULT, "could not ioremap I/O port range\n");
|
||||
mps->psc = tempp;
|
||||
mps->fifo =
|
||||
(struct mpc512x_psc_fifo *)(tempp + sizeof(struct mpc52xx_psc));
|
||||
|
||||
mps->irq = platform_get_irq(pdev, 0);
|
||||
ret = devm_request_irq(dev, mps->irq, mpc512x_psc_spi_isr, IRQF_SHARED,
|
||||
"mpc512x-psc-spi", mps);
|
||||
if (ret)
|
||||
goto free_master;
|
||||
return ret;
|
||||
init_completion(&mps->txisrdone);
|
||||
|
||||
clk = devm_clk_get(dev, "mclk");
|
||||
if (IS_ERR(clk)) {
|
||||
ret = PTR_ERR(clk);
|
||||
goto free_master;
|
||||
}
|
||||
if (IS_ERR(clk))
|
||||
return PTR_ERR(clk);
|
||||
|
||||
ret = clk_prepare_enable(clk);
|
||||
if (ret)
|
||||
goto free_master;
|
||||
return ret;
|
||||
mps->clk_mclk = clk;
|
||||
mps->mclk_rate = clk_get_rate(clk);
|
||||
|
||||
@ -555,15 +530,13 @@ free_ipg_clock:
|
||||
clk_disable_unprepare(mps->clk_ipg);
|
||||
free_mclk_clock:
|
||||
clk_disable_unprepare(mps->clk_mclk);
|
||||
free_master:
|
||||
spi_master_put(master);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mpc512x_psc_spi_do_remove(struct device *dev)
|
||||
static int mpc512x_psc_spi_of_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct spi_master *master = dev_get_drvdata(dev);
|
||||
struct spi_master *master = dev_get_drvdata(&pdev->dev);
|
||||
struct mpc512x_psc_spi *mps = spi_master_get_devdata(master);
|
||||
|
||||
clk_disable_unprepare(mps->clk_mclk);
|
||||
@ -572,27 +545,6 @@ static int mpc512x_psc_spi_do_remove(struct device *dev)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mpc512x_psc_spi_of_probe(struct platform_device *op)
|
||||
{
|
||||
const u32 *regaddr_p;
|
||||
u64 regaddr64, size64;
|
||||
|
||||
regaddr_p = of_get_address(op->dev.of_node, 0, &size64, NULL);
|
||||
if (!regaddr_p) {
|
||||
dev_err(&op->dev, "Invalid PSC address\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
regaddr64 = of_translate_address(op->dev.of_node, regaddr_p);
|
||||
|
||||
return mpc512x_psc_spi_do_probe(&op->dev, (u32) regaddr64, (u32) size64,
|
||||
irq_of_parse_and_map(op->dev.of_node, 0));
|
||||
}
|
||||
|
||||
static int mpc512x_psc_spi_of_remove(struct platform_device *op)
|
||||
{
|
||||
return mpc512x_psc_spi_do_remove(&op->dev);
|
||||
}
|
||||
|
||||
static const struct of_device_id mpc512x_psc_spi_of_match[] = {
|
||||
{ .compatible = "fsl,mpc5121-psc-spi", .data = (void *)TYPE_MPC5121 },
|
||||
{ .compatible = "fsl,mpc5125-psc-spi", .data = (void *)TYPE_MPC5125 },
|
||||
|
||||
@ -11,16 +11,14 @@
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/of_platform.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/completion.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/spi/spi.h>
|
||||
#include <linux/fsl_devices.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/of_irq.h>
|
||||
|
||||
#include <asm/mpc52xx.h>
|
||||
#include <asm/mpc52xx_psc.h>
|
||||
@ -28,10 +26,6 @@
|
||||
#define MCLK 20000000 /* PSC port MClk in hz */
|
||||
|
||||
struct mpc52xx_psc_spi {
|
||||
/* fsl_spi_platform data */
|
||||
void (*cs_control)(struct spi_device *spi, bool on);
|
||||
u32 sysclk;
|
||||
|
||||
/* driver internal data */
|
||||
struct mpc52xx_psc __iomem *psc;
|
||||
struct mpc52xx_psc_fifo __iomem *fifo;
|
||||
@ -101,17 +95,6 @@ static void mpc52xx_psc_spi_activate_cs(struct spi_device *spi)
|
||||
ccr |= (MCLK / 1000000 - 1) & 0xFF;
|
||||
out_be16((u16 __iomem *)&psc->ccr, ccr);
|
||||
mps->bits_per_word = cs->bits_per_word;
|
||||
|
||||
if (mps->cs_control)
|
||||
mps->cs_control(spi, (spi->mode & SPI_CS_HIGH) ? 1 : 0);
|
||||
}
|
||||
|
||||
static void mpc52xx_psc_spi_deactivate_cs(struct spi_device *spi)
|
||||
{
|
||||
struct mpc52xx_psc_spi *mps = spi_master_get_devdata(spi->master);
|
||||
|
||||
if (mps->cs_control)
|
||||
mps->cs_control(spi, (spi->mode & SPI_CS_HIGH) ? 0 : 1);
|
||||
}
|
||||
|
||||
#define MPC52xx_PSC_BUFSIZE (MPC52xx_PSC_RFNUM_MASK + 1)
|
||||
@ -220,14 +203,9 @@ int mpc52xx_psc_spi_transfer_one_message(struct spi_controller *ctlr,
|
||||
m->actual_length += t->len;
|
||||
|
||||
spi_transfer_delay_exec(t);
|
||||
|
||||
if (cs_change)
|
||||
mpc52xx_psc_spi_deactivate_cs(spi);
|
||||
}
|
||||
|
||||
m->status = status;
|
||||
if (status || !cs_change)
|
||||
mpc52xx_psc_spi_deactivate_cs(spi);
|
||||
|
||||
mpc52xx_psc_spi_transfer_setup(spi, NULL);
|
||||
|
||||
@ -269,7 +247,7 @@ static int mpc52xx_psc_spi_port_config(int psc_id, struct mpc52xx_psc_spi *mps)
|
||||
int ret;
|
||||
|
||||
/* default sysclk is 512MHz */
|
||||
mclken_div = (mps->sysclk ? mps->sysclk : 512000000) / MCLK;
|
||||
mclken_div = 512000000 / MCLK;
|
||||
ret = mpc52xx_set_psc_clkdiv(psc_id, mclken_div);
|
||||
if (ret)
|
||||
return ret;
|
||||
@ -313,16 +291,15 @@ static irqreturn_t mpc52xx_psc_spi_isr(int irq, void *dev_id)
|
||||
return IRQ_NONE;
|
||||
}
|
||||
|
||||
/* bus_num is used only for the case dev->platform_data == NULL */
|
||||
static int mpc52xx_psc_spi_do_probe(struct device *dev, u32 regaddr,
|
||||
u32 size, unsigned int irq, s16 bus_num)
|
||||
static int mpc52xx_psc_spi_of_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct fsl_spi_platform_data *pdata = dev_get_platdata(dev);
|
||||
struct device *dev = &pdev->dev;
|
||||
struct mpc52xx_psc_spi *mps;
|
||||
struct spi_master *master;
|
||||
u32 bus_num;
|
||||
int ret;
|
||||
|
||||
master = spi_alloc_master(dev, sizeof(*mps));
|
||||
master = devm_spi_alloc_master(dev, sizeof(*mps));
|
||||
if (master == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
@ -332,104 +309,36 @@ static int mpc52xx_psc_spi_do_probe(struct device *dev, u32 regaddr,
|
||||
/* the spi->mode bits understood by this driver: */
|
||||
master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LSB_FIRST;
|
||||
|
||||
mps->irq = irq;
|
||||
if (pdata == NULL) {
|
||||
dev_warn(dev,
|
||||
"probe called without platform data, no cs_control function will be called\n");
|
||||
mps->cs_control = NULL;
|
||||
mps->sysclk = 0;
|
||||
master->bus_num = bus_num;
|
||||
master->num_chipselect = 255;
|
||||
} else {
|
||||
mps->cs_control = pdata->cs_control;
|
||||
mps->sysclk = pdata->sysclk;
|
||||
master->bus_num = pdata->bus_num;
|
||||
master->num_chipselect = pdata->max_chipselect;
|
||||
}
|
||||
ret = of_property_read_u32(dev->of_node, "cell-index", &bus_num);
|
||||
if (ret || bus_num > 5)
|
||||
return dev_err_probe(dev, ret ? : -EINVAL, "Invalid cell-index property\n");
|
||||
master->bus_num = bus_num + 1;
|
||||
|
||||
master->num_chipselect = 255;
|
||||
master->setup = mpc52xx_psc_spi_setup;
|
||||
master->transfer_one_message = mpc52xx_psc_spi_transfer_one_message;
|
||||
master->cleanup = mpc52xx_psc_spi_cleanup;
|
||||
master->dev.of_node = dev->of_node;
|
||||
|
||||
mps->psc = ioremap(regaddr, size);
|
||||
if (!mps->psc) {
|
||||
dev_err(dev, "could not ioremap I/O port range\n");
|
||||
ret = -EFAULT;
|
||||
goto free_master;
|
||||
}
|
||||
mps->psc = devm_platform_get_and_ioremap_resource(pdev, 0, NULL);
|
||||
if (!mps->psc)
|
||||
return dev_err_probe(dev, -EFAULT, "could not ioremap I/O port range\n");
|
||||
/* On the 5200, fifo regs are immediately ajacent to the psc regs */
|
||||
mps->fifo = ((void __iomem *)mps->psc) + sizeof(struct mpc52xx_psc);
|
||||
|
||||
ret = request_irq(mps->irq, mpc52xx_psc_spi_isr, 0, "mpc52xx-psc-spi",
|
||||
mps);
|
||||
mps->irq = platform_get_irq(pdev, 0);
|
||||
ret = devm_request_irq(dev, mps->irq, mpc52xx_psc_spi_isr, 0,
|
||||
"mpc52xx-psc-spi", mps);
|
||||
if (ret)
|
||||
goto free_master;
|
||||
return ret;
|
||||
|
||||
ret = mpc52xx_psc_spi_port_config(master->bus_num, mps);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "can't configure PSC! Is it capable of SPI?\n");
|
||||
goto free_irq;
|
||||
}
|
||||
if (ret < 0)
|
||||
return dev_err_probe(dev, ret, "can't configure PSC! Is it capable of SPI?\n");
|
||||
|
||||
init_completion(&mps->done);
|
||||
|
||||
ret = spi_register_master(master);
|
||||
if (ret < 0)
|
||||
goto free_irq;
|
||||
|
||||
return ret;
|
||||
|
||||
free_irq:
|
||||
free_irq(mps->irq, mps);
|
||||
free_master:
|
||||
if (mps->psc)
|
||||
iounmap(mps->psc);
|
||||
spi_master_put(master);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mpc52xx_psc_spi_of_probe(struct platform_device *op)
|
||||
{
|
||||
const u32 *regaddr_p;
|
||||
u64 regaddr64, size64;
|
||||
s16 id = -1;
|
||||
|
||||
regaddr_p = of_get_address(op->dev.of_node, 0, &size64, NULL);
|
||||
if (!regaddr_p) {
|
||||
dev_err(&op->dev, "Invalid PSC address\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
regaddr64 = of_translate_address(op->dev.of_node, regaddr_p);
|
||||
|
||||
/* get PSC id (1..6, used by port_config) */
|
||||
if (op->dev.platform_data == NULL) {
|
||||
const u32 *psc_nump;
|
||||
|
||||
psc_nump = of_get_property(op->dev.of_node, "cell-index", NULL);
|
||||
if (!psc_nump || *psc_nump > 5) {
|
||||
dev_err(&op->dev, "Invalid cell-index property\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
id = *psc_nump + 1;
|
||||
}
|
||||
|
||||
return mpc52xx_psc_spi_do_probe(&op->dev, (u32)regaddr64, (u32)size64,
|
||||
irq_of_parse_and_map(op->dev.of_node, 0), id);
|
||||
}
|
||||
|
||||
static int mpc52xx_psc_spi_of_remove(struct platform_device *op)
|
||||
{
|
||||
struct spi_master *master = spi_master_get(platform_get_drvdata(op));
|
||||
struct mpc52xx_psc_spi *mps = spi_master_get_devdata(master);
|
||||
|
||||
spi_unregister_master(master);
|
||||
free_irq(mps->irq, mps);
|
||||
if (mps->psc)
|
||||
iounmap(mps->psc);
|
||||
spi_master_put(master);
|
||||
|
||||
return 0;
|
||||
return devm_spi_register_master(dev, master);
|
||||
}
|
||||
|
||||
static const struct of_device_id mpc52xx_psc_spi_of_match[] = {
|
||||
@ -442,7 +351,6 @@ MODULE_DEVICE_TABLE(of, mpc52xx_psc_spi_of_match);
|
||||
|
||||
static struct platform_driver mpc52xx_psc_spi_of_driver = {
|
||||
.probe = mpc52xx_psc_spi_of_probe,
|
||||
.remove = mpc52xx_psc_spi_of_remove,
|
||||
.driver = {
|
||||
.name = "mpc52xx-psc-spi",
|
||||
.of_match_table = mpc52xx_psc_spi_of_match,
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user