mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-23 17:55:05 +03:00
tegra: nvadsp: Include adsp usage functionality
Adds functionality to calculate adsp cpu usage Inits, loads, starts and resume adsp_lpthread app Bug 1727014 Change-Id: Icaf7a1ba9e91bff19d7fbc894bfdd0f884971d6c Signed-off-by: Hariharan Sivaraman <hariharans@nvidia.com> Reviewed-on: http://git-master/r/1134173 (cherry picked from commit 256bd7180cefa523a9e480be315fbf47b9c8de4f) Signed-off-by: Hariharan Sivaraman <hariharans@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/1564162 Reviewed-by: svc-mobile-coverity <svc-mobile-coverity@nvidia.com> GVS: Gerrit_Virtual_Submit Reviewed-by: Ajay Nandakumar M <anandakumarm@nvidia.com> Reviewed-by: Nitin Pai <npai@nvidia.com> Reviewed-by: mobile promotions <svcmobile_promotions@nvidia.com> Tested-by: mobile promotions <svcmobile_promotions@nvidia.com>
This commit is contained in:
Hariharan Sivaraman
committed by
Laxman Dewangan
Laxman Dewangan
parent
12dc199ff3
commit
b3a66c2476
232
drivers/platform/tegra/nvadsp/adsp_lpthread_proc.c
Normal file
232
drivers/platform/tegra/nvadsp/adsp_lpthread_proc.c
Normal file
@@ -0,0 +1,232 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2017, NVIDIA CORPORATION. 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 as published by
|
||||
* the Free Software Foundation; version 2 of the License.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/debugfs.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/irqchip/tegra-agic.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/spinlock.h>
|
||||
|
||||
#include "dev.h"
|
||||
|
||||
#define RW_MODE (S_IWUSR | S_IRUGO)
|
||||
|
||||
/* #define VERBOSE_OUTPUT_LPTHREAD */
|
||||
|
||||
struct adsp_lpthread {
|
||||
bool lpthread_initialized;
|
||||
bool adsp_os_suspended;
|
||||
bool lpthread_to_be_paused;
|
||||
bool lpthread_to_be_resumed;
|
||||
bool lpthread_to_be_closed;
|
||||
bool lpthread_init_and_closed;
|
||||
};
|
||||
|
||||
static struct adsp_lpthread lpthread_obj;
|
||||
static struct adsp_lpthread *lpthread;
|
||||
|
||||
static int adsp_usage_set(void *data, u64 val)
|
||||
{
|
||||
int ret = 0;
|
||||
switch (val) {
|
||||
case 1:
|
||||
if (lpthread->adsp_os_suspended && !lpthread->lpthread_initialized) {
|
||||
if (lpthread->lpthread_init_and_closed) {
|
||||
lpthread->lpthread_init_and_closed = false;
|
||||
lpthread->lpthread_initialized = true;
|
||||
lpthread->lpthread_to_be_resumed = true;
|
||||
pr_info("App already initialized\n");
|
||||
break;
|
||||
}
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("Starting os\n");
|
||||
#endif
|
||||
if (nvadsp_os_start()) {
|
||||
pr_info("Unable to restart os\n");
|
||||
break;
|
||||
}
|
||||
ret = adsp_lpthread_init(true);
|
||||
lpthread->lpthread_initialized = true;
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("Initialized lpthread. Suspending OS\n");
|
||||
#endif
|
||||
if (nvadsp_os_suspend()) {
|
||||
pr_info("Unable to restart os\n");
|
||||
break;
|
||||
}
|
||||
lpthread->lpthread_to_be_resumed = true;
|
||||
} else if (!lpthread->lpthread_initialized) {
|
||||
if (lpthread->lpthread_init_and_closed) {
|
||||
lpthread->lpthread_init_and_closed = false;
|
||||
lpthread->lpthread_initialized = true;
|
||||
lpthread->lpthread_to_be_resumed = true;
|
||||
pr_info("App already initialized\n");
|
||||
break;
|
||||
}
|
||||
ret = adsp_lpthread_init(lpthread->adsp_os_suspended);
|
||||
lpthread->lpthread_initialized = true;
|
||||
} else if (lpthread->adsp_os_suspended) {
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("App to be resumed\n");
|
||||
#endif
|
||||
lpthread->lpthread_to_be_resumed = true;
|
||||
lpthread->lpthread_to_be_paused = false;
|
||||
ret = 0;
|
||||
} else {
|
||||
ret = adsp_lpthread_resume();
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (lpthread->adsp_os_suspended && lpthread->lpthread_initialized) {
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("App to be paused\n");
|
||||
#endif
|
||||
lpthread->lpthread_to_be_resumed = false;
|
||||
lpthread->lpthread_to_be_paused = true;
|
||||
ret = 0;
|
||||
} else if (lpthread->lpthread_initialized) {
|
||||
ret = adsp_lpthread_pause();
|
||||
} else {
|
||||
pr_info("App not initialized. echo 1 > adsp_usage to init\n");
|
||||
ret = 0;
|
||||
}
|
||||
break;
|
||||
case 0:
|
||||
if (lpthread->adsp_os_suspended && lpthread->lpthread_initialized) {
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("App to be closed\n");
|
||||
#endif
|
||||
lpthread->lpthread_to_be_closed = true;
|
||||
lpthread->lpthread_init_and_closed = true;
|
||||
lpthread->lpthread_initialized = false;
|
||||
lpthread->lpthread_to_be_resumed = false;
|
||||
ret = 0;
|
||||
} else if (lpthread->lpthread_initialized) {
|
||||
ret = adsp_lpthread_exit();
|
||||
lpthread->lpthread_initialized = false;
|
||||
} else {
|
||||
pr_info("App not initialized. echo 1 > adsp_usage to init\n");
|
||||
ret = 0;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
pr_info("Invalid input\n");
|
||||
pr_info("echo 1 > adsp_usage to init/resume\n");
|
||||
pr_info("echo 2 > adsp_usage to pause\n");
|
||||
pr_info("echo 0 > adsp_usage to stop\n");
|
||||
ret = 0;
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int adsp_usage_get(void *data, u64 *val)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
DEFINE_SIMPLE_ATTRIBUTE(adsp_usage_fops, adsp_usage_get, adsp_usage_set, "%llu\n");
|
||||
|
||||
static int lpthread_debugfs_init(struct nvadsp_drv_data *drv)
|
||||
{
|
||||
int ret = -ENOMEM;
|
||||
struct dentry *d, *dir;
|
||||
|
||||
if (!drv->adsp_debugfs_root)
|
||||
return ret;
|
||||
dir = debugfs_create_dir("adsp_lpthread", drv->adsp_debugfs_root);
|
||||
if (!dir)
|
||||
return ret;
|
||||
|
||||
d = debugfs_create_file(
|
||||
"adsp_usage", RW_MODE, dir, NULL, &adsp_usage_fops);
|
||||
if (!d)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int adsp_lpthread_debugfs_init(struct platform_device *pdev)
|
||||
{
|
||||
struct nvadsp_drv_data *drv = platform_get_drvdata(pdev);
|
||||
int ret = -EINVAL;
|
||||
|
||||
lpthread = &lpthread_obj;
|
||||
|
||||
ret = lpthread_debugfs_init(drv);
|
||||
if (!ret)
|
||||
pr_info(" lpthread_debugfs_init() ret = %d\n", ret);
|
||||
|
||||
drv->lpthread_initialized = true;
|
||||
lpthread->adsp_os_suspended = false;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int adsp_lpthread_debugfs_exit(struct platform_device *pdev)
|
||||
{
|
||||
status_t ret = 0;
|
||||
struct nvadsp_drv_data *drv = platform_get_drvdata(pdev);
|
||||
|
||||
if (!drv->lpthread_initialized)
|
||||
ret = -EINVAL;
|
||||
drv->lpthread_initialized = false;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int adsp_lpthread_debugfs_set_suspend(bool is_suspended)
|
||||
{
|
||||
lpthread->adsp_os_suspended = is_suspended;
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("ADSP_OS_SUSPENDED = %d\n", (int)is_suspended);
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
|
||||
int adsp_lpthread_debugfs_callback(void)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
if (lpthread->lpthread_initialized) {
|
||||
if (lpthread->lpthread_to_be_resumed) {
|
||||
lpthread->lpthread_to_be_resumed = false;
|
||||
ret = adsp_lpthread_resume();
|
||||
} else if (lpthread->lpthread_to_be_paused) {
|
||||
lpthread->lpthread_to_be_paused = false;
|
||||
ret = adsp_lpthread_pause();
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (lpthread->lpthread_to_be_closed) {
|
||||
lpthread->lpthread_to_be_closed = false;
|
||||
lpthread->lpthread_init_and_closed = false;
|
||||
ret = adsp_lpthread_exit();
|
||||
return ret;
|
||||
}
|
||||
|
||||
#ifdef VERBOSE_OUTPUT_LPTHREAD
|
||||
pr_info("to_be_paused = %d\n", (int)lpthread->lpthread_to_be_paused);
|
||||
pr_info("to_be_resumed = %d\n", (int)lpthread->lpthread_to_be_resumed);
|
||||
pr_info("to_be_closed = %d\n", (int)lpthread->lpthread_to_be_closed);
|
||||
pr_info("init_and_closed = %d\n", (int)lpthread->lpthread_init_and_closed);
|
||||
pr_info("initialized = %d\n", (int)lpthread->lpthread_initialized);
|
||||
#endif
|
||||
|
||||
return ret;
|
||||
}
|
||||
Reference in New Issue
Block a user