2019-10-01 17:30:35 -04:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
|
|
|
/*
|
2020-01-13 21:40:45 -05:00
|
|
|
* Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
|
2019-10-01 17:30:35 -04:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/debugfs.h>
|
|
|
|
#include <linux/dma-mapping.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/ioctl.h>
|
|
|
|
#include <linux/list.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/of_platform.h>
|
|
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/version.h>
|
|
|
|
#include <linux/io.h>
|
|
|
|
#include "msm_cvp_core.h"
|
|
|
|
#include "msm_cvp_common.h"
|
|
|
|
#include "msm_cvp_debug.h"
|
|
|
|
#include "msm_cvp_internal.h"
|
|
|
|
#include "msm_cvp_res_parse.h"
|
|
|
|
#include "msm_cvp_resources.h"
|
|
|
|
#include "cvp_hfi_api.h"
|
|
|
|
#include "cvp_private.h"
|
|
|
|
#include "msm_cvp_clocks.h"
|
|
|
|
#include "msm_cvp_dsp.h"
|
|
|
|
|
|
|
|
#define CLASS_NAME "cvp"
|
|
|
|
#define DRIVER_NAME "cvp"
|
|
|
|
|
|
|
|
struct msm_cvp_drv *cvp_driver;
|
|
|
|
|
|
|
|
static int cvp_open(struct inode *inode, struct file *filp)
|
|
|
|
{
|
|
|
|
struct msm_cvp_core *core = container_of(inode->i_cdev,
|
|
|
|
struct msm_cvp_core, cdev);
|
|
|
|
struct msm_cvp_inst *inst;
|
|
|
|
|
2020-04-13 21:01:34 -04:00
|
|
|
dprintk(CVP_SESS, "%s: Enter\n", __func__);
|
2019-10-01 17:30:35 -04:00
|
|
|
|
|
|
|
inst = msm_cvp_open(core->id, MSM_CVP_USER);
|
2020-01-13 21:40:45 -05:00
|
|
|
if (!inst) {
|
|
|
|
dprintk(CVP_ERR, "Failed to create cvp instance\n");
|
2019-10-01 17:30:35 -04:00
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
filp->private_data = inst;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int cvp_close(struct inode *inode, struct file *filp)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
struct msm_cvp_inst *inst = filp->private_data;
|
|
|
|
|
|
|
|
rc = msm_cvp_close(inst);
|
|
|
|
filp->private_data = NULL;
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned int cvp_poll(struct file *filp, struct poll_table_struct *p)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
struct msm_cvp_inst *inst = filp->private_data;
|
|
|
|
unsigned long flags = 0;
|
|
|
|
|
|
|
|
poll_wait(filp, &inst->event_handler.wq, p);
|
|
|
|
|
|
|
|
spin_lock_irqsave(&inst->event_handler.lock, flags);
|
|
|
|
if (inst->event_handler.event == CVP_SSR_EVENT)
|
|
|
|
rc |= POLLPRI;
|
|
|
|
spin_unlock_irqrestore(&inst->event_handler.lock, flags);
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct file_operations cvp_fops = {
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.open = cvp_open,
|
|
|
|
.release = cvp_close,
|
|
|
|
.unlocked_ioctl = cvp_unblocked_ioctl,
|
|
|
|
.compat_ioctl = cvp_compat_ioctl,
|
|
|
|
.poll = cvp_poll,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int read_platform_resources(struct msm_cvp_core *core,
|
|
|
|
struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
|
|
|
|
if (!core || !pdev) {
|
|
|
|
dprintk(CVP_ERR, "%s: Invalid params %pK %pK\n",
|
|
|
|
__func__, core, pdev);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
core->hfi_type = CVP_HFI_IRIS;
|
|
|
|
core->resources.pdev = pdev;
|
|
|
|
if (pdev->dev.of_node) {
|
|
|
|
/* Target supports DT, parse from it */
|
|
|
|
rc = cvp_read_platform_resources_from_drv_data(core);
|
|
|
|
rc = cvp_read_platform_resources_from_dt(&core->resources);
|
|
|
|
} else {
|
|
|
|
dprintk(CVP_ERR, "pdev node is NULL\n");
|
|
|
|
rc = -EINVAL;
|
|
|
|
}
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
2020-06-04 20:46:42 -04:00
|
|
|
static void init_cycle_info(struct cvp_cycle_info *info)
|
|
|
|
{
|
|
|
|
memset(info->sum_fps, 0, HFI_MAX_HW_THREADS*sizeof(u32));
|
|
|
|
memset(info->hi_ctrl_lim, 0, HFI_MAX_HW_THREADS*sizeof(u32));
|
|
|
|
memset(info->lo_ctrl_lim, 0, HFI_MAX_HW_THREADS*sizeof(u32));
|
|
|
|
memset(info->cycle, 0,
|
|
|
|
HFI_MAX_HW_THREADS*sizeof(struct cvp_cycle_stat));
|
|
|
|
info->conf_freq = 0;
|
|
|
|
}
|
|
|
|
|
2019-10-01 17:30:35 -04:00
|
|
|
static int msm_cvp_initialize_core(struct platform_device *pdev,
|
|
|
|
struct msm_cvp_core *core)
|
|
|
|
{
|
|
|
|
int i = 0;
|
|
|
|
int rc = 0;
|
|
|
|
|
|
|
|
if (!core)
|
|
|
|
return -EINVAL;
|
|
|
|
rc = read_platform_resources(core, pdev);
|
|
|
|
if (rc) {
|
|
|
|
dprintk(CVP_ERR, "Failed to get platform resources\n");
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&core->instances);
|
|
|
|
mutex_init(&core->lock);
|
2020-08-17 15:05:22 -04:00
|
|
|
mutex_init(&core->clk_lock);
|
2019-10-01 17:30:35 -04:00
|
|
|
|
|
|
|
core->state = CVP_CORE_UNINIT;
|
|
|
|
for (i = SYS_MSG_INDEX(SYS_MSG_START);
|
|
|
|
i <= SYS_MSG_INDEX(SYS_MSG_END); i++) {
|
|
|
|
init_completion(&core->completions[i]);
|
|
|
|
}
|
|
|
|
|
|
|
|
INIT_DELAYED_WORK(&core->fw_unload_work, msm_cvp_fw_unload_handler);
|
|
|
|
INIT_WORK(&core->ssr_work, msm_cvp_ssr_handler);
|
2020-06-04 20:46:42 -04:00
|
|
|
init_cycle_info(&core->dyn_clk);
|
2019-10-01 17:30:35 -04:00
|
|
|
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t link_name_show(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
char *buf)
|
|
|
|
{
|
|
|
|
struct msm_cvp_core *core = dev_get_drvdata(dev);
|
|
|
|
|
|
|
|
if (core)
|
|
|
|
if (dev == core->dev)
|
|
|
|
return snprintf(buf, PAGE_SIZE, "msm_cvp\n");
|
|
|
|
else
|
|
|
|
return 0;
|
|
|
|
else
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static DEVICE_ATTR_RO(link_name);
|
|
|
|
|
|
|
|
static ssize_t pwr_collapse_delay_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
unsigned long val = 0;
|
|
|
|
int rc = 0;
|
|
|
|
struct msm_cvp_core *core = NULL;
|
|
|
|
|
|
|
|
rc = kstrtoul(buf, 0, &val);
|
|
|
|
if (rc)
|
|
|
|
return rc;
|
|
|
|
else if (!val)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
core = get_cvp_core(MSM_CORE_CVP);
|
|
|
|
if (!core)
|
|
|
|
return -EINVAL;
|
|
|
|
core->resources.msm_cvp_pwr_collapse_delay = val;
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t pwr_collapse_delay_show(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
char *buf)
|
|
|
|
{
|
|
|
|
struct msm_cvp_core *core = NULL;
|
|
|
|
|
|
|
|
core = get_cvp_core(MSM_CORE_CVP);
|
|
|
|
if (!core)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
return snprintf(buf, PAGE_SIZE, "%u\n",
|
|
|
|
core->resources.msm_cvp_pwr_collapse_delay);
|
|
|
|
}
|
|
|
|
|
|
|
|
static DEVICE_ATTR_RW(pwr_collapse_delay);
|
|
|
|
|
|
|
|
static ssize_t thermal_level_show(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
char *buf)
|
|
|
|
{
|
|
|
|
return snprintf(buf, PAGE_SIZE, "%d\n", cvp_driver->thermal_level);
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t thermal_level_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
int rc = 0, val = 0;
|
|
|
|
|
|
|
|
rc = kstrtoint(buf, 0, &val);
|
|
|
|
if (rc || val < 0) {
|
|
|
|
dprintk(CVP_WARN,
|
|
|
|
"Invalid thermal level value: %s\n", buf);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2020-04-13 21:01:34 -04:00
|
|
|
dprintk(CVP_PWR, "Thermal level old %d new %d\n",
|
2019-10-01 17:30:35 -04:00
|
|
|
cvp_driver->thermal_level, val);
|
|
|
|
|
|
|
|
if (val == cvp_driver->thermal_level)
|
|
|
|
return count;
|
|
|
|
cvp_driver->thermal_level = val;
|
|
|
|
|
|
|
|
msm_cvp_comm_handle_thermal_event();
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static DEVICE_ATTR_RW(thermal_level);
|
|
|
|
|
|
|
|
static ssize_t sku_version_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buf)
|
|
|
|
{
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "%d",
|
|
|
|
cvp_driver->sku_version);
|
|
|
|
}
|
|
|
|
|
|
|
|
static DEVICE_ATTR_RO(sku_version);
|
|
|
|
|
|
|
|
static ssize_t boot_store(struct device *dev,
|
|
|
|
struct device_attribute *attr,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
int rc = 0, val = 0;
|
|
|
|
static int booted;
|
|
|
|
|
|
|
|
rc = kstrtoint(buf, 0, &val);
|
|
|
|
if (rc || val < 0) {
|
|
|
|
dprintk(CVP_WARN,
|
|
|
|
"Invalid boot value: %s\n", buf);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (val > 0 && booted == 0) {
|
|
|
|
struct msm_cvp_inst *inst;
|
|
|
|
|
|
|
|
inst = msm_cvp_open(MSM_CORE_CVP, MSM_CVP_BOOT);
|
|
|
|
if (!inst) {
|
|
|
|
dprintk(CVP_ERR,
|
|
|
|
"Failed to create cvp instance\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
rc = msm_cvp_close(inst);
|
|
|
|
if (rc) {
|
|
|
|
dprintk(CVP_ERR,
|
|
|
|
"Failed to close cvp instance\n");
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
booted = 1;
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static DEVICE_ATTR_WO(boot);
|
|
|
|
|
|
|
|
static struct attribute *msm_cvp_core_attrs[] = {
|
|
|
|
&dev_attr_pwr_collapse_delay.attr,
|
|
|
|
&dev_attr_thermal_level.attr,
|
|
|
|
&dev_attr_sku_version.attr,
|
|
|
|
&dev_attr_link_name.attr,
|
|
|
|
&dev_attr_boot.attr,
|
|
|
|
NULL
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct attribute_group msm_cvp_core_attr_group = {
|
|
|
|
.attrs = msm_cvp_core_attrs,
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct of_device_id msm_cvp_plat_match[] = {
|
|
|
|
{.compatible = "qcom,msm-cvp"},
|
|
|
|
{.compatible = "qcom,msm-cvp,context-bank"},
|
|
|
|
{.compatible = "qcom,msm-cvp,bus"},
|
|
|
|
{.compatible = "qcom,msm-cvp,mem-cdsp"},
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
|
|
|
|
static int msm_probe_cvp_device(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
struct msm_cvp_core *core;
|
|
|
|
|
|
|
|
if (!cvp_driver) {
|
|
|
|
dprintk(CVP_ERR, "Invalid cvp driver\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
core = kzalloc(sizeof(*core), GFP_KERNEL);
|
|
|
|
if (!core)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
core->platform_data = cvp_get_drv_data(&pdev->dev);
|
|
|
|
dev_set_drvdata(&pdev->dev, core);
|
|
|
|
rc = msm_cvp_initialize_core(pdev, core);
|
|
|
|
if (rc) {
|
|
|
|
dprintk(CVP_ERR, "Failed to init core\n");
|
|
|
|
goto err_core_init;
|
|
|
|
}
|
|
|
|
|
|
|
|
core->id = MSM_CORE_CVP;
|
|
|
|
|
|
|
|
rc = alloc_chrdev_region(&core->dev_num, 0, 1, DRIVER_NAME);
|
|
|
|
if (rc < 0) {
|
|
|
|
dprintk(CVP_ERR, "alloc_chrdev_region failed: %d\n",
|
|
|
|
rc);
|
|
|
|
goto err_alloc_chrdev;
|
|
|
|
}
|
|
|
|
|
|
|
|
core->class = class_create(THIS_MODULE, CLASS_NAME);
|
|
|
|
if (IS_ERR(core->class)) {
|
|
|
|
rc = PTR_ERR(core->class);
|
|
|
|
dprintk(CVP_ERR, "class_create failed: %d\n",
|
|
|
|
rc);
|
|
|
|
goto err_class_create;
|
|
|
|
}
|
|
|
|
|
|
|
|
core->dev = device_create(core->class, NULL,
|
|
|
|
core->dev_num, NULL, DRIVER_NAME);
|
|
|
|
if (IS_ERR(core->dev)) {
|
|
|
|
rc = PTR_ERR(core->dev);
|
|
|
|
dprintk(CVP_ERR, "device_create failed: %d\n",
|
|
|
|
rc);
|
|
|
|
goto err_device_create;
|
|
|
|
}
|
|
|
|
dev_set_drvdata(core->dev, core);
|
|
|
|
|
|
|
|
cdev_init(&core->cdev, &cvp_fops);
|
|
|
|
rc = cdev_add(&core->cdev,
|
|
|
|
MKDEV(MAJOR(core->dev_num), 0), 1);
|
|
|
|
if (rc < 0) {
|
|
|
|
dprintk(CVP_ERR, "cdev_add failed: %d\n",
|
|
|
|
rc);
|
|
|
|
goto error_cdev_add;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* finish setting up the 'core' */
|
|
|
|
mutex_lock(&cvp_driver->lock);
|
|
|
|
if (cvp_driver->num_cores + 1 > MSM_CVP_CORES_MAX) {
|
|
|
|
mutex_unlock(&cvp_driver->lock);
|
|
|
|
dprintk(CVP_ERR, "Maximum cores already exist, core_no = %d\n",
|
|
|
|
cvp_driver->num_cores);
|
|
|
|
goto err_cores_exceeded;
|
|
|
|
}
|
|
|
|
cvp_driver->num_cores++;
|
|
|
|
mutex_unlock(&cvp_driver->lock);
|
|
|
|
|
|
|
|
rc = sysfs_create_group(&core->dev->kobj, &msm_cvp_core_attr_group);
|
|
|
|
if (rc) {
|
|
|
|
dprintk(CVP_ERR,
|
|
|
|
"Failed to create attributes\n");
|
|
|
|
goto err_cores_exceeded;
|
|
|
|
}
|
|
|
|
|
|
|
|
core->device = cvp_hfi_initialize(core->hfi_type, core->id,
|
|
|
|
&core->resources, &cvp_handle_cmd_response);
|
|
|
|
if (IS_ERR_OR_NULL(core->device)) {
|
|
|
|
mutex_lock(&cvp_driver->lock);
|
|
|
|
cvp_driver->num_cores--;
|
|
|
|
mutex_unlock(&cvp_driver->lock);
|
|
|
|
|
|
|
|
rc = PTR_ERR(core->device) ?: -EBADHANDLE;
|
|
|
|
if (rc != -EPROBE_DEFER)
|
|
|
|
dprintk(CVP_ERR, "Failed to create HFI device\n");
|
|
|
|
else
|
2020-04-13 21:01:34 -04:00
|
|
|
dprintk(CVP_CORE, "msm_cvp: request probe defer\n");
|
2019-10-01 17:30:35 -04:00
|
|
|
goto err_hfi_initialize;
|
|
|
|
}
|
|
|
|
|
|
|
|
mutex_lock(&cvp_driver->lock);
|
|
|
|
list_add_tail(&core->list, &cvp_driver->cores);
|
|
|
|
mutex_unlock(&cvp_driver->lock);
|
|
|
|
|
|
|
|
core->debugfs_root = msm_cvp_debugfs_init_core(
|
|
|
|
core, cvp_driver->debugfs_root);
|
|
|
|
|
|
|
|
cvp_driver->sku_version = core->resources.sku_version;
|
|
|
|
|
2020-04-13 21:01:34 -04:00
|
|
|
dprintk(CVP_CORE, "populating sub devices\n");
|
2019-10-01 17:30:35 -04:00
|
|
|
/*
|
|
|
|
* Trigger probe for each sub-device i.e. qcom,msm-cvp,context-bank.
|
|
|
|
* When msm_cvp_probe is called for each sub-device, parse the
|
|
|
|
* context-bank details and store it in core->resources.context_banks
|
|
|
|
* list.
|
|
|
|
*/
|
|
|
|
rc = of_platform_populate(pdev->dev.of_node, msm_cvp_plat_match, NULL,
|
|
|
|
&pdev->dev);
|
|
|
|
if (rc) {
|
|
|
|
dprintk(CVP_ERR, "Failed to trigger probe for sub-devices\n");
|
|
|
|
goto err_fail_sub_device_probe;
|
|
|
|
}
|
|
|
|
|
|
|
|
atomic64_set(&core->kernel_trans_id, 0);
|
|
|
|
|
2020-03-30 19:04:08 -04:00
|
|
|
rc = cvp_dsp_device_init();
|
|
|
|
if (rc)
|
|
|
|
dprintk(CVP_WARN, "Failed to initialize DSP driver\n");
|
|
|
|
|
2019-10-01 17:30:35 -04:00
|
|
|
return rc;
|
|
|
|
|
|
|
|
err_fail_sub_device_probe:
|
|
|
|
cvp_hfi_deinitialize(core->hfi_type, core->device);
|
|
|
|
err_hfi_initialize:
|
|
|
|
err_cores_exceeded:
|
|
|
|
cdev_del(&core->cdev);
|
|
|
|
error_cdev_add:
|
|
|
|
device_destroy(core->class, core->dev_num);
|
|
|
|
err_device_create:
|
|
|
|
class_destroy(core->class);
|
|
|
|
err_class_create:
|
|
|
|
unregister_chrdev_region(core->dev_num, 1);
|
|
|
|
err_alloc_chrdev:
|
|
|
|
sysfs_remove_group(&pdev->dev.kobj, &msm_cvp_core_attr_group);
|
|
|
|
err_core_init:
|
|
|
|
dev_set_drvdata(&pdev->dev, NULL);
|
|
|
|
kfree(core);
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_probe_mem_cdsp(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
return cvp_read_mem_cdsp_resources_from_dt(pdev);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_probe_context_bank(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
return cvp_read_context_bank_resources_from_dt(pdev);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_probe_bus(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
return cvp_read_bus_resources_from_dt(pdev);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_probe(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
/*
|
|
|
|
* Sub devices probe will be triggered by of_platform_populate() towards
|
|
|
|
* the end of the probe function after msm-cvp device probe is
|
|
|
|
* completed. Return immediately after completing sub-device probe.
|
|
|
|
*/
|
|
|
|
if (of_device_is_compatible(pdev->dev.of_node, "qcom,msm-cvp")) {
|
|
|
|
return msm_probe_cvp_device(pdev);
|
|
|
|
} else if (of_device_is_compatible(pdev->dev.of_node,
|
|
|
|
"qcom,msm-cvp,bus")) {
|
|
|
|
return msm_cvp_probe_bus(pdev);
|
|
|
|
} else if (of_device_is_compatible(pdev->dev.of_node,
|
|
|
|
"qcom,msm-cvp,context-bank")) {
|
|
|
|
return msm_cvp_probe_context_bank(pdev);
|
|
|
|
} else if (of_device_is_compatible(pdev->dev.of_node,
|
|
|
|
"qcom,msm-cvp,mem-cdsp")) {
|
|
|
|
return msm_cvp_probe_mem_cdsp(pdev);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* How did we end up here? */
|
|
|
|
MSM_CVP_ERROR(1);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_remove(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
struct msm_cvp_core *core;
|
|
|
|
|
|
|
|
if (!pdev) {
|
|
|
|
dprintk(CVP_ERR, "%s invalid input %pK", __func__, pdev);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
core = dev_get_drvdata(&pdev->dev);
|
|
|
|
if (!core) {
|
|
|
|
dprintk(CVP_ERR, "%s invalid core", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
cvp_hfi_deinitialize(core->hfi_type, core->device);
|
|
|
|
msm_cvp_free_platform_resources(&core->resources);
|
|
|
|
sysfs_remove_group(&pdev->dev.kobj, &msm_cvp_core_attr_group);
|
|
|
|
dev_set_drvdata(&pdev->dev, NULL);
|
|
|
|
mutex_destroy(&core->lock);
|
2020-08-17 15:05:22 -04:00
|
|
|
mutex_destroy(&core->clk_lock);
|
2019-10-01 17:30:35 -04:00
|
|
|
kfree(core);
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_pm_suspend(struct device *dev)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
struct msm_cvp_core *core;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Bail out if
|
|
|
|
* - driver possibly not probed yet
|
|
|
|
* - not the main device. We don't support power management on
|
|
|
|
* subdevices (e.g. context banks)
|
|
|
|
*/
|
|
|
|
if (!dev || !dev->driver ||
|
|
|
|
!of_device_is_compatible(dev->of_node, "qcom,msm-cvp"))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
core = dev_get_drvdata(dev);
|
|
|
|
if (!core) {
|
|
|
|
dprintk(CVP_ERR, "%s invalid core\n", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
rc = msm_cvp_suspend(core->id);
|
|
|
|
if (rc == -ENOTSUPP)
|
|
|
|
rc = 0;
|
|
|
|
else if (rc)
|
|
|
|
dprintk(CVP_WARN, "Failed to suspend: %d\n", rc);
|
|
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int msm_cvp_pm_resume(struct device *dev)
|
|
|
|
{
|
|
|
|
dprintk(CVP_INFO, "%s\n", __func__);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct dev_pm_ops msm_cvp_pm_ops = {
|
|
|
|
SET_SYSTEM_SLEEP_PM_OPS(msm_cvp_pm_suspend, msm_cvp_pm_resume)
|
|
|
|
};
|
|
|
|
|
|
|
|
MODULE_DEVICE_TABLE(of, msm_cvp_plat_match);
|
|
|
|
|
|
|
|
static struct platform_driver msm_cvp_driver = {
|
|
|
|
.probe = msm_cvp_probe,
|
|
|
|
.remove = msm_cvp_remove,
|
|
|
|
.driver = {
|
|
|
|
.name = "msm_cvp",
|
|
|
|
.of_match_table = msm_cvp_plat_match,
|
|
|
|
.pm = &msm_cvp_pm_ops,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init msm_cvp_init(void)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
|
2020-01-13 21:40:45 -05:00
|
|
|
cvp_driver = kzalloc(sizeof(*cvp_driver), GFP_KERNEL);
|
2019-10-01 17:30:35 -04:00
|
|
|
if (!cvp_driver) {
|
|
|
|
dprintk(CVP_ERR,
|
|
|
|
"Failed to allocate memroy for msm_cvp_drv\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&cvp_driver->cores);
|
|
|
|
mutex_init(&cvp_driver->lock);
|
|
|
|
cvp_driver->debugfs_root = msm_cvp_debugfs_init_drv();
|
|
|
|
if (!cvp_driver->debugfs_root)
|
|
|
|
dprintk(CVP_ERR,
|
|
|
|
"Failed to create debugfs for msm_cvp\n");
|
|
|
|
|
|
|
|
rc = platform_driver_register(&msm_cvp_driver);
|
|
|
|
if (rc) {
|
|
|
|
dprintk(CVP_ERR,
|
|
|
|
"Failed to register platform driver\n");
|
|
|
|
debugfs_remove_recursive(cvp_driver->debugfs_root);
|
|
|
|
kfree(cvp_driver);
|
|
|
|
cvp_driver = NULL;
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
cvp_driver->msg_cache = KMEM_CACHE(cvp_session_msg, 0);
|
|
|
|
cvp_driver->frame_cache = KMEM_CACHE(msm_cvp_frame, 0);
|
2020-01-29 14:54:22 -05:00
|
|
|
cvp_driver->buf_cache = KMEM_CACHE(cvp_internal_buf, 0);
|
|
|
|
cvp_driver->smem_cache = KMEM_CACHE(msm_cvp_smem, 0);
|
2019-10-01 17:30:35 -04:00
|
|
|
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit msm_cvp_exit(void)
|
|
|
|
{
|
|
|
|
cvp_dsp_device_exit();
|
|
|
|
kmem_cache_destroy(cvp_driver->msg_cache);
|
|
|
|
kmem_cache_destroy(cvp_driver->frame_cache);
|
2020-01-29 14:54:22 -05:00
|
|
|
kmem_cache_destroy(cvp_driver->buf_cache);
|
|
|
|
kmem_cache_destroy(cvp_driver->smem_cache);
|
2019-10-01 17:30:35 -04:00
|
|
|
|
|
|
|
platform_driver_unregister(&msm_cvp_driver);
|
|
|
|
debugfs_remove_recursive(cvp_driver->debugfs_root);
|
|
|
|
mutex_destroy(&cvp_driver->lock);
|
|
|
|
kfree(cvp_driver);
|
|
|
|
cvp_driver = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(msm_cvp_init);
|
|
|
|
module_exit(msm_cvp_exit);
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL v2");
|