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

Commit 1bf666ce authored by Raghavendra Kakarla's avatar Raghavendra Kakarla Committed by Gerrit - the friendly Code Review server
Browse files

soc: qcom: Add RPM SMD Driver 



This is a snapshot of the RPM-SMD driver functionality as of
'commit 0453f0e7("move rpm-smd initcall to
postcore_initcall_sync")' on msm-4.14 branch.

Change-Id: Ie70bca9c28ae2339b45715f7d82839f39e733832
Signed-off-by: default avatarRaghavendra Kakarla <rkakarla@codeaurora.org>
parent feef939e

drivers/rpmsg/Kconfig

+9 −0
Original line number Diff line number Diff line
@@ -77,4 +77,13 @@ config RPMSG_VIRTIO 
	select RPMSG

	select VIRTIO



config MSM_RPM_SMD

	bool "RPM driver using SMD protocol"

	help

	  RPM is the dedicated hardware engine for managing shared SoC

	  resources. This config adds driver support for using SMD as a

	  transport layer communication with RPM hardware. It also selects

	  the MSM_MPM config that programs the MPM module to monitor interrupts

	  during sleep modes.



endmenu

drivers/rpmsg/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -3,6 +3,7 @@ obj-$(CONFIG_RPMSG) += rpmsg_core.o 
obj-$(CONFIG_RPMSG_CHAR)	+= rpmsg_char.o

obj-$(CONFIG_RPMSG_QCOM_GLINK_RPM) += qcom_glink_rpm.o

obj-$(CONFIG_RPMSG_QCOM_GLINK_NATIVE) += qcom_glink_native.o

obj-$(CONFIG_MSM_RPM_SMD)   +=  rpm-smd.o

obj-$(CONFIG_RPMSG_QCOM_GLINK_SMEM) += qcom_glink_smem.o

obj-$(CONFIG_RPMSG_QCOM_GLINK_SPSS) += qcom_glink_spss.o

obj-$(CONFIG_RPMSG_QCOM_GLINK_SPI) += qcom_glink_spi.o

drivers/rpmsg/rpm-smd.c

0 → 100644
+1645 −0

File added.

Preview size limit exceeded, changes collapsed.

drivers/soc/qcom/Makefile

+3 −0
Original line number Diff line number Diff line
@@ -87,6 +87,9 @@ obj-$(CONFIG_QTI_DDR_STATS_LOG) += ddr_stats.o 
obj-$(CONFIG_QMP_DEBUGFS_CLIENT) += qmp-debugfs-client.o

obj-$(CONFIG_QCOM_HYP_CORE_CTL) += hyp_core_ctl.o

obj-$(CONFIG_MSM_PERFORMANCE) += msm_performance.o

ifdef CONFIG_DEBUG_FS

obj-$(CONFIG_MSM_RPM_SMD)   +=  rpm-smd-debug.o

endif

obj-$(CONFIG_QCOM_CDSP_RM) += cdsprm.o

obj-$(CONFIG_ICNSS) += icnss.o

obj-$(CONFIG_ICNSS_QMI) += icnss_qmi.o wlan_firmware_service_v01.o

drivers/soc/qcom/rpm-smd-debug.c

0 → 100644
+144 −0
Original line number Diff line number Diff line 
// SPDX-License-Identifier: GPL-2.0-only

/*

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

 */



#define pr_fmt(fmt) "rpm-smd-debug: %s(): " fmt, __func__



#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/module.h>

#include <linux/debugfs.h>

#include <linux/list.h>

#include <linux/io.h>

#include <linux/uaccess.h>

#include <linux/slab.h>

#include <soc/qcom/rpm-smd.h>



#define MAX_MSG_BUFFER 350

#define MAX_KEY_VALUE_PAIRS 20



static struct dentry *rpm_debugfs_dir;



static u32 string_to_uint(const u8 *str)

{

	int i, len;

	u32 output = 0;



	len = strnlen(str, sizeof(u32));

	for (i = 0; i < len; i++)

		output |= str[i] << (i * 8);



	return output;

}



static ssize_t rsc_ops_write(struct file *fp, const char __user *user_buffer,

						size_t count, loff_t *position)

{

	char buf[MAX_MSG_BUFFER], rsc_type_str[6] = {}, rpm_set[8] = {},

						key_str[6] = {};

	int i, pos = -1, set = -1, nelems = -1;

	char *cmp;

	uint32_t rsc_type = 0, rsc_id = 0, key = 0, data = 0;

	struct msm_rpm_request *req;



	count = min(count, sizeof(buf) - 1);

	if (copy_from_user(&buf, user_buffer, count))

		return -EFAULT;

	buf[count] = '\0';

	cmp = strstrip(buf);



	if (sscanf(cmp, "%7s %5s %u %d %n", rpm_set, rsc_type_str,

				&rsc_id, &nelems, &pos) != 4) {

		pr_err("Invalid number of arguments passed\n");

		goto err;

	}



	if (strlen(rpm_set) > 6 || strlen(rsc_type_str) > 4) {

		pr_err("Invalid value of set or resource type\n");

		goto err;

	}



	if (!strcmp(rpm_set, "active"))

		set = 0;

	else if (!strcmp(rpm_set, "sleep"))

		set = 1;



	rsc_type = string_to_uint(rsc_type_str);



	if (set < 0 || nelems < 0) {

		pr_err("Invalid value of set or nelems\n");

		goto err;

	}

	if (nelems > MAX_KEY_VALUE_PAIRS) {

		pr_err("Exceeded max no of key-value entries\n");

		goto err;

	}



	req = msm_rpm_create_request(set, rsc_type, rsc_id, nelems);

	if (!req)

		return -ENOMEM;



	for (i = 0; i < nelems; i++) {

		cmp += pos;

		if (sscanf(cmp, "%5s %n", key_str, &pos) != 1) {

			pr_err("Invalid number of arguments passed\n");

			goto err_request;

		}



		if (strlen(key_str) > 4) {

			pr_err("Key value cannot be more than 4 charecters\n");

			goto err_request;

		}

		key = string_to_uint(key_str);

		if (!key) {

			pr_err("Key values entered incorrectly\n");

			goto err_request;

		}



		cmp += pos;

		if (sscanf(cmp, "%u %n", &data, &pos) != 1) {

			pr_err("Invalid number of arguments passed\n");

			goto err_request;

		}



		if (msm_rpm_add_kvp_data(req, key,

				(void *)&data, sizeof(data)))

			goto err_request;

	}



	if (msm_rpm_wait_for_ack(msm_rpm_send_request(req)))

		pr_err("Sending the RPM message failed\n");



err_request:

	msm_rpm_free_request(req);

err:

	return count;

}



static const struct file_operations rsc_ops = {

	.write = rsc_ops_write,

};



static int __init rpm_smd_debugfs_init(void)

{

	rpm_debugfs_dir = debugfs_create_dir("rpm_send_msg", NULL);

	if (!rpm_debugfs_dir)

		return -ENOMEM;



	if (!debugfs_create_file("message", 0200, rpm_debugfs_dir, NULL,

								&rsc_ops))

		return -ENOMEM;



	return 0;

}

late_initcall(rpm_smd_debugfs_init);



static void __exit rpm_smd_debugfs_exit(void)

{

	debugfs_remove_recursive(rpm_debugfs_dir);

}

module_exit(rpm_smd_debugfs_exit);



MODULE_DESCRIPTION("RPM SMD Debug Driver");

MODULE_LICENSE("GPL v2");