mirror of
https://github.com/hardkernel/linux.git
synced 2026-06-06 19:08:57 +09:00
drm/rockchip: Add dw hdcp2 controller driver
Signed-off-by: Zhang Yubing <yubing.zhang@rock-chips.com> Change-Id: I0ac6ee46e0f97714f76fbf613a2400627343546d
This commit is contained in:
@@ -150,6 +150,12 @@ config DRM_ROCKCHIP_VVOP
|
||||
don't need a real vop driver(et: you just want rockchip drm
|
||||
gem driver to allocate memory).
|
||||
|
||||
config ROCKCHIP_DW_HDCP2
|
||||
tristate "Synopsis Designware HDCP2 interface"
|
||||
help
|
||||
Choose this option to enable support for the Synopsys
|
||||
Designware HDCP2 Controller.
|
||||
|
||||
source "drivers/gpu/drm/rockchip/rk628/Kconfig"
|
||||
|
||||
endif
|
||||
|
||||
@@ -28,6 +28,7 @@ rockchipdrm-$(CONFIG_ROCKCHIP_RK3066_HDMI) += rk3066_hdmi.o
|
||||
rockchipdrm-$(CONFIG_ROCKCHIP_VCONN) += rockchip_drm_vconn.o
|
||||
rockchipdrm-$(CONFIG_DRM_ROCKCHIP_VVOP) += rockchip_drm_vvop.o
|
||||
|
||||
obj-$(CONFIG_ROCKCHIP_DW_HDCP2) += dw_hdcp2.o
|
||||
obj-$(CONFIG_DRM_ROCKCHIP) += rockchipdrm.o
|
||||
|
||||
obj-$(CONFIG_DRM_ROCKCHIP_RK628) += rk628/
|
||||
|
||||
607
drivers/gpu/drm/rockchip/dw_hdcp2.c
Normal file
607
drivers/gpu/drm/rockchip/dw_hdcp2.c
Normal file
@@ -0,0 +1,607 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* Synopsys DesignWare Cores HDCP Controller
|
||||
*
|
||||
* Copyright (c) 2022 Rockchip Electronics Co. Ltd.
|
||||
*
|
||||
* Author: Zhang Yubing <yubing.zhang@rock-chips.com>
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/dma-mapping.h>
|
||||
#include <linux/uaccess.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/reset.h>
|
||||
#include <linux/mfd/syscon.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/pm_runtime.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/rockchip/rockchip_sip.h>
|
||||
#include <uapi/misc/dw_hdcp2.h>
|
||||
|
||||
#define VO0_GRF_VO0_STS0 0x20
|
||||
#define DP1_CONNECT_HDCP0_STATUS BIT(24)
|
||||
#define DP0_CONNECT_HDCP0_STATUS BIT(8)
|
||||
#define VO0_GRF_VO0_STS3 0x2C
|
||||
#define HDCP0_BOOT_STATUS BIT(8)
|
||||
#define VO1_GRF_VO1_STS3 0x3C
|
||||
#define HDMITX0_CONNECT_HDCP1_STATUS BIT(20)
|
||||
#define HDCP1_BOOT_STATUS BIT(16)
|
||||
#define VO1_GRF_VO1_STS4 0x40
|
||||
#define HDMITX1_CONNECT_HDCP1_STATUS BIT(0)
|
||||
#define HDMIRX_CONNECT_HDCP1_STATUS BIT(8)
|
||||
|
||||
/**
|
||||
* struct hl_device - hdcp host library device structure
|
||||
* each hdcp controller attach to a hl_device, it include
|
||||
* code memory info, data memory info and hpi(apb) interface
|
||||
* info
|
||||
*/
|
||||
struct hl_device {
|
||||
bool allocated;
|
||||
bool initialized;
|
||||
bool code_loaded;
|
||||
|
||||
bool code_is_phys_mem;
|
||||
dma_addr_t code_base;
|
||||
uint32_t code_size;
|
||||
uint8_t *code;
|
||||
bool data_is_phys_mem;
|
||||
dma_addr_t data_base;
|
||||
uint32_t data_size;
|
||||
uint8_t *data;
|
||||
|
||||
/** @hpi_respurce: resource of HPI interface */
|
||||
struct resource *hpi_resource;
|
||||
/** @hpi: base address of HPI registers */
|
||||
uint8_t __iomem *hpi;
|
||||
};
|
||||
|
||||
struct dw_hdcp {
|
||||
struct device *dev;
|
||||
struct miscdevice misc_dev;
|
||||
struct hl_device hl_dev;
|
||||
|
||||
struct regmap *vo_grf;
|
||||
struct reset_control *rsts_bulk;
|
||||
struct clk_bulk_data *clks;
|
||||
int num_clks;
|
||||
int id;
|
||||
bool is_suspend;
|
||||
};
|
||||
|
||||
enum {
|
||||
HDCP_PORT0 = 0,
|
||||
HDCP_PORT1,
|
||||
HDCP_PORT2,
|
||||
};
|
||||
|
||||
static int dw_hdcp_get_status(struct dw_hdcp *hdcp, void __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_status status;
|
||||
u32 val = 0;
|
||||
u32 connected_status = 0;
|
||||
u32 booted_status = 0;
|
||||
|
||||
if (!arg)
|
||||
return -EFAULT;
|
||||
|
||||
if (!hdcp->is_suspend) {
|
||||
if (hdcp->id) {
|
||||
regmap_read(hdcp->vo_grf, VO1_GRF_VO1_STS3, &val);
|
||||
if (val & HDMITX0_CONNECT_HDCP1_STATUS)
|
||||
connected_status |= 1 << HDCP_PORT1;
|
||||
if (val & HDCP1_BOOT_STATUS)
|
||||
booted_status = 1;
|
||||
|
||||
regmap_read(hdcp->vo_grf, VO1_GRF_VO1_STS4, &val);
|
||||
if (val & HDMITX1_CONNECT_HDCP1_STATUS)
|
||||
connected_status |= 1 << HDCP_PORT2;
|
||||
if (val & HDMIRX_CONNECT_HDCP1_STATUS)
|
||||
connected_status |= 1 << HDCP_PORT0;
|
||||
} else {
|
||||
regmap_read(hdcp->vo_grf, VO0_GRF_VO0_STS0, &val);
|
||||
if (val & DP0_CONNECT_HDCP0_STATUS)
|
||||
connected_status |= 1 << HDCP_PORT0;
|
||||
if (val & DP1_CONNECT_HDCP0_STATUS)
|
||||
connected_status |= 1 << HDCP_PORT1;
|
||||
|
||||
regmap_read(hdcp->vo_grf, VO0_GRF_VO0_STS3, &val);
|
||||
if (val & HDCP0_BOOT_STATUS)
|
||||
booted_status = 1;
|
||||
}
|
||||
}
|
||||
|
||||
status.connected_status = connected_status;
|
||||
status.booted_status = booted_status;
|
||||
|
||||
if (copy_to_user(arg, &status, sizeof(status)))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_MEMINFO implementation */
|
||||
static long dw_hdcp_get_meminfo(struct hl_device *hl_dev, void __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_meminfo info;
|
||||
|
||||
if (!arg)
|
||||
return -EFAULT;
|
||||
|
||||
info.hpi_base = hl_dev->hpi_resource->start;
|
||||
info.code_base = hl_dev->code_base;
|
||||
info.code_size = hl_dev->code_size;
|
||||
info.data_base = hl_dev->data_base;
|
||||
info.data_size = hl_dev->data_size;
|
||||
|
||||
if (copy_to_user(arg, &info, sizeof(info)))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_LOAD_CODE implementation */
|
||||
static long dw_hdcp_load_code(struct hl_device *hl_dev, struct hl_drv_ioc_code __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_code head;
|
||||
|
||||
if (!arg || !hl_dev->code)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(&head, arg, sizeof(head)))
|
||||
return -EFAULT;
|
||||
|
||||
if (head.len > hl_dev->code_size)
|
||||
return -ENOSPC;
|
||||
|
||||
if (hl_dev->code_loaded)
|
||||
return -EBUSY;
|
||||
|
||||
if (copy_from_user(hl_dev->code, &arg->data, head.len))
|
||||
return -EFAULT;
|
||||
|
||||
hl_dev->code_loaded = true;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_WRITE_DATA implementation */
|
||||
static long dw_hdcp_write_data(struct hl_device *hl_dev, struct hl_drv_ioc_data __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_data head;
|
||||
|
||||
if (!arg || !hl_dev->data)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(&head, arg, sizeof(head)))
|
||||
return -EFAULT;
|
||||
|
||||
if (hl_dev->data_size < head.len)
|
||||
return -ENOSPC;
|
||||
if (hl_dev->data_size - head.len < head.offset)
|
||||
return -ENOSPC;
|
||||
|
||||
if (copy_from_user(hl_dev->data + head.offset, &arg->data, head.len))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_READ_DATA implementation */
|
||||
static long dw_hdcp_read_data(struct hl_device *hl_dev, struct hl_drv_ioc_data __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_data head;
|
||||
|
||||
if (!arg || !hl_dev->data)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(&head, arg, sizeof(head)))
|
||||
return -EFAULT;
|
||||
|
||||
if (hl_dev->data_size < head.len)
|
||||
return -ENOSPC;
|
||||
if (hl_dev->data_size - head.len < head.offset)
|
||||
return -ENOSPC;
|
||||
|
||||
if (copy_to_user(&arg->data, hl_dev->data + head.offset, head.len))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_MEMSET_DATA implementation */
|
||||
static long dw_hdcp_set_data(struct hl_device *hl_dev, void __user *arg)
|
||||
{
|
||||
union {
|
||||
struct hl_drv_ioc_data data;
|
||||
unsigned char buf[sizeof(struct hl_drv_ioc_data) + 1];
|
||||
} u;
|
||||
|
||||
if (!arg || !hl_dev->data)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(&u.data, arg, sizeof(u.buf)))
|
||||
return -EFAULT;
|
||||
|
||||
if (hl_dev->data_size < u.data.len)
|
||||
return -ENOSPC;
|
||||
if (hl_dev->data_size - u.data.len < u.data.offset)
|
||||
return -ENOSPC;
|
||||
|
||||
memset(hl_dev->data + u.data.offset, u.data.data[0], u.data.len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_READ_HPI implementation */
|
||||
static long dw_hdcp_hpi_read(struct hl_device *hl_dev, void __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_hpi_reg reg;
|
||||
|
||||
if (!arg)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(®, arg, sizeof(reg)))
|
||||
return -EFAULT;
|
||||
|
||||
if ((reg.offset & 3) || reg.offset >= resource_size(hl_dev->hpi_resource))
|
||||
return -EINVAL;
|
||||
|
||||
reg.value = ioread32(hl_dev->hpi + reg.offset);
|
||||
if (copy_to_user(arg, ®, sizeof(reg)))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_WRITE_HPI implementation */
|
||||
static long dw_hdcp_hpi_write(struct hl_device *hl_dev, void __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_hpi_reg reg;
|
||||
|
||||
if (!arg)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(®, arg, sizeof(reg)))
|
||||
return -EFAULT;
|
||||
|
||||
if ((reg.offset & 3) || reg.offset >= resource_size(hl_dev->hpi_resource))
|
||||
return -EINVAL;
|
||||
|
||||
iowrite32(reg.value, hl_dev->hpi + reg.offset);
|
||||
#ifdef TROOT_GRIFFIN
|
||||
if ((reg.offset == 0x38) && ((reg.value & 0x000000ff) == 0x08))
|
||||
hl_dev->code_loaded = false;
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dw_hdcp_check_hl_dev_slot(const struct hl_drv_ioc_meminfo *info,
|
||||
struct hl_device *hl_dev)
|
||||
{
|
||||
if (info->hpi_base == hl_dev->hpi_resource->start)
|
||||
return 0;
|
||||
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
static void dw_hdcp_free_dma_areas(struct hl_device *hl_dev)
|
||||
{
|
||||
struct dw_hdcp *hdcp = container_of(hl_dev, struct dw_hdcp, hl_dev);
|
||||
|
||||
if (!hl_dev->code_is_phys_mem && hl_dev->code) {
|
||||
dma_free_coherent(hdcp->dev, hl_dev->code_size, hl_dev->code, hl_dev->code_base);
|
||||
hl_dev->code = NULL;
|
||||
}
|
||||
|
||||
if (!hl_dev->data_is_phys_mem && hl_dev->data) {
|
||||
dma_free_coherent(hdcp->dev, hl_dev->data_size, hl_dev->data, hl_dev->data_base);
|
||||
hl_dev->data = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
static int dw_hdcp_alloc_dma_areas(struct hl_device *hl_dev, const struct hl_drv_ioc_meminfo *info)
|
||||
{
|
||||
struct dw_hdcp *hdcp = container_of(hl_dev, struct dw_hdcp, hl_dev);
|
||||
|
||||
hl_dev->code_size = info->code_size;
|
||||
hl_dev->code_is_phys_mem = (info->code_base != HL_DRIVER_ALLOCATE_DYNAMIC_MEM);
|
||||
hl_dev->data_size = info->data_size;
|
||||
hl_dev->data_is_phys_mem = (info->data_base != HL_DRIVER_ALLOCATE_DYNAMIC_MEM);
|
||||
|
||||
if ((hl_dev->code_is_phys_mem && !hl_dev->code) ||
|
||||
(hl_dev->data_is_phys_mem && !hl_dev->data)) {
|
||||
dev_err(hdcp->dev, "hdcp don't support phys mem\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
hl_dev->code = dma_alloc_coherent(hdcp->dev, hl_dev->code_size,
|
||||
&hl_dev->code_base, GFP_KERNEL);
|
||||
if (!hl_dev->code)
|
||||
return -ENOMEM;
|
||||
|
||||
hl_dev->data = dma_alloc_coherent(hdcp->dev, hl_dev->data_size,
|
||||
&hl_dev->data_base, GFP_KERNEL);
|
||||
if (!hl_dev->data) {
|
||||
dw_hdcp_free_dma_areas(hl_dev);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* HL_DRV_IOC_INIT implementation */
|
||||
static long dw_hdcp_init(struct hl_device *hl_dev, void __user *arg)
|
||||
{
|
||||
struct hl_drv_ioc_meminfo info;
|
||||
int rc;
|
||||
|
||||
if (!arg)
|
||||
return -EFAULT;
|
||||
|
||||
if (copy_from_user(&info, arg, sizeof(info)))
|
||||
return -EFAULT;
|
||||
|
||||
rc = dw_hdcp_check_hl_dev_slot(&info, hl_dev);
|
||||
if (rc)
|
||||
return -EMFILE;
|
||||
|
||||
if (!hl_dev->initialized) {
|
||||
rc = dw_hdcp_alloc_dma_areas(hl_dev, &info);
|
||||
if (rc < 0)
|
||||
goto err_free;
|
||||
|
||||
hl_dev->initialized = true;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_free:
|
||||
dw_hdcp_free_dma_areas(hl_dev);
|
||||
hl_dev->initialized = false;
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
static void dw_hdcp_free_hl_dev_slot(struct hl_device *hl_dev)
|
||||
{
|
||||
if (hl_dev->initialized)
|
||||
dw_hdcp_free_dma_areas(hl_dev);
|
||||
|
||||
hl_dev->initialized = false;
|
||||
}
|
||||
|
||||
static long dw_hdcp_hld_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
|
||||
{
|
||||
struct hl_device *hl_dev;
|
||||
struct dw_hdcp *hdcp;
|
||||
struct miscdevice *misc_dev;
|
||||
void __user *data;
|
||||
|
||||
if (!f)
|
||||
return -EFAULT;
|
||||
|
||||
misc_dev = f->private_data;
|
||||
hdcp = container_of(misc_dev, struct dw_hdcp, misc_dev);
|
||||
hl_dev = &hdcp->hl_dev;
|
||||
|
||||
data = (void __user *)arg;
|
||||
|
||||
switch (cmd) {
|
||||
case HL_DRV_IOC_INIT:
|
||||
return dw_hdcp_init(hl_dev, data);
|
||||
case HL_DRV_IOC_MEMINFO:
|
||||
return dw_hdcp_get_meminfo(hl_dev, data);
|
||||
case HL_DRV_IOC_READ_HPI:
|
||||
return dw_hdcp_hpi_read(hl_dev, data);
|
||||
case HL_DRV_IOC_WRITE_HPI:
|
||||
return dw_hdcp_hpi_write(hl_dev, data);
|
||||
case HL_DRV_IOC_LOAD_CODE:
|
||||
return dw_hdcp_load_code(hl_dev, data);
|
||||
case HL_DRV_IOC_WRITE_DATA:
|
||||
return dw_hdcp_write_data(hl_dev, data);
|
||||
case HL_DRV_IOC_READ_DATA:
|
||||
return dw_hdcp_read_data(hl_dev, data);
|
||||
case HL_DRV_IOC_MEMSET_DATA:
|
||||
return dw_hdcp_set_data(hl_dev, data);
|
||||
|
||||
case RK_DRV_IOC_GET_STATUS:
|
||||
return dw_hdcp_get_status(hdcp, data);
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return -ENOTTY;
|
||||
}
|
||||
|
||||
static int dw_hdcp_hld_open(struct inode *inode, struct file *f)
|
||||
{
|
||||
struct dw_hdcp *hdcp;
|
||||
struct miscdevice *misc_dev;
|
||||
|
||||
misc_dev = f->private_data;
|
||||
hdcp = container_of(misc_dev, struct dw_hdcp, misc_dev);
|
||||
pm_runtime_get_sync(hdcp->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dw_hdcp_hld_release(struct inode *inode, struct file *f)
|
||||
{
|
||||
struct dw_hdcp *hdcp;
|
||||
struct miscdevice *misc_dev;
|
||||
|
||||
misc_dev = f->private_data;
|
||||
hdcp = container_of(misc_dev, struct dw_hdcp, misc_dev);
|
||||
pm_runtime_put(hdcp->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct file_operations dw_hdcp_hld_file_operations = {
|
||||
#ifdef CONFIG_COMPAT
|
||||
.compat_ioctl = dw_hdcp_hld_ioctl,
|
||||
#else
|
||||
.unlocked_ioctl = dw_hdcp_hld_ioctl,
|
||||
#endif
|
||||
.open = dw_hdcp_hld_open,
|
||||
.release = dw_hdcp_hld_release,
|
||||
.owner = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int dw_hdcp_hld_init(struct dw_hdcp *hdcp, struct resource *res, void __iomem *base)
|
||||
{
|
||||
hdcp->hl_dev.allocated = false;
|
||||
hdcp->hl_dev.initialized = false;
|
||||
hdcp->hl_dev.code_loaded = false;
|
||||
hdcp->hl_dev.code = NULL;
|
||||
hdcp->hl_dev.data = NULL;
|
||||
hdcp->hl_dev.hpi_resource = res;
|
||||
hdcp->hl_dev.hpi = base;
|
||||
|
||||
hdcp->misc_dev.name = devm_kasprintf(hdcp->dev, GFP_KERNEL, "hl_dev%d", hdcp->id);
|
||||
if (!hdcp->misc_dev.name)
|
||||
return -ENOMEM;
|
||||
hdcp->misc_dev.minor = MISC_DYNAMIC_MINOR;
|
||||
hdcp->misc_dev.fops = &dw_hdcp_hld_file_operations;
|
||||
|
||||
return misc_register(&hdcp->misc_dev);
|
||||
}
|
||||
|
||||
static void dw_hdcp_hld_exit(struct dw_hdcp *hdcp)
|
||||
{
|
||||
dw_hdcp_free_hl_dev_slot(&hdcp->hl_dev);
|
||||
|
||||
misc_deregister(&hdcp->misc_dev);
|
||||
}
|
||||
|
||||
static int dw_hdcp_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct device *dev = &pdev->dev;
|
||||
struct dw_hdcp *hdcp;
|
||||
struct resource *res;
|
||||
void __iomem *base;
|
||||
int id, ret;
|
||||
|
||||
hdcp = devm_kzalloc(dev, sizeof(*hdcp), GFP_KERNEL);
|
||||
if (!hdcp)
|
||||
return -ENOMEM;
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
base = devm_ioremap_resource(dev, res);
|
||||
if (IS_ERR(base))
|
||||
return PTR_ERR(base);
|
||||
|
||||
id = of_alias_get_id(dev->of_node, "hdcp");
|
||||
if (id < 0)
|
||||
id = 0;
|
||||
|
||||
hdcp->id = id;
|
||||
hdcp->dev = dev;
|
||||
|
||||
hdcp->vo_grf = syscon_regmap_lookup_by_phandle(dev->of_node, "rockchip,vo-grf");
|
||||
if (IS_ERR(hdcp->vo_grf)) {
|
||||
dev_err(hdcp->dev, "Get vo-grf failed\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
hdcp->rsts_bulk = devm_reset_control_array_get_exclusive(dev);
|
||||
if (IS_ERR(hdcp->rsts_bulk)) {
|
||||
dev_err(dev, "Get resets failed\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
hdcp->num_clks = devm_clk_bulk_get_all(dev, &hdcp->clks);
|
||||
if (hdcp->num_clks < 1) {
|
||||
dev_err(dev, "Get clks failed\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
ret = dw_hdcp_hld_init(hdcp, res, base);
|
||||
if (ret) {
|
||||
dev_err(dev, "hld init failed\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
platform_set_drvdata(pdev, hdcp);
|
||||
|
||||
pm_runtime_enable(hdcp->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dw_hdcp_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct dw_hdcp *hdcp = platform_get_drvdata(pdev);
|
||||
|
||||
dw_hdcp_hld_exit(hdcp);
|
||||
|
||||
pm_runtime_disable(hdcp->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dw_hdcp_runtime_suspend(struct device *dev)
|
||||
{
|
||||
struct dw_hdcp *hdcp = dev_get_drvdata(dev);
|
||||
|
||||
hdcp->is_suspend = true;
|
||||
clk_bulk_disable_unprepare(hdcp->num_clks, hdcp->clks);
|
||||
|
||||
dw_hdcp_free_hl_dev_slot(&hdcp->hl_dev);
|
||||
hdcp->hl_dev.code_loaded = false;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dw_hdcp_runtime_resume(struct device *dev)
|
||||
{
|
||||
struct dw_hdcp *hdcp = dev_get_drvdata(dev);
|
||||
int ret;
|
||||
|
||||
ret = clk_bulk_prepare_enable(hdcp->num_clks, hdcp->clks);
|
||||
if (ret)
|
||||
dev_err(dev, "prepare enable clk bulk failed\n");
|
||||
|
||||
reset_control_assert(hdcp->rsts_bulk);
|
||||
udelay(10);
|
||||
reset_control_deassert(hdcp->rsts_bulk);
|
||||
|
||||
ret = sip_hdcpkey_init(hdcp->id);
|
||||
if (ret)
|
||||
dev_err(dev, "load hdcp key failed\n");
|
||||
|
||||
hdcp->is_suspend = false;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct dev_pm_ops dw_hdcp_pm_ops = {
|
||||
SET_RUNTIME_PM_OPS(dw_hdcp_runtime_suspend, dw_hdcp_runtime_resume, NULL)
|
||||
SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, pm_runtime_force_resume)
|
||||
};
|
||||
|
||||
static const struct of_device_id dw_hdcp_of_match[] = {
|
||||
{.compatible = "rockchip,rk3588-hdcp",},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(of, dw_hdcp_of_match);
|
||||
|
||||
static struct platform_driver dw_hdcp_driver = {
|
||||
.probe = dw_hdcp_probe,
|
||||
.remove = dw_hdcp_remove,
|
||||
.driver = {
|
||||
.name = "dw-hdcp",
|
||||
.of_match_table = dw_hdcp_of_match,
|
||||
.pm = &dw_hdcp_pm_ops,
|
||||
},
|
||||
};
|
||||
|
||||
module_platform_driver(dw_hdcp_driver);
|
||||
|
||||
MODULE_AUTHOR("Zhang Yubing <yubing.zhang@rock-chips.com>");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_DESCRIPTION("Rockchip HDCP Host Library Driver");
|
||||
127
include/uapi/misc/dw_hdcp2.h
Normal file
127
include/uapi/misc/dw_hdcp2.h
Normal file
@@ -0,0 +1,127 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 WITH Linux-syscall-note */
|
||||
/*
|
||||
* Rockchip HDCP Host Library driver
|
||||
*
|
||||
* Copyright (C) 2022 Rockchip Electronics Co., Ltd
|
||||
*/
|
||||
|
||||
#ifndef _DW_HDCP_HOST_LIB_DRIVER_LINUX_IF_H_
|
||||
#define _DW_HDCP_HOST_LIB_DRIVER_LINUX_IF_H_
|
||||
|
||||
#include <linux/ioctl.h>
|
||||
#include <linux/types.h>
|
||||
|
||||
#define HL_DRIVER_ALLOCATE_DYNAMIC_MEM 0xffffffff
|
||||
// hl_drv_ioctl numbers
|
||||
enum {
|
||||
HL_DRV_NR_MIN = 0x10,
|
||||
HL_DRV_NR_INIT,
|
||||
HL_DRV_NR_MEMINFO,
|
||||
HL_DRV_NR_LOAD_CODE,
|
||||
HL_DRV_NR_READ_DATA,
|
||||
HL_DRV_NR_WRITE_DATA,
|
||||
HL_DRV_NR_MEMSET_DATA,
|
||||
HL_DRV_NR_READ_HPI,
|
||||
HL_DRV_NR_WRITE_HPI,
|
||||
|
||||
RK_DRV_NR_GET_STATUS,
|
||||
|
||||
HL_DRV_NR_MAX
|
||||
};
|
||||
|
||||
/*
|
||||
* HL_DRV_IOC_INIT: associate file descriptor with the indicated memory. This
|
||||
* must be called before any other hl_drv_ioctl on the file descriptor.
|
||||
*
|
||||
* - hpi_base = base address of HPI registers.
|
||||
* - code_base = base address of firmware memory (0 to allocate internally)
|
||||
* - data_base = base address of data memory (0 to allocate internally)
|
||||
* - code_len, data_len = length of firmware and data memory, respectively.
|
||||
*/
|
||||
#define HL_DRV_IOC_INIT _IOW('H', HL_DRV_NR_INIT, struct hl_drv_ioc_meminfo)
|
||||
|
||||
/*
|
||||
* HL_DRV_IOC_MEMINFO: retrieve memory information from file descriptor.
|
||||
*
|
||||
* Fills out the meminfo struct, returning the values passed to HL_DRV_IOC_INIT
|
||||
* except that the actual base addresses of internal allocations (if any) are
|
||||
* reported.
|
||||
*/
|
||||
#define HL_DRV_IOC_MEMINFO _IOR('H', HL_DRV_NR_MEMINFO, struct hl_drv_ioc_meminfo)
|
||||
|
||||
struct hl_drv_ioc_meminfo {
|
||||
__u32 hpi_base;
|
||||
__u32 code_base;
|
||||
__u32 code_size;
|
||||
__u32 data_base;
|
||||
__u32 data_size;
|
||||
};
|
||||
|
||||
/*
|
||||
* HL_DRV_IOC_LOAD_CODE: write the provided buffer to the firmware memory.
|
||||
*
|
||||
* - len = number of bytes in data buffer
|
||||
* - data = data to write to firmware memory.
|
||||
*
|
||||
* This can only be done once (successfully). Subsequent attempts will
|
||||
* return -EBUSY.
|
||||
*/
|
||||
#define HL_DRV_IOC_LOAD_CODE _IOW('H', HL_DRV_NR_LOAD_CODE, struct hl_drv_ioc_code)
|
||||
|
||||
struct hl_drv_ioc_code {
|
||||
__u32 len;
|
||||
__u8 data[];
|
||||
};
|
||||
|
||||
/*
|
||||
* HL_DRV_IOC_READ_DATA: copy from data memory.
|
||||
* HL_DRV_IOC_WRITE_DATA: copy to data memory.
|
||||
*
|
||||
* - offset = start copying at this byte offset into the data memory.
|
||||
* - len = number of bytes to copy.
|
||||
* - data = for write, buffer containing data to copy.
|
||||
* for read, buffer to which read data will be written.
|
||||
*
|
||||
*/
|
||||
#define HL_DRV_IOC_READ_DATA _IOWR('H', HL_DRV_NR_READ_DATA, struct hl_drv_ioc_data)
|
||||
#define HL_DRV_IOC_WRITE_DATA _IOW('H', HL_DRV_NR_WRITE_DATA, struct hl_drv_ioc_data)
|
||||
|
||||
/*
|
||||
* HL_DRV_IOC_MEMSET_DATA: initialize data memory.
|
||||
*
|
||||
* - offset = start initializatoin at this byte offset into the data memory.
|
||||
* - len = number of bytes to set.
|
||||
* - data[0] = byte value to write to all indicated memory locations.
|
||||
*/
|
||||
#define HL_DRV_IOC_MEMSET_DATA _IOW('H', HL_DRV_NR_MEMSET_DATA, struct hl_drv_ioc_data)
|
||||
|
||||
struct hl_drv_ioc_data {
|
||||
__u32 offset;
|
||||
__u32 len;
|
||||
__u8 data[];
|
||||
};
|
||||
|
||||
/*
|
||||
* HL_DRV_IOC_READ_HPI: read HPI register.
|
||||
* HL_DRV_IOC_WRITE_HPI: write HPI register.
|
||||
*
|
||||
* - offset = byte offset of HPI register to access.
|
||||
* - value = for write, value to write.
|
||||
* for read, location to which result is stored.
|
||||
*/
|
||||
#define HL_DRV_IOC_READ_HPI _IOWR('H', HL_DRV_NR_READ_HPI, struct hl_drv_ioc_hpi_reg)
|
||||
#define HL_DRV_IOC_WRITE_HPI _IOW('H', HL_DRV_NR_WRITE_HPI, struct hl_drv_ioc_hpi_reg)
|
||||
|
||||
struct hl_drv_ioc_hpi_reg {
|
||||
__u32 offset;
|
||||
__u32 value;
|
||||
};
|
||||
|
||||
#define RK_DRV_IOC_GET_STATUS _IOR('H', RK_DRV_NR_GET_STATUS, struct hl_drv_ioc_status)
|
||||
|
||||
struct hl_drv_ioc_status {
|
||||
__u32 connected_status;
|
||||
__u32 booted_status;
|
||||
};
|
||||
|
||||
#endif // _DW_HDCP_HOST_LIB_DRIVER_LINUX_IF_H_
|
||||
Reference in New Issue
Block a user