Loading drivers/char/Kconfig +8 −0 Original line number Diff line number Diff line Loading @@ -589,6 +589,14 @@ config TILE_SROM source "drivers/char/xillybus/Kconfig" source "drivers/char/diag/Kconfig" config MSM_FASTCVPD bool "QTI FASTCVP driver" depends on QCOM_GLINK help This driver exposes APIs to video driver to share HFI command queue address to CDSP and handle errors to exit gracefully in case video and cdsp subsystems crash. config MSM_ADSPRPC tristate "QTI ADSP RPC driver" depends on QCOM_GLINK Loading drivers/char/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -65,3 +65,4 @@ obj-$(CONFIG_MSM_ADSPRPC) += adsprpc.o ifdef CONFIG_COMPAT obj-$(CONFIG_MSM_ADSPRPC) += adsprpc_compat.o endif obj-$(CONFIG_MSM_FASTCVPD) += fastcvpd.o No newline at end of file drivers/char/fastcvpd.c 0 → 100644 +197 −0 Original line number Diff line number Diff line /* * Copyright (c) 2018, 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. * */ #include <linux/module.h> #include <linux/rpmsg.h> #include <linux/of_platform.h> #include "linux/fastcvpd.h" #define FASTCVPD_VIDEO_SEND_HFI_CMD_QUEUE 0 #define FASTCVPD_VIDEO_SUSPEND 1 #define FASTCVPD_VIDEO_RESUME 2 #define FASTCVPD_VIDEO_SHUTDOWN 3 struct fastcvpd_cmd_msg { uint32_t cmd_msg_type; int ret_val; uint64_t msg_ptr; uint32_t msg_ptr_len; }; struct fastcvpd_apps { struct rpmsg_device *chan; struct mutex smd_mutex; int rpmsg_register; }; static struct fastcvpd_apps gfa_cv; static int fastcvpd_send_cmd(void *msg, uint32_t len) { struct fastcvpd_apps *me = &gfa_cv; int err; if (IS_ERR_OR_NULL(me->chan)) { err = -EINVAL; goto bail; } err = rpmsg_send(me->chan->ept, msg, len); bail: return err; } static int fastcvpd_rpmsg_probe(struct rpmsg_device *rpdev) { int err = 0; struct fastcvpd_apps *me = &gfa_cv; if (strcmp(rpdev->dev.parent->of_node->name, "cdsp")) { pr_err("%s: Failed to probe rpmsg device.Node name:%s\n", __func__, rpdev->dev.parent->of_node->name); err = -EINVAL; goto bail; } mutex_lock(&me->smd_mutex); me->chan = rpdev; mutex_unlock(&me->smd_mutex); pr_debug("%s: Successfully probed\n", __func__); bail: return err; } static void fastcvpd_rpmsg_remove(struct rpmsg_device *rpdev) { struct fastcvpd_apps *me = &gfa_cv; mutex_lock(&me->smd_mutex); me->chan = NULL; mutex_unlock(&me->smd_mutex); } static int fastcvpd_rpmsg_callback(struct rpmsg_device *rpdev, void *data, int len, void *priv, u32 addr) { return 0; } int fastcvpd_video_send_cmd_hfi_queue(phys_addr_t *phys_addr, uint32_t size_in_bytes) { int err; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_SEND_HFI_CMD_QUEUE; cmd_msg.msg_ptr = (uint64_t)phys_addr; cmd_msg.msg_ptr_len = size_in_bytes; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_send_cmd_hfi_queue); int fastcvpd_video_suspend(uint32_t session_flag) { int err = 0; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_SUSPEND; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_suspend); int fastcvpd_video_resume(uint32_t session_flag) { int err; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_RESUME; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_resume); int fastcvpd_video_shutdown(uint32_t session_flag) { int err; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_SHUTDOWN; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_shutdown); static const struct rpmsg_device_id fastcvpd_rpmsg_match[] = { { FASTCVPD_GLINK_GUID }, { }, }; static struct rpmsg_driver fastcvpd_rpmsg_client = { .id_table = fastcvpd_rpmsg_match, .probe = fastcvpd_rpmsg_probe, .remove = fastcvpd_rpmsg_remove, .callback = fastcvpd_rpmsg_callback, .drv = { .name = "qcom,msm_fastcvpd_rpmsg", }, }; static int __init fastcvpd_device_init(void) { struct fastcvpd_apps *me = &gfa_cv; int err; mutex_init(&me->smd_mutex); err = register_rpmsg_driver(&fastcvpd_rpmsg_client); if (err) { pr_err("%s : register_rpmsg_driver failed with err %d\n", __func__, err); goto register_bail; } me->rpmsg_register = 1; return 0; register_bail: return err; } static void __exit fastcvpd_device_exit(void) { struct fastcvpd_apps *me = &gfa_cv; if (me->rpmsg_register == 1) unregister_rpmsg_driver(&fastcvpd_rpmsg_client); } late_initcall(fastcvpd_device_init); module_exit(fastcvpd_device_exit); MODULE_LICENSE("GPL v2"); include/linux/fastcvpd.h 0 → 100644 +89 −0 Original line number Diff line number Diff line /* * Copyright (c) 2018, 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 FASTCVPD_H #define FASTCVPD_H #include <linux/types.h> #define FASTCVPD_GLINK_GUID "fastcvpd-glink-apps-dsp" #define FASTCVPD_SMD_GUID "fastcvpd-smd-apps-dsp" #define FASTCVPD_DEVICE_NAME "fastcvpd-smd" #ifdef CONFIG_MSM_FASTCVPD /* * API for Video driver to send physical address to FastCVP driver * @param phys_addr * Physical address of command message queue * that needs to be mapped to CDSP. * It should be allocated from CMA adsp_mem region. * * @param size_in_bytes * Size in bytes of command message queue */ int fastcvpd_video_send_cmd_hfi_queue(phys_addr_t *phys_addr, uint32_t size_in_bytes); /* * API for Video driver to suspend CVP session during * power collapse * * @param session_flag * Flag to share details of session. */ int fastcvpd_video_suspend(uint32_t session_flag); /* * API for Video driver to resume CVP session during * power collapse * * @param session_flag * Flag to share details of session. */ int fastcvpd_video_resume(uint32_t session_flag); /* * API for Video driver to shutdown CVP session during * video subsystem error. * * @param session_flag * Flag to share details of session. */ int fastcvpd_video_shutdown(uint32_t session_flag); #else static inline int fastcvpd_video_send_cmd_hfi_queue( phys_addr_t *phys_addr, uint32_t size_in_bytes) { return -ENODEV; } static inline int fastcvpd_video_suspend(uint32_t session_flag) { return -ENODEV; } static inline int fastcvpd_video_suspend(uint32_t session_flag) { return -ENODEV; } static inline int fastcvpd_video_resume(uint32_t session_flag) { return -ENODEV; } #endif // CONFIG_FASTCVPD #endif // FASTCVPD_H Loading
drivers/char/Kconfig +8 −0 Original line number Diff line number Diff line Loading @@ -589,6 +589,14 @@ config TILE_SROM source "drivers/char/xillybus/Kconfig" source "drivers/char/diag/Kconfig" config MSM_FASTCVPD bool "QTI FASTCVP driver" depends on QCOM_GLINK help This driver exposes APIs to video driver to share HFI command queue address to CDSP and handle errors to exit gracefully in case video and cdsp subsystems crash. config MSM_ADSPRPC tristate "QTI ADSP RPC driver" depends on QCOM_GLINK Loading
drivers/char/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -65,3 +65,4 @@ obj-$(CONFIG_MSM_ADSPRPC) += adsprpc.o ifdef CONFIG_COMPAT obj-$(CONFIG_MSM_ADSPRPC) += adsprpc_compat.o endif obj-$(CONFIG_MSM_FASTCVPD) += fastcvpd.o No newline at end of file
drivers/char/fastcvpd.c 0 → 100644 +197 −0 Original line number Diff line number Diff line /* * Copyright (c) 2018, 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. * */ #include <linux/module.h> #include <linux/rpmsg.h> #include <linux/of_platform.h> #include "linux/fastcvpd.h" #define FASTCVPD_VIDEO_SEND_HFI_CMD_QUEUE 0 #define FASTCVPD_VIDEO_SUSPEND 1 #define FASTCVPD_VIDEO_RESUME 2 #define FASTCVPD_VIDEO_SHUTDOWN 3 struct fastcvpd_cmd_msg { uint32_t cmd_msg_type; int ret_val; uint64_t msg_ptr; uint32_t msg_ptr_len; }; struct fastcvpd_apps { struct rpmsg_device *chan; struct mutex smd_mutex; int rpmsg_register; }; static struct fastcvpd_apps gfa_cv; static int fastcvpd_send_cmd(void *msg, uint32_t len) { struct fastcvpd_apps *me = &gfa_cv; int err; if (IS_ERR_OR_NULL(me->chan)) { err = -EINVAL; goto bail; } err = rpmsg_send(me->chan->ept, msg, len); bail: return err; } static int fastcvpd_rpmsg_probe(struct rpmsg_device *rpdev) { int err = 0; struct fastcvpd_apps *me = &gfa_cv; if (strcmp(rpdev->dev.parent->of_node->name, "cdsp")) { pr_err("%s: Failed to probe rpmsg device.Node name:%s\n", __func__, rpdev->dev.parent->of_node->name); err = -EINVAL; goto bail; } mutex_lock(&me->smd_mutex); me->chan = rpdev; mutex_unlock(&me->smd_mutex); pr_debug("%s: Successfully probed\n", __func__); bail: return err; } static void fastcvpd_rpmsg_remove(struct rpmsg_device *rpdev) { struct fastcvpd_apps *me = &gfa_cv; mutex_lock(&me->smd_mutex); me->chan = NULL; mutex_unlock(&me->smd_mutex); } static int fastcvpd_rpmsg_callback(struct rpmsg_device *rpdev, void *data, int len, void *priv, u32 addr) { return 0; } int fastcvpd_video_send_cmd_hfi_queue(phys_addr_t *phys_addr, uint32_t size_in_bytes) { int err; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_SEND_HFI_CMD_QUEUE; cmd_msg.msg_ptr = (uint64_t)phys_addr; cmd_msg.msg_ptr_len = size_in_bytes; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_send_cmd_hfi_queue); int fastcvpd_video_suspend(uint32_t session_flag) { int err = 0; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_SUSPEND; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_suspend); int fastcvpd_video_resume(uint32_t session_flag) { int err; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_RESUME; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_resume); int fastcvpd_video_shutdown(uint32_t session_flag) { int err; struct fastcvpd_cmd_msg cmd_msg; cmd_msg.cmd_msg_type = FASTCVPD_VIDEO_SHUTDOWN; err = fastcvpd_send_cmd (&cmd_msg, sizeof(struct fastcvpd_cmd_msg)); if (err != 0) pr_err("%s: fastcvpd_send_cmd failed with err=%d\n", __func__, err); return err; } EXPORT_SYMBOL(fastcvpd_video_shutdown); static const struct rpmsg_device_id fastcvpd_rpmsg_match[] = { { FASTCVPD_GLINK_GUID }, { }, }; static struct rpmsg_driver fastcvpd_rpmsg_client = { .id_table = fastcvpd_rpmsg_match, .probe = fastcvpd_rpmsg_probe, .remove = fastcvpd_rpmsg_remove, .callback = fastcvpd_rpmsg_callback, .drv = { .name = "qcom,msm_fastcvpd_rpmsg", }, }; static int __init fastcvpd_device_init(void) { struct fastcvpd_apps *me = &gfa_cv; int err; mutex_init(&me->smd_mutex); err = register_rpmsg_driver(&fastcvpd_rpmsg_client); if (err) { pr_err("%s : register_rpmsg_driver failed with err %d\n", __func__, err); goto register_bail; } me->rpmsg_register = 1; return 0; register_bail: return err; } static void __exit fastcvpd_device_exit(void) { struct fastcvpd_apps *me = &gfa_cv; if (me->rpmsg_register == 1) unregister_rpmsg_driver(&fastcvpd_rpmsg_client); } late_initcall(fastcvpd_device_init); module_exit(fastcvpd_device_exit); MODULE_LICENSE("GPL v2");
include/linux/fastcvpd.h 0 → 100644 +89 −0 Original line number Diff line number Diff line /* * Copyright (c) 2018, 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 FASTCVPD_H #define FASTCVPD_H #include <linux/types.h> #define FASTCVPD_GLINK_GUID "fastcvpd-glink-apps-dsp" #define FASTCVPD_SMD_GUID "fastcvpd-smd-apps-dsp" #define FASTCVPD_DEVICE_NAME "fastcvpd-smd" #ifdef CONFIG_MSM_FASTCVPD /* * API for Video driver to send physical address to FastCVP driver * @param phys_addr * Physical address of command message queue * that needs to be mapped to CDSP. * It should be allocated from CMA adsp_mem region. * * @param size_in_bytes * Size in bytes of command message queue */ int fastcvpd_video_send_cmd_hfi_queue(phys_addr_t *phys_addr, uint32_t size_in_bytes); /* * API for Video driver to suspend CVP session during * power collapse * * @param session_flag * Flag to share details of session. */ int fastcvpd_video_suspend(uint32_t session_flag); /* * API for Video driver to resume CVP session during * power collapse * * @param session_flag * Flag to share details of session. */ int fastcvpd_video_resume(uint32_t session_flag); /* * API for Video driver to shutdown CVP session during * video subsystem error. * * @param session_flag * Flag to share details of session. */ int fastcvpd_video_shutdown(uint32_t session_flag); #else static inline int fastcvpd_video_send_cmd_hfi_queue( phys_addr_t *phys_addr, uint32_t size_in_bytes) { return -ENODEV; } static inline int fastcvpd_video_suspend(uint32_t session_flag) { return -ENODEV; } static inline int fastcvpd_video_suspend(uint32_t session_flag) { return -ENODEV; } static inline int fastcvpd_video_resume(uint32_t session_flag) { return -ENODEV; } #endif // CONFIG_FASTCVPD #endif // FASTCVPD_H
