Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 431a9b4a authored by Can Guo's avatar Can Guo Committed by Hiren Gohel
Browse files

scsi: ufs-qcom: Add one vendor specific sysfs group 



Add one vendor specific sysfs group to support additional sysfs nodes,
such as err_state and power_mode.

Change-Id: Ia69909fc3838a054221191259a015067dd962008
Signed-off-by: default avatarCan Guo <cang@codeaurora.org>
parent e7babae0

drivers/scsi/ufs/ufs-qcom.c

+68 −0
Original line number Diff line number Diff line
@@ -65,6 +65,7 @@ static int ufs_qcom_set_dme_vs_core_clk_ctrl_clear_div(struct ufs_hba *hba, 
						       u32 clk_1us_cycles,

						       u32 clk_40ns_cycles);

static void ufs_qcom_pm_qos_suspend(struct ufs_qcom_host *host);

static int ufs_qcom_init_sysfs(struct ufs_hba *hba);



static void ufs_qcom_dump_regs(struct ufs_hba *hba, int offset, int len,

		char *prefix)
@@ -2253,6 +2254,8 @@ static int ufs_qcom_init(struct ufs_hba *hba) 
		err = 0;

	}



	ufs_qcom_init_sysfs(hba);



	ufs_qcom_save_host_ptr(hba);



	goto out;
@@ -2704,6 +2707,8 @@ static void ufs_qcom_dump_dbg_regs(struct ufs_hba *hba, bool no_sleep) 
	struct ufs_qcom_host *host = ufshcd_get_variant(hba);

	struct phy *phy = host->generic_phy;



	host->err_occurred = true;



	ufs_qcom_dump_regs(hba, REG_UFS_SYS1CLK_1US, 16,

			"HCI Vendor Specific Registers ");

	ufs_qcom_print_hw_debug_reg_all(hba, NULL, ufs_qcom_dump_regs_wrapper);
@@ -2768,6 +2773,69 @@ static struct ufs_hba_variant ufs_hba_qcom_variant = { 
	.pm_qos_vops	= &ufs_hba_pm_qos_variant_ops,

};



/**

 * QCOM specific sysfs group and nodes

 */

static ssize_t err_state_show(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 scnprintf(buf, PAGE_SIZE, "%d\n", !!host->err_occurred);

}



static DEVICE_ATTR_RO(err_state);



static ssize_t power_mode_show(struct device *dev,

			struct device_attribute *attr, char *buf)

{

	struct ufs_hba *hba = dev_get_drvdata(dev);

	static const char * const names[] = {

		"INVALID MODE",

		"FAST MODE",

		"SLOW MODE",

		"INVALID MODE",

		"FASTAUTO MODE",

		"SLOWAUTO MODE",

		"INVALID MODE",

	};



	/* Print current power info */

	return scnprintf(buf, PAGE_SIZE,

		"[Rx,Tx]: Gear[%d,%d], Lane[%d,%d], PWR[%s,%s], Rate-%c\n",

		hba->pwr_info.gear_rx, hba->pwr_info.gear_tx,

		hba->pwr_info.lane_rx, hba->pwr_info.lane_tx,

		names[hba->pwr_info.pwr_rx],

		names[hba->pwr_info.pwr_tx],

		hba->pwr_info.hs_rate == PA_HS_MODE_B ? 'B' : 'A');

}



static DEVICE_ATTR_RO(power_mode);



static struct attribute *ufs_qcom_sysfs_attrs[] = {

	&dev_attr_err_state.attr,

	&dev_attr_power_mode.attr,

	NULL

};



static const struct attribute_group ufs_qcom_sysfs_group = {

	.name = "qcom",

	.attrs = ufs_qcom_sysfs_attrs,

};



static int ufs_qcom_init_sysfs(struct ufs_hba *hba)

{

	int ret;



	ret = sysfs_create_group(&hba->dev->kobj, &ufs_qcom_sysfs_group);

	if (ret)

		dev_err(hba->dev, "%s: Failed to create qcom sysfs group (err = %d)\n",

				 __func__, ret);



	return ret;

}



/**

 * ufs_qcom_probe - probe routine of the driver

 * @pdev: pointer to Platform device handle

drivers/scsi/ufs/ufs-qcom.h

+2 −1
Original line number Diff line number Diff line 
/* SPDX-License-Identifier: GPL-2.0 */

/* Copyright (c) 2013-2019, The Linux Foundation. All rights reserved.

/* Copyright (c) 2013-2020, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and
@@ -365,6 +365,7 @@ struct ufs_qcom_host { 
	struct ufs_vreg *vccq_parent;

	bool work_pending;

	bool is_phy_pwr_on;

	bool err_occurred;

};



static inline u32