scsi: ufs-qcom: add support for platforms with bus scaling disabled
Some platforms do not enable the BUS_SCALING feature. For such cases, we should wrap the routines that use this feature with a configuration flag. Change-Id: Iced5b6492a470eb5700b50a50de8260b6bb59753 Signed-off-by: Yaniv Gardi <ygardi@codeaurora.org>
This commit is contained in:
Yaniv Gardi
David Keitel
parent
0beb345a7e
commit
ca45ac2da8
1 changed files with 162 additions and 149 deletions
|
|
@ -51,10 +51,6 @@ enum {
|
||||||
|
|
||||||
static struct ufs_qcom_host *ufs_qcom_hosts[MAX_UFS_QCOM_HOSTS];
|
static struct ufs_qcom_host *ufs_qcom_hosts[MAX_UFS_QCOM_HOSTS];
|
||||||
|
|
||||||
static void ufs_qcom_get_speed_mode(struct ufs_pa_layer_attr *p, char *result);
|
|
||||||
static int ufs_qcom_get_bus_vote(struct ufs_qcom_host *host,
|
|
||||||
const char *speed_mode);
|
|
||||||
static int ufs_qcom_set_bus_vote(struct ufs_qcom_host *host, int vote);
|
|
||||||
static int ufs_qcom_update_sec_cfg(struct ufs_hba *hba, bool restore_sec_cfg);
|
static int ufs_qcom_update_sec_cfg(struct ufs_hba *hba, bool restore_sec_cfg);
|
||||||
static void ufs_qcom_get_default_testbus_cfg(struct ufs_qcom_host *host);
|
static void ufs_qcom_get_default_testbus_cfg(struct ufs_qcom_host *host);
|
||||||
static int ufs_qcom_set_dme_vs_core_clk_ctrl_clear_div(struct ufs_hba *hba,
|
static int ufs_qcom_set_dme_vs_core_clk_ctrl_clear_div(struct ufs_hba *hba,
|
||||||
|
|
@ -852,6 +848,81 @@ static int ufs_qcom_get_pwr_dev_param(struct ufs_qcom_dev_params *qcom_param,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifdef CONFIG_MSM_BUS_SCALING
|
||||||
|
static int ufs_qcom_get_bus_vote(struct ufs_qcom_host *host,
|
||||||
|
const char *speed_mode)
|
||||||
|
{
|
||||||
|
struct device *dev = host->hba->dev;
|
||||||
|
struct device_node *np = dev->of_node;
|
||||||
|
int err;
|
||||||
|
const char *key = "qcom,bus-vector-names";
|
||||||
|
|
||||||
|
if (!speed_mode) {
|
||||||
|
err = -EINVAL;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (host->bus_vote.is_max_bw_needed && !!strcmp(speed_mode, "MIN"))
|
||||||
|
err = of_property_match_string(np, key, "MAX");
|
||||||
|
else
|
||||||
|
err = of_property_match_string(np, key, speed_mode);
|
||||||
|
|
||||||
|
out:
|
||||||
|
if (err < 0)
|
||||||
|
dev_err(dev, "%s: Invalid %s mode %d\n",
|
||||||
|
__func__, speed_mode, err);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ufs_qcom_get_speed_mode(struct ufs_pa_layer_attr *p, char *result)
|
||||||
|
{
|
||||||
|
int gear = max_t(u32, p->gear_rx, p->gear_tx);
|
||||||
|
int lanes = max_t(u32, p->lane_rx, p->lane_tx);
|
||||||
|
int pwr;
|
||||||
|
|
||||||
|
/* default to PWM Gear 1, Lane 1 if power mode is not initialized */
|
||||||
|
if (!gear)
|
||||||
|
gear = 1;
|
||||||
|
|
||||||
|
if (!lanes)
|
||||||
|
lanes = 1;
|
||||||
|
|
||||||
|
if (!p->pwr_rx && !p->pwr_tx) {
|
||||||
|
pwr = SLOWAUTO_MODE;
|
||||||
|
snprintf(result, BUS_VECTOR_NAME_LEN, "MIN");
|
||||||
|
} else if (p->pwr_rx == FAST_MODE || p->pwr_rx == FASTAUTO_MODE ||
|
||||||
|
p->pwr_tx == FAST_MODE || p->pwr_tx == FASTAUTO_MODE) {
|
||||||
|
pwr = FAST_MODE;
|
||||||
|
snprintf(result, BUS_VECTOR_NAME_LEN, "%s_R%s_G%d_L%d", "HS",
|
||||||
|
p->hs_rate == PA_HS_MODE_B ? "B" : "A", gear, lanes);
|
||||||
|
} else {
|
||||||
|
pwr = SLOW_MODE;
|
||||||
|
snprintf(result, BUS_VECTOR_NAME_LEN, "%s_G%d_L%d",
|
||||||
|
"PWM", gear, lanes);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ufs_qcom_set_bus_vote(struct ufs_qcom_host *host, int vote)
|
||||||
|
{
|
||||||
|
int err = 0;
|
||||||
|
|
||||||
|
if (vote != host->bus_vote.curr_vote) {
|
||||||
|
err = msm_bus_scale_client_update_request(
|
||||||
|
host->bus_vote.client_handle, vote);
|
||||||
|
if (err) {
|
||||||
|
dev_err(host->hba->dev,
|
||||||
|
"%s: msm_bus_scale_client_update_request() failed: bus_client_handle=0x%x, vote=%d, err=%d\n",
|
||||||
|
__func__, host->bus_vote.client_handle,
|
||||||
|
vote, err);
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
host->bus_vote.curr_vote = vote;
|
||||||
|
}
|
||||||
|
out:
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
static int ufs_qcom_update_bus_bw_vote(struct ufs_qcom_host *host)
|
static int ufs_qcom_update_bus_bw_vote(struct ufs_qcom_host *host)
|
||||||
{
|
{
|
||||||
int vote;
|
int vote;
|
||||||
|
|
@ -873,6 +944,93 @@ static int ufs_qcom_update_bus_bw_vote(struct ufs_qcom_host *host)
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static ssize_t
|
||||||
|
show_ufs_to_mem_max_bus_bw(struct device *dev, struct device_attribute *attr,
|
||||||
|
char *buf)
|
||||||
|
{
|
||||||
|
struct ufs_hba *hba = dev_get_drvdata(dev);
|
||||||
|
struct ufs_qcom_host *host = ufshcd_get_variant(hba);
|
||||||
|
|
||||||
|
return snprintf(buf, PAGE_SIZE, "%u\n",
|
||||||
|
host->bus_vote.is_max_bw_needed);
|
||||||
|
}
|
||||||
|
|
||||||
|
static ssize_t
|
||||||
|
store_ufs_to_mem_max_bus_bw(struct device *dev, struct device_attribute *attr,
|
||||||
|
const char *buf, size_t count)
|
||||||
|
{
|
||||||
|
struct ufs_hba *hba = dev_get_drvdata(dev);
|
||||||
|
struct ufs_qcom_host *host = ufshcd_get_variant(hba);
|
||||||
|
uint32_t value;
|
||||||
|
|
||||||
|
if (!kstrtou32(buf, 0, &value)) {
|
||||||
|
host->bus_vote.is_max_bw_needed = !!value;
|
||||||
|
ufs_qcom_update_bus_bw_vote(host);
|
||||||
|
}
|
||||||
|
|
||||||
|
return count;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ufs_qcom_bus_register(struct ufs_qcom_host *host)
|
||||||
|
{
|
||||||
|
int err;
|
||||||
|
struct msm_bus_scale_pdata *bus_pdata;
|
||||||
|
struct device *dev = host->hba->dev;
|
||||||
|
struct platform_device *pdev = to_platform_device(dev);
|
||||||
|
struct device_node *np = dev->of_node;
|
||||||
|
|
||||||
|
bus_pdata = msm_bus_cl_get_pdata(pdev);
|
||||||
|
if (!bus_pdata) {
|
||||||
|
dev_err(dev, "%s: failed to get bus vectors\n", __func__);
|
||||||
|
err = -ENODATA;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = of_property_count_strings(np, "qcom,bus-vector-names");
|
||||||
|
if (err < 0 || err != bus_pdata->num_usecases) {
|
||||||
|
dev_err(dev, "%s: qcom,bus-vector-names not specified correctly %d\n",
|
||||||
|
__func__, err);
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
host->bus_vote.client_handle = msm_bus_scale_register_client(bus_pdata);
|
||||||
|
if (!host->bus_vote.client_handle) {
|
||||||
|
dev_err(dev, "%s: msm_bus_scale_register_client failed\n",
|
||||||
|
__func__);
|
||||||
|
err = -EFAULT;
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* cache the vote index for minimum and maximum bandwidth */
|
||||||
|
host->bus_vote.min_bw_vote = ufs_qcom_get_bus_vote(host, "MIN");
|
||||||
|
host->bus_vote.max_bw_vote = ufs_qcom_get_bus_vote(host, "MAX");
|
||||||
|
|
||||||
|
host->bus_vote.max_bus_bw.show = show_ufs_to_mem_max_bus_bw;
|
||||||
|
host->bus_vote.max_bus_bw.store = store_ufs_to_mem_max_bus_bw;
|
||||||
|
sysfs_attr_init(&host->bus_vote.max_bus_bw.attr);
|
||||||
|
host->bus_vote.max_bus_bw.attr.name = "max_bus_bw";
|
||||||
|
host->bus_vote.max_bus_bw.attr.mode = S_IRUGO | S_IWUSR;
|
||||||
|
err = device_create_file(dev, &host->bus_vote.max_bus_bw);
|
||||||
|
out:
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
#else /* CONFIG_MSM_BUS_SCALING */
|
||||||
|
static int ufs_qcom_update_bus_bw_vote(struct ufs_qcom_host *host)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ufs_qcom_set_bus_vote(struct ufs_qcom_host *host, int vote)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ufs_qcom_bus_register(struct ufs_qcom_host *host)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#endif /* CONFIG_MSM_BUS_SCALING */
|
||||||
|
|
||||||
static void ufs_qcom_dev_ref_clk_ctrl(struct ufs_qcom_host *host, bool enable)
|
static void ufs_qcom_dev_ref_clk_ctrl(struct ufs_qcom_host *host, bool enable)
|
||||||
{
|
{
|
||||||
if (host->dev_ref_clk_ctrl_mmio &&
|
if (host->dev_ref_clk_ctrl_mmio &&
|
||||||
|
|
@ -1072,80 +1230,6 @@ static void ufs_qcom_set_caps(struct ufs_hba *hba)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static int ufs_qcom_get_bus_vote(struct ufs_qcom_host *host,
|
|
||||||
const char *speed_mode)
|
|
||||||
{
|
|
||||||
struct device *dev = host->hba->dev;
|
|
||||||
struct device_node *np = dev->of_node;
|
|
||||||
int err;
|
|
||||||
const char *key = "qcom,bus-vector-names";
|
|
||||||
|
|
||||||
if (!speed_mode) {
|
|
||||||
err = -EINVAL;
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (host->bus_vote.is_max_bw_needed && !!strcmp(speed_mode, "MIN"))
|
|
||||||
err = of_property_match_string(np, key, "MAX");
|
|
||||||
else
|
|
||||||
err = of_property_match_string(np, key, speed_mode);
|
|
||||||
|
|
||||||
out:
|
|
||||||
if (err < 0)
|
|
||||||
dev_err(dev, "%s: Invalid %s mode %d\n",
|
|
||||||
__func__, speed_mode, err);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ufs_qcom_set_bus_vote(struct ufs_qcom_host *host, int vote)
|
|
||||||
{
|
|
||||||
int err = 0;
|
|
||||||
|
|
||||||
if (vote != host->bus_vote.curr_vote) {
|
|
||||||
err = msm_bus_scale_client_update_request(
|
|
||||||
host->bus_vote.client_handle, vote);
|
|
||||||
if (err) {
|
|
||||||
dev_err(host->hba->dev,
|
|
||||||
"%s: msm_bus_scale_client_update_request() failed: bus_client_handle=0x%x, vote=%d, err=%d\n",
|
|
||||||
__func__, host->bus_vote.client_handle,
|
|
||||||
vote, err);
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
|
|
||||||
host->bus_vote.curr_vote = vote;
|
|
||||||
}
|
|
||||||
out:
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void ufs_qcom_get_speed_mode(struct ufs_pa_layer_attr *p, char *result)
|
|
||||||
{
|
|
||||||
int gear = max_t(u32, p->gear_rx, p->gear_tx);
|
|
||||||
int lanes = max_t(u32, p->lane_rx, p->lane_tx);
|
|
||||||
int pwr;
|
|
||||||
|
|
||||||
/* default to PWM Gear 1, Lane 1 if power mode is not initialized */
|
|
||||||
if (!gear)
|
|
||||||
gear = 1;
|
|
||||||
|
|
||||||
if (!lanes)
|
|
||||||
lanes = 1;
|
|
||||||
|
|
||||||
if (!p->pwr_rx && !p->pwr_tx) {
|
|
||||||
pwr = SLOWAUTO_MODE;
|
|
||||||
snprintf(result, BUS_VECTOR_NAME_LEN, "MIN");
|
|
||||||
} else if (p->pwr_rx == FAST_MODE || p->pwr_rx == FASTAUTO_MODE ||
|
|
||||||
p->pwr_tx == FAST_MODE || p->pwr_tx == FASTAUTO_MODE) {
|
|
||||||
pwr = FAST_MODE;
|
|
||||||
snprintf(result, BUS_VECTOR_NAME_LEN, "%s_R%s_G%d_L%d", "HS",
|
|
||||||
p->hs_rate == PA_HS_MODE_B ? "B" : "A", gear, lanes);
|
|
||||||
} else {
|
|
||||||
pwr = SLOW_MODE;
|
|
||||||
snprintf(result, BUS_VECTOR_NAME_LEN, "%s_G%d_L%d",
|
|
||||||
"PWM", gear, lanes);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ufs_qcom_setup_clocks(struct ufs_hba *hba, bool on)
|
static int ufs_qcom_setup_clocks(struct ufs_hba *hba, bool on)
|
||||||
{
|
{
|
||||||
struct ufs_qcom_host *host = ufshcd_get_variant(hba);
|
struct ufs_qcom_host *host = ufshcd_get_variant(hba);
|
||||||
|
|
@ -1199,77 +1283,6 @@ out:
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
static ssize_t
|
|
||||||
show_ufs_to_mem_max_bus_bw(struct device *dev, struct device_attribute *attr,
|
|
||||||
char *buf)
|
|
||||||
{
|
|
||||||
struct ufs_hba *hba = dev_get_drvdata(dev);
|
|
||||||
struct ufs_qcom_host *host = ufshcd_get_variant(hba);
|
|
||||||
|
|
||||||
return snprintf(buf, PAGE_SIZE, "%u\n",
|
|
||||||
host->bus_vote.is_max_bw_needed);
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t
|
|
||||||
store_ufs_to_mem_max_bus_bw(struct device *dev, struct device_attribute *attr,
|
|
||||||
const char *buf, size_t count)
|
|
||||||
{
|
|
||||||
struct ufs_hba *hba = dev_get_drvdata(dev);
|
|
||||||
struct ufs_qcom_host *host = ufshcd_get_variant(hba);
|
|
||||||
uint32_t value;
|
|
||||||
|
|
||||||
if (!kstrtou32(buf, 0, &value)) {
|
|
||||||
host->bus_vote.is_max_bw_needed = !!value;
|
|
||||||
ufs_qcom_update_bus_bw_vote(host);
|
|
||||||
}
|
|
||||||
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ufs_qcom_bus_register(struct ufs_qcom_host *host)
|
|
||||||
{
|
|
||||||
int err;
|
|
||||||
struct msm_bus_scale_pdata *bus_pdata;
|
|
||||||
struct device *dev = host->hba->dev;
|
|
||||||
struct platform_device *pdev = to_platform_device(dev);
|
|
||||||
struct device_node *np = dev->of_node;
|
|
||||||
|
|
||||||
bus_pdata = msm_bus_cl_get_pdata(pdev);
|
|
||||||
if (!bus_pdata) {
|
|
||||||
dev_err(dev, "%s: failed to get bus vectors\n", __func__);
|
|
||||||
err = -ENODATA;
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
|
|
||||||
err = of_property_count_strings(np, "qcom,bus-vector-names");
|
|
||||||
if (err < 0 || err != bus_pdata->num_usecases) {
|
|
||||||
dev_err(dev, "%s: qcom,bus-vector-names not specified correctly %d\n",
|
|
||||||
__func__, err);
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
|
|
||||||
host->bus_vote.client_handle = msm_bus_scale_register_client(bus_pdata);
|
|
||||||
if (!host->bus_vote.client_handle) {
|
|
||||||
dev_err(dev, "%s: msm_bus_scale_register_client failed\n",
|
|
||||||
__func__);
|
|
||||||
err = -EFAULT;
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* cache the vote index for minimum and maximum bandwidth */
|
|
||||||
host->bus_vote.min_bw_vote = ufs_qcom_get_bus_vote(host, "MIN");
|
|
||||||
host->bus_vote.max_bw_vote = ufs_qcom_get_bus_vote(host, "MAX");
|
|
||||||
|
|
||||||
host->bus_vote.max_bus_bw.show = show_ufs_to_mem_max_bus_bw;
|
|
||||||
host->bus_vote.max_bus_bw.store = store_ufs_to_mem_max_bus_bw;
|
|
||||||
sysfs_attr_init(&host->bus_vote.max_bus_bw.attr);
|
|
||||||
host->bus_vote.max_bus_bw.attr.name = "max_bus_bw";
|
|
||||||
host->bus_vote.max_bus_bw.attr.mode = S_IRUGO | S_IWUSR;
|
|
||||||
err = device_create_file(dev, &host->bus_vote.max_bus_bw);
|
|
||||||
out:
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
#define ANDROID_BOOT_DEV_MAX 30
|
#define ANDROID_BOOT_DEV_MAX 30
|
||||||
static char android_boot_dev[ANDROID_BOOT_DEV_MAX];
|
static char android_boot_dev[ANDROID_BOOT_DEV_MAX];
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Add table
Reference in a new issue