From b4fe9519731139559c062f81decb5fc91ee40f3e Mon Sep 17 00:00:00 2001
From: xuwt2 <xuwt2@lenovo.com>
Date: Tue, 9 Nov 2021 23:30:40 +0800
Subject: [PATCH] qti_glink_charger: Add tx_mode and rx_connected sysfs node

Add tx_mode and rx_connected
this is to support moto wireless powershared

Change-Id: Idb36fdfb10fa9cbe4015f6c4ecd1f6c6e74deb26
Signed-off-by: xuwt2 <xuwt2@lenovo.com>
Reviewed-on: https://gerrit.mot.com/2111245
SLTApproved: Slta Waiver
SME-Granted: SME Approvals Granted
Tested-by: Jira Key
Reviewed-by: Yonghua Yan <yanyh2@motorola.com>
Reviewed-by: Jianqi Yang <yangj@motorola.com>
Submit-Approved: Jira Key
---
 .../qti_glink_charger/qti_glink_charger.c     | 93 +++++++++++++++++++
 .../qti_glink_charger/qti_glink_charger.h     |  1 +
 2 files changed, 94 insertions(+)

diff --git a/drivers/power/qti_glink_charger/qti_glink_charger.c b/drivers/power/qti_glink_charger/qti_glink_charger.c
index ef4b7e7582da..3989563118ff 100644
--- a/drivers/power/qti_glink_charger/qti_glink_charger.c
+++ b/drivers/power/qti_glink_charger/qti_glink_charger.c
@@ -154,12 +154,14 @@ struct qti_charger {
 	struct mmi_charger_cfg		chg_cfg;
 	struct mmi_charger_constraint	constraint;
 	struct mmi_charger_driver	*driver;
+	struct power_supply	*wls_psy;
 	u32				*profile_data;
 	struct charger_profile_info	profile_info;
 	struct lpd_info			lpd_info;
 	void				*ipc_log;
 	struct fod_curr	rx_fod_curr;
 	struct fod_gain	rx_fod_gain;
+	u32				tx_mode;
 	bool				*debug_enabled;
 };
 
@@ -1311,6 +1313,95 @@ static DEVICE_ATTR(data, 0664,
 		data_show,
 		data_store);
 
+static ssize_t tx_mode_store(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+	unsigned long r;
+	unsigned long tx_mode;
+	struct qti_charger *chg = this_chip;
+
+	if (!chg) {
+		pr_err("QTI: chip not valid\n");
+		return -ENODEV;
+	}
+
+	r = kstrtoul(buf, 0, &tx_mode);
+	if (r) {
+		pr_err("Invalid tx_mode = %lu\n", tx_mode);
+		return -EINVAL;
+	}
+
+	r = qti_charger_write(chg, OEM_PROP_WLS_TX_MODE,
+				&tx_mode,
+				sizeof(tx_mode));
+	chg->tx_mode = tx_mode;
+	if (chg->wls_psy)
+		sysfs_notify(&chg->wls_psy->dev.parent->kobj, NULL, "tx_mode");
+
+	return r ? r : count;
+}
+
+static ssize_t tx_mode_show(struct device *dev,
+		struct device_attribute *attr,
+		char *buf)
+{
+	struct qti_charger *chg = this_chip;
+
+	if (!chg) {
+		pr_err("PEN: chip not valid\n");
+		return -ENODEV;
+	}
+
+	return scnprintf(buf, CHG_SHOW_MAX_SIZE, "%d\n", chg->tx_mode);
+}
+static DEVICE_ATTR(tx_mode, S_IRUGO|S_IWUSR, tx_mode_show, tx_mode_store);
+
+static ssize_t rx_connected_show(struct device *dev,
+					struct device_attribute *attr,
+					char *buf)
+{
+	int data;
+	struct qti_charger *chg = dev_get_drvdata(dev);
+
+	if (!chg) {
+		pr_err("QTI: chip not valid\n");
+		return -ENODEV;
+	}
+
+      data = 0;
+
+	return scnprintf(buf, CHG_SHOW_MAX_SIZE, "0x%04x\n", data);
+}
+
+static DEVICE_ATTR(rx_connected, S_IRUGO,
+		rx_connected_show,
+		NULL);
+
+static void wireless_psy_init(struct qti_charger *chg)
+{
+	int rc;
+
+	if (chg->wls_psy)
+		return;
+
+	chg->wls_psy = power_supply_get_by_name("wireless");
+	if (!chg->wls_psy) {
+		pr_err("No pen power supply found\n");
+		return;
+	}
+	pr_info("wireless power supply is found\n");
+
+	rc = device_create_file(chg->wls_psy->dev.parent,
+				&dev_attr_tx_mode);
+        if (rc)
+		pr_err("couldn't create pen control\n");
+	rc = device_create_file(chg->wls_psy->dev.parent,
+				&dev_attr_rx_connected);
+        if (rc)
+		pr_err("couldn't create wireless sysfs node error\n");
+}
+
 static int qti_charger_init(struct qti_charger *chg)
 {
 	int rc;
@@ -1453,6 +1544,8 @@ static int qti_charger_init(struct qti_charger *chg)
 
 	bm_ulog_print_mask_log(BM_ALL, BM_LOG_LEVEL_INFO, OEM_BM_ULOG_SIZE);
 
+	wireless_psy_init(chg);
+
 	return 0;
 }
 
diff --git a/drivers/power/qti_glink_charger/qti_glink_charger.h b/drivers/power/qti_glink_charger/qti_glink_charger.h
index 04a5458055b5..e1bf65a1a635 100644
--- a/drivers/power/qti_glink_charger/qti_glink_charger.h
+++ b/drivers/power/qti_glink_charger/qti_glink_charger.h
@@ -55,6 +55,7 @@ enum oem_property_type {
 	OEM_PROP_PEN_STATUS,
 	OEM_PROP_WLS_RX_FOD_CURR,
 	OEM_PROP_WLS_RX_FOD_GAIN,
+	OEM_PROP_WLS_TX_MODE,
 	OEM_PROP_MAX,
 };