Commit 5c0c28a8 authored by Sujit Reddy Thumma's avatar Sujit Reddy Thumma Committed by Christoph Hellwig

ufs: Allow vendor specific initialization

Some vendor specific controller versions might need to configure
vendor specific - registers, clocks, voltage regulators etc. to
initialize the host controller UTP layer and Uni-Pro stack.
Provide some common initialization operations that can be used
to configure vendor specifics. The methods can be extended in
future, for example, for power mode transitions.

The operations are vendor/board specific and hence determined with
the help of compatible property in device tree.
Signed-off-by: default avatarSujit Reddy Thumma <sthumma@codeaurora.org>
Signed-off-by: default avatarDolev Raviv <draviv@codeaurora.org>
Signed-off-by: default avatarChristoph Hellwig <hch@lst.de>
parent 693ad5ba
...@@ -164,7 +164,13 @@ ufshcd_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) ...@@ -164,7 +164,13 @@ ufshcd_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
mmio_base = pcim_iomap_table(pdev)[0]; mmio_base = pcim_iomap_table(pdev)[0];
err = ufshcd_init(&pdev->dev, &hba, mmio_base, pdev->irq); err = ufshcd_alloc_host(&pdev->dev, &hba);
if (err) {
dev_err(&pdev->dev, "Allocation failed\n");
return err;
}
err = ufshcd_init(hba, mmio_base, pdev->irq);
if (err) { if (err) {
dev_err(&pdev->dev, "Initialization failed\n"); dev_err(&pdev->dev, "Initialization failed\n");
return err; return err;
......
...@@ -35,9 +35,24 @@ ...@@ -35,9 +35,24 @@
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/pm_runtime.h> #include <linux/pm_runtime.h>
#include <linux/of.h>
#include "ufshcd.h" #include "ufshcd.h"
static const struct of_device_id ufs_of_match[];
static struct ufs_hba_variant_ops *get_variant_ops(struct device *dev)
{
if (dev->of_node) {
const struct of_device_id *match;
match = of_match_node(ufs_of_match, dev->of_node);
if (match)
return (struct ufs_hba_variant_ops *)match->data;
}
return NULL;
}
#ifdef CONFIG_PM #ifdef CONFIG_PM
/** /**
* ufshcd_pltfrm_suspend - suspend power management function * ufshcd_pltfrm_suspend - suspend power management function
...@@ -138,8 +153,8 @@ static int ufshcd_pltfrm_probe(struct platform_device *pdev) ...@@ -138,8 +153,8 @@ static int ufshcd_pltfrm_probe(struct platform_device *pdev)
mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
mmio_base = devm_ioremap_resource(dev, mem_res); mmio_base = devm_ioremap_resource(dev, mem_res);
if (IS_ERR(mmio_base)) { if (IS_ERR(*(void **)&mmio_base)) {
err = PTR_ERR(mmio_base); err = PTR_ERR(*(void **)&mmio_base);
goto out; goto out;
} }
...@@ -150,10 +165,18 @@ static int ufshcd_pltfrm_probe(struct platform_device *pdev) ...@@ -150,10 +165,18 @@ static int ufshcd_pltfrm_probe(struct platform_device *pdev)
goto out; goto out;
} }
err = ufshcd_alloc_host(dev, &hba);
if (err) {
dev_err(&pdev->dev, "Allocation failed\n");
goto out;
}
hba->vops = get_variant_ops(&pdev->dev);
pm_runtime_set_active(&pdev->dev); pm_runtime_set_active(&pdev->dev);
pm_runtime_enable(&pdev->dev); pm_runtime_enable(&pdev->dev);
err = ufshcd_init(dev, &hba, mmio_base, irq); err = ufshcd_init(hba, mmio_base, irq);
if (err) { if (err) {
dev_err(dev, "Intialization failed\n"); dev_err(dev, "Intialization failed\n");
goto out_disable_rpm; goto out_disable_rpm;
......
...@@ -3,6 +3,7 @@ ...@@ -3,6 +3,7 @@
* *
* This code is based on drivers/scsi/ufs/ufshcd.c * This code is based on drivers/scsi/ufs/ufshcd.c
* Copyright (C) 2011-2013 Samsung India Software Operations * Copyright (C) 2011-2013 Samsung India Software Operations
* Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
* *
* Authors: * Authors:
* Santosh Yaraganavi <santosh.sy@samsung.com> * Santosh Yaraganavi <santosh.sy@samsung.com>
...@@ -31,6 +32,9 @@ ...@@ -31,6 +32,9 @@
* circumstances will the contributor of this Program be liable for * circumstances will the contributor of this Program be liable for
* any damages of any kind arising from your use or distribution of * any damages of any kind arising from your use or distribution of
* this program. * this program.
*
* The Linux Foundation chooses to take subject only to the GPLv2
* license terms, and distributes only under these terms.
*/ */
#include <linux/async.h> #include <linux/async.h>
...@@ -175,13 +179,14 @@ static inline u32 ufshcd_get_ufs_version(struct ufs_hba *hba) ...@@ -175,13 +179,14 @@ static inline u32 ufshcd_get_ufs_version(struct ufs_hba *hba)
/** /**
* ufshcd_is_device_present - Check if any device connected to * ufshcd_is_device_present - Check if any device connected to
* the host controller * the host controller
* @reg_hcs - host controller status register value * @hba: pointer to adapter instance
* *
* Returns 1 if device present, 0 if no device detected * Returns 1 if device present, 0 if no device detected
*/ */
static inline int ufshcd_is_device_present(u32 reg_hcs) static inline int ufshcd_is_device_present(struct ufs_hba *hba)
{ {
return (DEVICE_PRESENT & reg_hcs) ? 1 : 0; return (ufshcd_readl(hba, REG_CONTROLLER_STATUS) &
DEVICE_PRESENT) ? 1 : 0;
} }
/** /**
...@@ -1798,11 +1803,10 @@ static int ufshcd_complete_dev_init(struct ufs_hba *hba) ...@@ -1798,11 +1803,10 @@ static int ufshcd_complete_dev_init(struct ufs_hba *hba)
* @hba: per adapter instance * @hba: per adapter instance
* *
* To bring UFS host controller to operational state, * To bring UFS host controller to operational state,
* 1. Check if device is present * 1. Enable required interrupts
* 2. Enable required interrupts * 2. Configure interrupt aggregation
* 3. Configure interrupt aggregation * 3. Program UTRL and UTMRL base addres
* 4. Program UTRL and UTMRL base addres * 4. Configure run-stop-registers
* 5. Configure run-stop-registers
* *
* Returns 0 on success, non-zero value on failure * Returns 0 on success, non-zero value on failure
*/ */
...@@ -1811,14 +1815,6 @@ static int ufshcd_make_hba_operational(struct ufs_hba *hba) ...@@ -1811,14 +1815,6 @@ static int ufshcd_make_hba_operational(struct ufs_hba *hba)
int err = 0; int err = 0;
u32 reg; u32 reg;
/* check if device present */
reg = ufshcd_readl(hba, REG_CONTROLLER_STATUS);
if (!ufshcd_is_device_present(reg)) {
dev_err(hba->dev, "cc: Device not present\n");
err = -ENXIO;
goto out;
}
/* Enable required interrupts */ /* Enable required interrupts */
ufshcd_enable_intr(hba, UFSHCD_ENABLE_INTRS); ufshcd_enable_intr(hba, UFSHCD_ENABLE_INTRS);
...@@ -1839,6 +1835,7 @@ static int ufshcd_make_hba_operational(struct ufs_hba *hba) ...@@ -1839,6 +1835,7 @@ static int ufshcd_make_hba_operational(struct ufs_hba *hba)
* UCRDY, UTMRLDY and UTRLRDY bits must be 1 * UCRDY, UTMRLDY and UTRLRDY bits must be 1
* DEI, HEI bits must be 0 * DEI, HEI bits must be 0
*/ */
reg = ufshcd_readl(hba, REG_CONTROLLER_STATUS);
if (!(ufshcd_get_lists_status(reg))) { if (!(ufshcd_get_lists_status(reg))) {
ufshcd_enable_run_stop_reg(hba); ufshcd_enable_run_stop_reg(hba);
} else { } else {
...@@ -1885,6 +1882,9 @@ static int ufshcd_hba_enable(struct ufs_hba *hba) ...@@ -1885,6 +1882,9 @@ static int ufshcd_hba_enable(struct ufs_hba *hba)
msleep(5); msleep(5);
} }
if (hba->vops && hba->vops->hce_enable_notify)
hba->vops->hce_enable_notify(hba, PRE_CHANGE);
/* start controller initialization sequence */ /* start controller initialization sequence */
ufshcd_hba_start(hba); ufshcd_hba_start(hba);
...@@ -1912,6 +1912,10 @@ static int ufshcd_hba_enable(struct ufs_hba *hba) ...@@ -1912,6 +1912,10 @@ static int ufshcd_hba_enable(struct ufs_hba *hba)
} }
msleep(5); msleep(5);
} }
if (hba->vops && hba->vops->hce_enable_notify)
hba->vops->hce_enable_notify(hba, POST_CHANGE);
return 0; return 0;
} }
...@@ -1928,12 +1932,28 @@ static int ufshcd_link_startup(struct ufs_hba *hba) ...@@ -1928,12 +1932,28 @@ static int ufshcd_link_startup(struct ufs_hba *hba)
/* enable UIC related interrupts */ /* enable UIC related interrupts */
ufshcd_enable_intr(hba, UIC_COMMAND_COMPL); ufshcd_enable_intr(hba, UIC_COMMAND_COMPL);
if (hba->vops && hba->vops->link_startup_notify)
hba->vops->link_startup_notify(hba, PRE_CHANGE);
ret = ufshcd_dme_link_startup(hba); ret = ufshcd_dme_link_startup(hba);
if (ret) if (ret)
goto out; goto out;
ret = ufshcd_make_hba_operational(hba); /* check if device is detected by inter-connect layer */
if (!ufshcd_is_device_present(hba)) {
dev_err(hba->dev, "%s: Device not present\n", __func__);
ret = -ENXIO;
goto out;
}
/* Include any host controller configuration via UIC commands */
if (hba->vops && hba->vops->link_startup_notify) {
ret = hba->vops->link_startup_notify(hba, POST_CHANGE);
if (ret)
goto out;
}
ret = ufshcd_make_hba_operational(hba);
out: out:
if (ret) if (ret)
dev_err(hba->dev, "link startup failed %d\n", ret); dev_err(hba->dev, "link startup failed %d\n", ret);
...@@ -3173,6 +3193,61 @@ static struct scsi_host_template ufshcd_driver_template = { ...@@ -3173,6 +3193,61 @@ static struct scsi_host_template ufshcd_driver_template = {
.can_queue = UFSHCD_CAN_QUEUE, .can_queue = UFSHCD_CAN_QUEUE,
}; };
static int ufshcd_variant_hba_init(struct ufs_hba *hba)
{
int err = 0;
if (!hba->vops)
goto out;
if (hba->vops->init) {
err = hba->vops->init(hba);
if (err)
goto out;
}
if (hba->vops->setup_clocks) {
err = hba->vops->setup_clocks(hba, true);
if (err)
goto out_exit;
}
if (hba->vops->setup_regulators) {
err = hba->vops->setup_regulators(hba, true);
if (err)
goto out_clks;
}
goto out;
out_clks:
if (hba->vops->setup_clocks)
hba->vops->setup_clocks(hba, false);
out_exit:
if (hba->vops->exit)
hba->vops->exit(hba);
out:
if (err)
dev_err(hba->dev, "%s: variant %s init failed err %d\n",
__func__, hba->vops ? hba->vops->name : "", err);
return err;
}
static void ufshcd_variant_hba_exit(struct ufs_hba *hba)
{
if (!hba->vops)
return;
if (hba->vops->setup_clocks)
hba->vops->setup_clocks(hba, false);
if (hba->vops->setup_regulators)
hba->vops->setup_regulators(hba, false);
if (hba->vops->exit)
hba->vops->exit(hba);
}
/** /**
* ufshcd_suspend - suspend power management function * ufshcd_suspend - suspend power management function
* @hba: per adapter instance * @hba: per adapter instance
...@@ -3257,6 +3332,8 @@ void ufshcd_remove(struct ufs_hba *hba) ...@@ -3257,6 +3332,8 @@ void ufshcd_remove(struct ufs_hba *hba)
ufshcd_hba_stop(hba); ufshcd_hba_stop(hba);
scsi_host_put(hba->host); scsi_host_put(hba->host);
ufshcd_variant_hba_exit(hba);
} }
EXPORT_SYMBOL_GPL(ufshcd_remove); EXPORT_SYMBOL_GPL(ufshcd_remove);
...@@ -3277,19 +3354,16 @@ static int ufshcd_set_dma_mask(struct ufs_hba *hba) ...@@ -3277,19 +3354,16 @@ static int ufshcd_set_dma_mask(struct ufs_hba *hba)
} }
/** /**
* ufshcd_init - Driver initialization routine * ufshcd_alloc_host - allocate Host Bus Adapter (HBA)
* @dev: pointer to device handle * @dev: pointer to device handle
* @hba_handle: driver private handle * @hba_handle: driver private handle
* @mmio_base: base register address
* @irq: Interrupt line of device
* Returns 0 on success, non-zero value on failure * Returns 0 on success, non-zero value on failure
*/ */
int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle, int ufshcd_alloc_host(struct device *dev, struct ufs_hba **hba_handle)
void __iomem *mmio_base, unsigned int irq)
{ {
struct Scsi_Host *host; struct Scsi_Host *host;
struct ufs_hba *hba; struct ufs_hba *hba;
int err; int err = 0;
if (!dev) { if (!dev) {
dev_err(dev, dev_err(dev,
...@@ -3298,13 +3372,6 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle, ...@@ -3298,13 +3372,6 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle,
goto out_error; goto out_error;
} }
if (!mmio_base) {
dev_err(dev,
"Invalid memory reference for mmio_base is NULL\n");
err = -ENODEV;
goto out_error;
}
host = scsi_host_alloc(&ufshcd_driver_template, host = scsi_host_alloc(&ufshcd_driver_template,
sizeof(struct ufs_hba)); sizeof(struct ufs_hba));
if (!host) { if (!host) {
...@@ -3315,9 +3382,40 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle, ...@@ -3315,9 +3382,40 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle,
hba = shost_priv(host); hba = shost_priv(host);
hba->host = host; hba->host = host;
hba->dev = dev; hba->dev = dev;
*hba_handle = hba;
out_error:
return err;
}
EXPORT_SYMBOL(ufshcd_alloc_host);
/**
* ufshcd_init - Driver initialization routine
* @hba: per-adapter instance
* @mmio_base: base register address
* @irq: Interrupt line of device
* Returns 0 on success, non-zero value on failure
*/
int ufshcd_init(struct ufs_hba *hba, void __iomem *mmio_base, unsigned int irq)
{
int err;
struct Scsi_Host *host = hba->host;
struct device *dev = hba->dev;
if (!mmio_base) {
dev_err(hba->dev,
"Invalid memory reference for mmio_base is NULL\n");
err = -ENODEV;
goto out_error;
}
hba->mmio_base = mmio_base; hba->mmio_base = mmio_base;
hba->irq = irq; hba->irq = irq;
err = ufshcd_variant_hba_init(hba);
if (err)
goto out_error;
/* Read capabilities registers */ /* Read capabilities registers */
ufshcd_hba_capabilities(hba); ufshcd_hba_capabilities(hba);
...@@ -3395,8 +3493,6 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle, ...@@ -3395,8 +3493,6 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle,
goto out_remove_scsi_host; goto out_remove_scsi_host;
} }
*hba_handle = hba;
/* Hold auto suspend until async scan completes */ /* Hold auto suspend until async scan completes */
pm_runtime_get_sync(dev); pm_runtime_get_sync(dev);
...@@ -3408,6 +3504,7 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle, ...@@ -3408,6 +3504,7 @@ int ufshcd_init(struct device *dev, struct ufs_hba **hba_handle,
scsi_remove_host(hba->host); scsi_remove_host(hba->host);
out_disable: out_disable:
scsi_host_put(host); scsi_host_put(host);
ufshcd_variant_hba_exit(hba);
out_error: out_error:
return err; return err;
} }
......
...@@ -68,6 +68,8 @@ ...@@ -68,6 +68,8 @@
#define UFSHCD "ufshcd" #define UFSHCD "ufshcd"
#define UFSHCD_DRIVER_VERSION "0.2" #define UFSHCD_DRIVER_VERSION "0.2"
struct ufs_hba;
enum dev_cmd_type { enum dev_cmd_type {
DEV_CMD_TYPE_NOP = 0x0, DEV_CMD_TYPE_NOP = 0x0,
DEV_CMD_TYPE_QUERY = 0x1, DEV_CMD_TYPE_QUERY = 0x1,
...@@ -152,6 +154,30 @@ struct ufs_dev_cmd { ...@@ -152,6 +154,30 @@ struct ufs_dev_cmd {
struct ufs_query query; struct ufs_query query;
}; };
#define PRE_CHANGE 0
#define POST_CHANGE 1
/**
* struct ufs_hba_variant_ops - variant specific callbacks
* @name: variant name
* @init: called when the driver is initialized
* @exit: called to cleanup everything done in init
* @setup_clocks: called before touching any of the controller registers
* @setup_regulators: called before accessing the host controller
* @hce_enable_notify: called before and after HCE enable bit is set to allow
* variant specific Uni-Pro initialization.
* @link_startup_notify: called before and after Link startup is carried out
* to allow variant specific Uni-Pro initialization.
*/
struct ufs_hba_variant_ops {
const char *name;
int (*init)(struct ufs_hba *);
void (*exit)(struct ufs_hba *);
int (*setup_clocks)(struct ufs_hba *, bool);
int (*setup_regulators)(struct ufs_hba *, bool);
int (*hce_enable_notify)(struct ufs_hba *, bool);
int (*link_startup_notify)(struct ufs_hba *, bool);
};
/** /**
* struct ufs_hba - per adapter private structure * struct ufs_hba - per adapter private structure
* @mmio_base: UFSHCI base register address * @mmio_base: UFSHCI base register address
...@@ -171,6 +197,8 @@ struct ufs_dev_cmd { ...@@ -171,6 +197,8 @@ struct ufs_dev_cmd {
* @nutrs: Transfer Request Queue depth supported by controller * @nutrs: Transfer Request Queue depth supported by controller
* @nutmrs: Task Management Queue depth supported by controller * @nutmrs: Task Management Queue depth supported by controller
* @ufs_version: UFS Version to which controller complies * @ufs_version: UFS Version to which controller complies
* @vops: pointer to variant specific operations
* @priv: pointer to variant specific private data
* @irq: Irq number of the controller * @irq: Irq number of the controller
* @active_uic_cmd: handle of active UIC command * @active_uic_cmd: handle of active UIC command
* @uic_cmd_mutex: mutex for uic command * @uic_cmd_mutex: mutex for uic command
...@@ -218,6 +246,8 @@ struct ufs_hba { ...@@ -218,6 +246,8 @@ struct ufs_hba {
int nutrs; int nutrs;
int nutmrs; int nutmrs;
u32 ufs_version; u32 ufs_version;
struct ufs_hba_variant_ops *vops;
void *priv;
unsigned int irq; unsigned int irq;
struct uic_command *active_uic_cmd; struct uic_command *active_uic_cmd;
...@@ -256,8 +286,8 @@ struct ufs_hba { ...@@ -256,8 +286,8 @@ struct ufs_hba {
#define ufshcd_readl(hba, reg) \ #define ufshcd_readl(hba, reg) \
readl((hba)->mmio_base + (reg)) readl((hba)->mmio_base + (reg))
int ufshcd_init(struct device *, struct ufs_hba ** , void __iomem * , int ufshcd_alloc_host(struct device *, struct ufs_hba **);
unsigned int); int ufshcd_init(struct ufs_hba * , void __iomem * , unsigned int);
void ufshcd_remove(struct ufs_hba *); void ufshcd_remove(struct ufs_hba *);
/** /**
......
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