soc: qcom: Add snapshot of RPM SMD Driver (6c2ca35f) · Commits · e / devices / android_kernel_sony_msm8998

drivers/soc/qcom/Kconfig

+9 −0

Original line number	Diff line number	Diff line
		@@ -70,6 +70,15 @@ config MSM_GLINK_SMEM_NATIVE_XPRT
		transport to only connecting with entities internal to the
		System-on-Chip.

		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.

		config QCOM_GSBI
		tristate "QCOM General Serial Bus Interface"
		depends on ARCH_QCOM

drivers/soc/qcom/Makefile

+4 −0

Original line number	Diff line number	Diff line
		@@ -4,6 +4,10 @@ obj-$(CONFIG_MSM_GLINK) += glink.o glink_debugfs.o glink_ssr.o
		obj-$(CONFIG_MSM_GLINK_LOOPBACK_SERVER) += glink_loopback_server.o
		obj-$(CONFIG_MSM_GLINK_SMD_XPRT) += glink_smd_xprt.o
		obj-$(CONFIG_MSM_GLINK_SMEM_NATIVE_XPRT)+= glink_smem_native_xprt.o
		obj-$(CONFIG_MSM_RPM_SMD) += rpm-smd.o
		ifdef CONFIG_DEBUG_FS
		obj-$(CONFIG_MSM_RPM_SMD) += rpm-smd-debug.o
		endif
		obj-$(CONFIG_QCOM_GSBI) += qcom_gsbi.o
		obj-$(CONFIG_QCOM_PM) += spm.o
		obj-$(CONFIG_QCOM_SMD) += smd.o

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

0 → 100644

+141 −0

Original line number	Diff line number	Diff line
		/* Copyright (c) 2013-2014, 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
		* only version 2 as published by the Free Software Foundation.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*/

		#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, set = -1, nelems;
		char *cmp;
		uint32_t rsc_type, rsc_id, key, data;
		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);

		sscanf(cmp, "%7s %5s %u %d %n", rpm_set, rsc_type_str, &rsc_id,
		&nelems, &pos);
		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;
		sscanf(cmp, "%5s %n", key_str, &pos);
		if (strlen(key_str) > 4) {
		pr_err("Key value cannot be more than 4 charecters");
		goto err;
		}
		key = string_to_uint(key_str);
		if (!key) {
		pr_err("Key values entered incorrectly\n");
		goto err;
		}

		cmp += pos;
		sscanf(cmp, "%u %n", &data, &pos);
		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");
		else
		pr_info("RPM message sent succesfully\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", S_IWUSR, 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");

drivers/soc/qcom/rpm-smd.c

0 → 100644

+1912 −0

File added.

Preview size limit exceeded, changes collapsed.

include/soc/qcom/rpm-notifier.h

0 → 100644

+63 −0

Original line number	Diff line number	Diff line
		/* Copyright (c) 2012-2014, 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
		* only version 2 as published by the Free Software Foundation.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*
		*/
		#ifndef __ARCH_ARM_MACH_MSM_RPM_NOTIF_H
		#define __ARCH_ARM_MACH_MSM_RPM_NOTIF_H

		struct msm_rpm_notifier_data {
		uint32_t rsc_type;
		uint32_t rsc_id;
		uint32_t key;
		uint32_t size;
		uint8_t *value;
		};
		/**
		* msm_rpm_register_notifier - Register for sleep set notifications
		*
		* @nb - notifier block to register
		*
		* return 0 on success, errno on failure.
		*/
		int msm_rpm_register_notifier(struct notifier_block *nb);

		/**
		* msm_rpm_unregister_notifier - Unregister previously registered notifications
		*
		* @nb - notifier block to unregister
		*
		* return 0 on success, errno on failure.
		*/
		int msm_rpm_unregister_notifier(struct notifier_block *nb);

		/**
		* msm_rpm_enter_sleep - Notify RPM driver to prepare for entering sleep
		*
		* @bool - flag to enable print contents of sleep buffer.
		* @cpumask - cpumask of next wakeup cpu
		*
		* return 0 on success errno on failure.
		*/
		int msm_rpm_enter_sleep(bool print, const struct cpumask *cpumask);

		/**
		* msm_rpm_exit_sleep - Notify RPM driver about resuming from power collapse
		*/
		void msm_rpm_exit_sleep(void);

		/**
		* msm_rpm_waiting_for_ack - Indicate if there is RPM message
		* pending acknowledgement.
		* returns true for pending messages and false otherwise
		*/
		bool msm_rpm_waiting_for_ack(void);

		#endif /__ARCH_ARM_MACH_MSM_RPM_NOTIF_H /