From: 陈恒明 <chm@rock-chips.com>
Date: Wed, 13 Jul 2011 06:39:16 +0000 (+0800)
Subject: rk29: vpu: move vpu_service from user to kernel
X-Git-Tag: firefly_0821_release~10136^2~2
X-Git-Url: http://demsky.eecs.uci.edu/git/?a=commitdiff_plain;h=8ace8d26ee5eaa692ab74522c1c6f95b04049e7d;p=firefly-linux-kernel-4.4.55.git
rk29: vpu: move vpu_service from user to kernel
---
diff --git a/arch/arm/mach-rk29/Kconfig b/arch/arm/mach-rk29/Kconfig
index 6f1ceb62a229..f5c49882514a 100755
--- a/arch/arm/mach-rk29/Kconfig
+++ b/arch/arm/mach-rk29/Kconfig
@@ -158,14 +158,22 @@ config WIFI_CONTROL_FUNC
menu "RK29 VPU (Video Processing Unit) support"
config RK29_VPU
- tristate "Support for RK29 VPU (Video Processing Unit)"
+ bool
depends on ARCH_RK29
default y
+config RK29_VPU_SERVICE
+ bool "VPU service driver in kernel"
+ depends on ARCH_RK29
+ default y
+
+config RK29_VPU_OLD
+ bool "Old version for RK29 VPU (Video Processing Unit)"
+ depends on ARCH_RK29 && !RK29_VPU_SERVICE
+
config RK29_VPU_DEBUG
bool "RK29 VPU debugging"
depends on RK29_VPU != n
- default n
help
This is an option for the developers; most people should
say N here. This enables RK29 VPU driver debugging.
diff --git a/arch/arm/mach-rk29/Makefile b/arch/arm/mach-rk29/Makefile
index d094cdb5b5e7..c55dae8d8550 100755
--- a/arch/arm/mach-rk29/Makefile
+++ b/arch/arm/mach-rk29/Makefile
@@ -8,8 +8,10 @@ obj-$(CONFIG_RK29_LAST_LOG) += last_log.o
obj-$(CONFIG_USB_GADGET) += usb_detect.o
obj-$(CONFIG_PM) += pm.o
obj-$(CONFIG_CPU_FREQ) += cpufreq.o
-obj-$(CONFIG_RK29_VPU) += vpu.o vpu_mem.o
+obj-$(CONFIG_RK29_VPU) += vpu_mem.o
obj-y += spi_sram.o
+obj-$(CONFIG_RK29_VPU_SERVICE) += vpu_service.o
+obj-$(CONFIG_RK29_VPU_OLD) += vpu.o
obj-$(CONFIG_RK29_PWM_INSRAM) += pwm_sram.o
obj-$(CONFIG_MACH_RK29SDK) += board-rk29sdk.o board-rk29sdk-key.o board-rk29sdk-rfkill.o board-rk29sdk-power.o
obj-$(CONFIG_MACH_RK29SDK_DDR3) += board-rk29-ddr3sdk.o board-rk29sdk-key.o board-rk29sdk-rfkill.o board-rk29sdk-power.o
diff --git a/arch/arm/mach-rk29/include/mach/vpu_service.h b/arch/arm/mach-rk29/include/mach/vpu_service.h
new file mode 100644
index 000000000000..9733600a61bf
--- /dev/null
+++ b/arch/arm/mach-rk29/include/mach/vpu_service.h
@@ -0,0 +1,268 @@
+/* arch/arm/mach-rk29/include/mach/vpu_service.h
+ *
+ * Copyright (C) 2010 ROCKCHIP, Inc.
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * 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_RK29_VPU_SERVICE_H
+#define __ARCH_ARM_MACH_RK29_VPU_SERVICE_H
+
+#include <linux/ioctl.h> /* needed for the _IOW etc stuff used later */
+
+/*
+ * Ioctl definitions
+ */
+
+/* Use 'k' as magic number */
+#define VPU_IOC_MAGIC 'l'
+
+#define VPU_IOC_SET_CLIENT_TYPE _IOW(VPU_IOC_MAGIC, 1, unsigned long)
+#define VPU_IOC_GET_HW_FUSE_STATUS _IOW(VPU_IOC_MAGIC, 2, unsigned long)
+
+#define VPU_IOC_SET_REG _IOW(VPU_IOC_MAGIC, 3, unsigned long)
+#define VPU_IOC_GET_REG _IOW(VPU_IOC_MAGIC, 4, unsigned long)
+
+
+// client type: decoder only£º60 registers, size 240B
+#define VPU_REG_NUM_DEC (60)
+// client type: post-process only£º41 registers, size 164B
+#define VPU_REG_NUM_PP (41)
+// client type: decoder plus post-process£º101 registers, size 404B
+#define VPU_REG_NUM_DEC_PP (VPU_REG_NUM_DEC+VPU_REG_NUM_PP)
+// client type: encoder only£º96 registers, size 384B
+#define VPU_REG_NUM_ENC (96)
+
+typedef enum VPU_CLIENT_TYPE {
+ VPU_ENC = 0x0,
+ VPU_DEC = 0x1,
+ VPU_PP = 0x2,
+ VPU_DEC_PP = 0x3,
+ VPU_TYPE_BUTT ,
+
+} VPU_CLIENT_TYPE;
+
+/* Hardware decoder configuration description */
+
+typedef struct VPUHwDecConfig {
+ unsigned long maxDecPicWidth; /* Maximum video decoding width supported */
+ unsigned long maxPpOutPicWidth; /* Maximum output width of Post-Processor */
+ unsigned long h264Support; /* HW supports h.264 */
+ unsigned long jpegSupport; /* HW supports JPEG */
+ unsigned long mpeg4Support; /* HW supports MPEG-4 */
+ unsigned long customMpeg4Support; /* HW supports custom MPEG-4 features */
+ unsigned long vc1Support; /* HW supports VC-1 Simple */
+ unsigned long mpeg2Support; /* HW supports MPEG-2 */
+ unsigned long ppSupport; /* HW supports post-processor */
+ unsigned long ppConfig; /* HW post-processor functions bitmask */
+ unsigned long sorensonSparkSupport; /* HW supports Sorenson Spark */
+ unsigned long refBufSupport; /* HW supports reference picture buffering */
+ unsigned long vp6Support; /* HW supports VP6 */
+ unsigned long vp7Support; /* HW supports VP7 */
+ unsigned long vp8Support; /* HW supports VP8 */
+ unsigned long avsSupport; /* HW supports AVS */
+ unsigned long jpegESupport; /* HW supports JPEG extensions */
+ unsigned long rvSupport; /* HW supports REAL */
+ unsigned long mvcSupport; /* HW supports H264 MVC extension */
+} VPUHwDecConfig_t;
+
+/* Hardware encoder configuration description */
+
+typedef struct VPUHwEndConfig
+{
+ unsigned long maxEncodedWidth; /* Maximum supported width for video encoding (not JPEG) */
+ unsigned long h264Enabled; /* HW supports H.264 */
+ unsigned long jpegEnabled; /* HW supports JPEG */
+ unsigned long mpeg4Enabled; /* HW supports MPEG-4 */
+ unsigned long vsEnabled; /* HW supports video stabilization */
+ unsigned long rgbEnabled; /* HW supports RGB input */
+ unsigned long busType; /* HW bus type in use */
+ unsigned long busWidth;
+ unsigned long synthesisLanguage;
+} VPUHwEncConfig_t;
+
+typedef struct VPUHwCfgReq
+{
+ unsigned long *cfg;
+ unsigned long size;
+} VPUHwCfgReq_t;
+
+#define DWL_MPEG2_E 31 /* 1 bit */
+#define DWL_VC1_E 29 /* 2 bits */
+#define DWL_JPEG_E 28 /* 1 bit */
+#define DWL_MPEG4_E 26 /* 2 bits */
+#define DWL_H264_E 24 /* 2 bits */
+#define DWL_VP6_E 23 /* 1 bit */
+#define DWL_PJPEG_E 22 /* 1 bit */
+#define DWL_REF_BUFF_E 20 /* 1 bit */
+
+#define DWL_JPEG_EXT_E 31 /* 1 bit */
+#define DWL_REF_BUFF_ILACE_E 30 /* 1 bit */
+#define DWL_MPEG4_CUSTOM_E 29 /* 1 bit */
+#define DWL_REF_BUFF_DOUBLE_E 28 /* 1 bit */
+#define DWL_RV_E 26 /* 2 bits */
+#define DWL_VP7_E 24 /* 1 bit */
+#define DWL_VP8_E 23 /* 1 bit */
+#define DWL_AVS_E 22 /* 1 bit */
+#define DWL_MVC_E 20 /* 2 bits */
+
+#define DWL_CFG_E 24 /* 4 bits */
+#define DWL_PP_E 16 /* 1 bit */
+
+#define DWL_SORENSONSPARK_E 11 /* 1 bit */
+
+#define DWL_H264_FUSE_E 31 /* 1 bit */
+#define DWL_MPEG4_FUSE_E 30 /* 1 bit */
+#define DWL_MPEG2_FUSE_E 29 /* 1 bit */
+#define DWL_SORENSONSPARK_FUSE_E 28 /* 1 bit */
+#define DWL_JPEG_FUSE_E 27 /* 1 bit */
+#define DWL_VP6_FUSE_E 26 /* 1 bit */
+#define DWL_VC1_FUSE_E 25 /* 1 bit */
+#define DWL_PJPEG_FUSE_E 24 /* 1 bit */
+#define DWL_CUSTOM_MPEG4_FUSE_E 23 /* 1 bit */
+#define DWL_RV_FUSE_E 22 /* 1 bit */
+#define DWL_VP7_FUSE_E 21 /* 1 bit */
+#define DWL_VP8_FUSE_E 20 /* 1 bit */
+#define DWL_AVS_FUSE_E 19 /* 1 bit */
+#define DWL_MVC_FUSE_E 18 /* 1 bit */
+
+#define DWL_DEC_MAX_1920_FUSE_E 15 /* 1 bit */
+#define DWL_DEC_MAX_1280_FUSE_E 14 /* 1 bit */
+#define DWL_DEC_MAX_720_FUSE_E 13 /* 1 bit */
+#define DWL_DEC_MAX_352_FUSE_E 12 /* 1 bit */
+#define DWL_REF_BUFF_FUSE_E 7 /* 1 bit */
+
+
+#define DWL_PP_FUSE_E 31 /* 1 bit */
+#define DWL_PP_DEINTERLACE_FUSE_E 30 /* 1 bit */
+#define DWL_PP_ALPHA_BLEND_FUSE_E 29 /* 1 bit */
+#define DWL_PP_MAX_1920_FUSE_E 15 /* 1 bit */
+#define DWL_PP_MAX_1280_FUSE_E 14 /* 1 bit */
+#define DWL_PP_MAX_720_FUSE_E 13 /* 1 bit */
+#define DWL_PP_MAX_352_FUSE_E 12 /* 1 bit */
+
+
+#define MPEG4_NOT_SUPPORTED (u32)(0x00)
+#define MPEG4_SIMPLE_PROFILE (u32)(0x01)
+#define MPEG4_ADVANCED_SIMPLE_PROFILE (u32)(0x02)
+#define MPEG4_CUSTOM_NOT_SUPPORTED (u32)(0x00)
+#define MPEG4_CUSTOM_FEATURE_1 (u32)(0x01)
+#define H264_NOT_SUPPORTED (u32)(0x00)
+#define H264_BASELINE_PROFILE (u32)(0x01)
+#define H264_MAIN_PROFILE (u32)(0x02)
+#define H264_HIGH_PROFILE (u32)(0x03)
+#define VC1_NOT_SUPPORTED (u32)(0x00)
+#define VC1_SIMPLE_PROFILE (u32)(0x01)
+#define VC1_MAIN_PROFILE (u32)(0x02)
+#define VC1_ADVANCED_PROFILE (u32)(0x03)
+#define MPEG2_NOT_SUPPORTED (u32)(0x00)
+#define MPEG2_MAIN_PROFILE (u32)(0x01)
+#define JPEG_NOT_SUPPORTED (u32)(0x00)
+#define JPEG_BASELINE (u32)(0x01)
+#define JPEG_PROGRESSIVE (u32)(0x02)
+#define PP_NOT_SUPPORTED (u32)(0x00)
+#define PP_SUPPORTED (u32)(0x01)
+#define PP_DITHERING (u32)(0x10000000)
+#define PP_SCALING (u32)(0x0C000000)
+#define PP_DEINTERLACING (u32)(0x02000000)
+#define PP_ALPHA_BLENDING (u32)(0x01000000)
+#define SORENSON_SPARK_NOT_SUPPORTED (u32)(0x00)
+#define SORENSON_SPARK_SUPPORTED (u32)(0x01)
+#define VP6_NOT_SUPPORTED (u32)(0x00)
+#define VP6_SUPPORTED (u32)(0x01)
+#define VP7_NOT_SUPPORTED (u32)(0x00)
+#define VP7_SUPPORTED (u32)(0x01)
+#define VP8_NOT_SUPPORTED (u32)(0x00)
+#define VP8_SUPPORTED (u32)(0x01)
+#define REF_BUF_NOT_SUPPORTED (u32)(0x00)
+#define REF_BUF_SUPPORTED (u32)(0x01)
+#define REF_BUF_INTERLACED (u32)(0x02)
+#define REF_BUF_DOUBLE (u32)(0x04)
+#define AVS_NOT_SUPPORTED (u32)(0x00)
+#define AVS_SUPPORTED (u32)(0x01)
+#define JPEG_EXT_NOT_SUPPORTED (u32)(0x00)
+#define JPEG_EXT_SUPPORTED (u32)(0x01)
+#define RV_NOT_SUPPORTED (u32)(0x00)
+#define RV_SUPPORTED (u32)(0x01)
+#define MVC_NOT_SUPPORTED (u32)(0x00)
+#define MVC_SUPPORTED (u32)(0x01)
+
+#define H264_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define H264_FUSE_ENABLED (u32)(0x01)
+#define MPEG4_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define MPEG4_FUSE_ENABLED (u32)(0x01)
+#define MPEG2_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define MPEG2_FUSE_ENABLED (u32)(0x01)
+#define SORENSON_SPARK_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define SORENSON_SPARK_ENABLED (u32)(0x01)
+#define JPEG_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define JPEG_FUSE_ENABLED (u32)(0x01)
+#define VP6_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define VP6_FUSE_ENABLED (u32)(0x01)
+#define VP7_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define VP7_FUSE_ENABLED (u32)(0x01)
+#define VP8_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define VP8_FUSE_ENABLED (u32)(0x01)
+#define VC1_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define VC1_FUSE_ENABLED (u32)(0x01)
+#define JPEG_PROGRESSIVE_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define JPEG_PROGRESSIVE_FUSE_ENABLED (u32)(0x01)
+#define REF_BUF_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define REF_BUF_FUSE_ENABLED (u32)(0x01)
+#define AVS_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define AVS_FUSE_ENABLED (u32)(0x01)
+#define RV_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define RV_FUSE_ENABLED (u32)(0x01)
+#define MVC_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define MVC_FUSE_ENABLED (u32)(0x01)
+
+#define PP_NOT_SUPPORTED_FUSE (u32)(0x00)
+#define PP_FUSE_ENABLED (u32)(0x01)
+#define PP_FUSE_DEINTERLACING_ENABLED (u32)(0x40000000)
+#define PP_FUSE_ALPHA_BLENDING_ENABLED (u32)(0x20000000)
+#define MAX_PP_OUT_WIDHT_1920_FUSE_ENABLED (u32)(0x00008000)
+#define MAX_PP_OUT_WIDHT_1280_FUSE_ENABLED (u32)(0x00004000)
+#define MAX_PP_OUT_WIDHT_720_FUSE_ENABLED (u32)(0x00002000)
+#define MAX_PP_OUT_WIDHT_352_FUSE_ENABLED (u32)(0x00001000)
+
+#define VPU_DEC_HWCFG0 50
+#define VPU_DEC_HWCFG1 51
+#define VPU_DEC_HW_FUSE_CFG 57
+#define VPU_PP_HW_SYNTH_CFG 40
+#define VPU_PP_HW_FUSE_CFG 41
+
+typedef struct VPUHwFuseStatus
+{
+ u32 h264SupportFuse; /* HW supports h.264 */
+ u32 mpeg4SupportFuse; /* HW supports MPEG-4 */
+ u32 mpeg2SupportFuse; /* HW supports MPEG-2 */
+ u32 sorensonSparkSupportFuse; /* HW supports Sorenson Spark */
+ u32 jpegSupportFuse; /* HW supports JPEG */
+ u32 vp6SupportFuse; /* HW supports VP6 */
+ u32 vp7SupportFuse; /* HW supports VP6 */
+ u32 vp8SupportFuse; /* HW supports VP6 */
+ u32 vc1SupportFuse; /* HW supports VC-1 Simple */
+ u32 jpegProgSupportFuse; /* HW supports Progressive JPEG */
+ u32 ppSupportFuse; /* HW supports post-processor */
+ u32 ppConfigFuse; /* HW post-processor functions bitmask */
+ u32 maxDecPicWidthFuse; /* Maximum video decoding width supported */
+ u32 maxPpOutPicWidthFuse; /* Maximum output width of Post-Processor */
+ u32 refBufSupportFuse; /* HW supports reference picture buffering */
+ u32 avsSupportFuse; /* one of the AVS values defined above */
+ u32 rvSupportFuse; /* one of the REAL values defined above */
+ u32 mvcSupportFuse;
+ u32 customMpeg4SupportFuse; /* Fuse for custom MPEG-4 */
+
+} VPUHwFuseStatus_t;
+
+
+#endif
+
diff --git a/arch/arm/mach-rk29/vpu_service.c b/arch/arm/mach-rk29/vpu_service.c
new file mode 100644
index 000000000000..bf4136f34a37
--- /dev/null
+++ b/arch/arm/mach-rk29/vpu_service.c
@@ -0,0 +1,1147 @@
+/* arch/arm/mach-rk29/vpu.c
+ *
+ * Copyright (C) 2010 ROCKCHIP, Inc.
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * 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.
+ *
+ */
+
+#ifdef CONFIG_RK29_VPU_DEBUG
+#define DEBUG
+#define pr_fmt(fmt) "VPU_SERVICE: %s: " fmt, __func__
+#else
+#define pr_fmt(fmt) "VPU_SERVICE: " fmt
+#endif
+
+
+#include <linux/clk.h>
+#include <linux/delay.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/fs.h>
+#include <linux/ioport.h>
+#include <linux/miscdevice.h>
+#include <linux/mm.h>
+#include <linux/poll.h>
+#include <linux/platform_device.h>
+#include <linux/workqueue.h>
+
+#include <asm/uaccess.h>
+
+#include <mach/irqs.h>
+#include <mach/vpu_service.h>
+#include <mach/rk29_iomap.h>
+#include <mach/pmu.h>
+#include <mach/cru.h>
+
+#define FUN printk("%s\n", __func__)
+
+#define DEC_INTERRUPT_REGISTER 1
+#define PP_INTERRUPT_REGISTER 60
+#define ENC_INTERRUPT_REGISTER 1
+
+#define DEC_INTERRUPT_BIT 0x100
+#define PP_INTERRUPT_BIT 0x100
+#define ENC_INTERRUPT_BIT 0x1
+
+#define REG_NUM_DEC (60)
+#define REG_NUM_PP (41)
+#define REG_NUM_ENC (96)
+#define REG_NUM_DEC_PP (REG_NUM_DEC+REG_NUM_PP)
+#define SIZE_REG(reg) ((reg)*4)
+
+#define DEC_IO_SIZE ((100 + 1) * 4) /* bytes */
+#define ENC_IO_SIZE (96 * 4) /* bytes */
+static const u16 dec_hw_ids[] = { 0x8190, 0x8170, 0x9170, 0x9190, 0x6731 };
+static const u16 enc_hw_ids[] = { 0x6280, 0x7280, 0x8270 };
+
+#define VPU_REG_EN_ENC 14
+#define VPU_REG_ENC_GATE 2
+#define VPU_REG_ENC_GATE_BIT (1<<4)
+
+#define VPU_REG_EN_DEC 1
+#define VPU_REG_DEC_GATE 2
+#define VPU_REG_DEC_GATE_BIT (1<<10)
+#define VPU_REG_EN_PP 0
+#define VPU_REG_PP_GATE 1
+#define VPU_REG_PP_GATE_BIT (1<<8)
+#define VPU_REG_EN_DEC_PP 1
+#define VPU_REG_DEC_PP_GATE 61
+#define VPU_REG_DEC_PP_GATE_BIT (1<<8)
+
+
+/**
+ * struct for process session which connect to vpu
+ *
+ * @author ChenHengming (2011-5-3)
+ */
+typedef struct vpu_session {
+ VPU_CLIENT_TYPE type;
+ /* a linked list of data so we can access them for debugging */
+ struct list_head list_session;
+ /* a linked list of register data waiting for process */
+ struct list_head waiting;
+ /* a linked list of register data in processing */
+ struct list_head running;
+ /* a linked list of register data processed */
+ struct list_head done;
+ wait_queue_head_t wait;
+ pid_t pid;
+} vpu_session;
+
+/**
+ * struct for process register set
+ *
+ * @author ChenHengming (2011-5-4)
+ */
+typedef struct vpu_reg {
+ VPU_CLIENT_TYPE type;
+ vpu_session *session;
+ struct list_head session_link; /* link to vpu service session */
+ struct list_head status_link; /* link to register set list */
+ unsigned long size;
+ unsigned long reg[VPU_REG_NUM_DEC_PP];
+} vpu_reg;
+
+typedef struct vpu_device {
+ unsigned long iobaseaddr;
+ unsigned int iosize;
+ volatile u32 *hwregs;
+} vpu_device;
+
+typedef struct vpu_service_info {
+ spinlock_t lock;
+ struct list_head waiting; /* link to link_reg in struct vpu_reg */
+ struct list_head running; /* link to link_reg in struct vpu_reg */
+ struct list_head done; /* link to link_reg in struct vpu_reg */
+ struct list_head session; /* link to list_session in struct vpu_session */
+ atomic_t task_running;
+ bool enabled;
+ vpu_reg *reg_dec;
+ vpu_reg *reg_pp;
+ vpu_reg *reg_enc;
+ VPUHwDecConfig_t dec_config;
+ VPUHwEncConfig_t enc_config;
+} vpu_service_info;
+
+typedef struct vpu_request
+{
+ unsigned long *req;
+ unsigned long size;
+} vpu_request;
+
+static struct clk *aclk_vepu;
+static struct clk *hclk_vepu;
+static struct clk *aclk_ddr_vepu;
+static struct clk *hclk_cpu_vcodec;
+static vpu_service_info service;
+static vpu_device dec_dev;
+static vpu_device enc_dev;
+
+static void vpu_service_power_off_work_func(struct work_struct *work);
+static DECLARE_DELAYED_WORK(vpu_service_power_off_work, vpu_service_power_off_work_func);
+#define POWER_OFF_DELAY 3*HZ /* 3s */
+
+static void vpu_get_clk(void)
+{
+ aclk_vepu = clk_get(NULL, "aclk_vepu");
+ hclk_vepu = clk_get(NULL, "hclk_vepu");
+ aclk_ddr_vepu = clk_get(NULL, "aclk_ddr_vepu");
+ hclk_cpu_vcodec = clk_get(NULL, "hclk_cpu_vcodec");
+}
+
+static void vpu_put_clk(void)
+{
+ clk_put(aclk_vepu);
+ clk_put(hclk_vepu);
+ clk_put(aclk_ddr_vepu);
+ clk_put(hclk_cpu_vcodec);
+}
+
+static u32 vpu_service_is_working(void)
+{
+ u32 irq_status;
+ u32 vpu_status = 0;
+ irq_status = readl(dec_dev.hwregs + DEC_INTERRUPT_REGISTER);
+ vpu_status |= irq_status&1;
+ irq_status = readl(enc_dev.hwregs + ENC_INTERRUPT_REGISTER);
+ vpu_status |= irq_status&1;
+ irq_status = readl(dec_dev.hwregs + PP_INTERRUPT_REGISTER);
+ vpu_status |= irq_status&1;
+
+ return vpu_status;
+}
+
+static void vpu_service_power_on(void)
+{
+ if (service.enabled)
+ return;
+
+ printk("vpu: power on\n");
+ clk_enable(aclk_vepu);
+ clk_enable(hclk_vepu);
+ clk_enable(hclk_cpu_vcodec);
+ udelay(10);
+ pmu_set_power_domain(PD_VCODEC, true);
+ udelay(10);
+ clk_enable(aclk_ddr_vepu);
+ service.enabled = true;
+}
+
+static void vpu_service_power_off(void)
+{
+ if (!service.enabled)
+ return;
+
+ while(atomic_read(&service.task_running))
+ udelay(10);
+
+ //while (vpu_service_is_working())
+ // udelay(10);
+
+ printk("vpu: power off\n");
+ pmu_set_power_domain(PD_VCODEC, false);
+ udelay(10);
+ clk_disable(hclk_cpu_vcodec);
+ clk_disable(aclk_ddr_vepu);
+ clk_disable(hclk_vepu);
+ clk_disable(aclk_vepu);
+
+ service.enabled = false;
+}
+
+static void vpu_service_power_off_work_func(struct work_struct *work)
+{
+ pr_debug("work\n");
+ vpu_service_power_off();
+}
+
+static vpu_reg *reg_init(vpu_session *session, void __user *src, unsigned long size)
+{
+ unsigned long flag;
+ vpu_reg *reg = kmalloc(sizeof(vpu_reg), GFP_KERNEL);
+ //FUN;
+ if (NULL == reg) {
+ pr_err("kmalloc fail in reg_init\n");
+ return NULL;
+ }
+
+ reg->session = session;
+ reg->type = session->type;
+ reg->size = size;
+ INIT_LIST_HEAD(®->session_link);
+ INIT_LIST_HEAD(®->status_link);
+
+ if (copy_from_user(®->reg[0], (void __user *)src, size)) {
+ pr_err("copy_from_user failed in reg_init\n");
+ kfree(reg);
+ return NULL;
+ }
+
+ spin_lock_irqsave(&service.lock, flag);
+ list_add_tail(®->status_link, &service.waiting);
+ list_add_tail(®->session_link, &session->waiting);
+ spin_unlock_irqrestore(&service.lock, flag);
+
+ return reg;
+}
+
+static void reg_deinit(vpu_reg *reg)
+{
+ list_del_init(®->session_link);
+ list_del_init(®->status_link);
+ kfree(reg);
+ if (reg == service.reg_dec) service.reg_dec = NULL;
+ if (reg == service.reg_enc) service.reg_enc = NULL;
+ if (reg == service.reg_pp) service.reg_pp = NULL;
+}
+
+static void reg_from_wait_to_run(vpu_reg *reg)
+{
+ //FUN;
+ list_del_init(®->status_link);
+ list_add_tail(®->status_link, &service.running);
+
+ list_del_init(®->session_link);
+ list_add_tail(®->session_link, ®->session->running);
+
+ atomic_add(1, &service.task_running);
+}
+
+static void reg_copy_from_hw(vpu_reg *reg, volatile u32 *src, u32 count)
+{
+ int i;
+ u32 *dst = (u32 *)®->reg[0];
+ //FUN;
+ for (i = 0; i < count; i++)
+ *dst++ = *src++;
+}
+
+static void reg_from_run_to_done(vpu_reg *reg)
+{
+ //FUN;
+ //printk("r\n");
+ spin_lock(&service.lock);
+ list_del_init(®->status_link);
+ list_add_tail(®->status_link, &service.done);
+
+ list_del_init(®->session_link);
+ list_add_tail(®->session_link, ®->session->done);
+
+ switch (reg->type) {
+ case VPU_ENC : {
+ service.reg_enc = NULL;
+ reg_copy_from_hw(reg, enc_dev.hwregs, REG_NUM_ENC);
+ break;
+ }
+ case VPU_DEC : {
+ service.reg_dec = NULL;
+ reg_copy_from_hw(reg, dec_dev.hwregs, REG_NUM_DEC);
+ break;
+ }
+ case VPU_PP : {
+ service.reg_pp = NULL;
+ reg_copy_from_hw(reg, dec_dev.hwregs + PP_INTERRUPT_REGISTER, REG_NUM_PP);
+ break;
+ }
+ case VPU_DEC_PP : {
+ service.reg_dec = NULL;
+ service.reg_pp = NULL;
+ reg_copy_from_hw(reg, dec_dev.hwregs, REG_NUM_DEC_PP);
+ break;
+ }
+ default : {
+ pr_err("copy reg from hw with unknown type %d\n", reg->type);
+ break;
+ }
+ }
+ atomic_sub(1, &service.task_running);
+ wake_up_interruptible_sync(®->session->wait);
+ spin_unlock(&service.lock);
+}
+
+void reg_copy_to_hw(vpu_reg *reg)
+{
+ int i;
+ u32 *src = (u32 *)®->reg[0];
+
+ switch (reg->type) {
+ case VPU_ENC : {
+ u32 *dst = (u32 *)enc_dev.hwregs;
+ service.reg_enc = reg;
+
+ dst[VPU_REG_EN_ENC] = src[VPU_REG_EN_ENC] & 0x6;
+
+ for (i = 0; i < VPU_REG_EN_ENC; i++)
+ dst[i] = src[i];
+
+ for (i = VPU_REG_EN_ENC + 1; i < REG_NUM_ENC; i++)
+ dst[i] = src[i];
+
+ dsb();
+
+ dst[VPU_REG_ENC_GATE] = src[VPU_REG_ENC_GATE] | VPU_REG_ENC_GATE_BIT;
+ dst[VPU_REG_EN_ENC] = src[VPU_REG_EN_ENC];
+ } break;
+ case VPU_DEC : {
+ u32 *dst = (u32 *)dec_dev.hwregs;
+ if (NULL == service.reg_pp) {
+ dst[PP_INTERRUPT_REGISTER] = 0;
+ }
+
+ service.reg_dec = reg;
+
+ for (i = REG_NUM_DEC - 1; i > VPU_REG_DEC_GATE; i--)
+ dst[i] = src[i];
+
+ dsb();
+
+ dst[VPU_REG_DEC_GATE] = src[VPU_REG_DEC_GATE] | VPU_REG_DEC_GATE_BIT;
+ dst[VPU_REG_EN_DEC] = src[VPU_REG_EN_DEC];
+ } break;
+ case VPU_PP : {
+ u32 *dst = (u32 *)dec_dev.hwregs + PP_INTERRUPT_REGISTER;
+ service.reg_pp = reg;
+
+ dst[VPU_REG_PP_GATE] = src[VPU_REG_PP_GATE] | VPU_REG_PP_GATE_BIT;
+
+ for (i = VPU_REG_PP_GATE + 1; i < REG_NUM_PP; i++)
+ dst[i] = src[i];
+
+ dsb();
+
+ dst[VPU_REG_EN_PP] = src[VPU_REG_EN_PP];
+ } break;
+ case VPU_DEC_PP : {
+ u32 *dst = (u32 *)dec_dev.hwregs;
+ service.reg_dec = reg;
+ service.reg_pp = reg;
+
+ for (i = VPU_REG_EN_DEC_PP + 1; i < REG_NUM_DEC_PP; i++)
+ dst[i] = src[i];
+
+ dsb();
+
+ dst[VPU_REG_DEC_PP_GATE] = src[VPU_REG_DEC_PP_GATE] | VPU_REG_PP_GATE_BIT;
+ dst[VPU_REG_DEC_GATE] = src[VPU_REG_DEC_GATE] | VPU_REG_DEC_GATE_BIT;
+ dst[VPU_REG_EN_DEC] = src[VPU_REG_EN_DEC];
+ } break;
+ default : {
+ pr_err("unsupport session type %d", reg->type);
+ break;
+ }
+ }
+}
+
+static void try_set_reg(void)
+{
+ unsigned long flag;
+ //FUN;
+ // first get reg from reg list
+ spin_lock_irqsave(&service.lock, flag);
+ if (!list_empty(&service.waiting)) {
+ vpu_reg *reg = list_entry(service.waiting.next, vpu_reg, status_link);
+
+ if (((VPU_DEC_PP == reg->type) && (NULL == service.reg_dec) && (NULL == service.reg_pp)) ||
+ ((VPU_DEC == reg->type) && (NULL == service.reg_dec)) ||
+ ((VPU_PP == reg->type) && (NULL == service.reg_pp)) ||
+ ((VPU_ENC == reg->type) && (NULL == service.reg_enc))) {
+ reg_from_wait_to_run(reg);
+ __cancel_delayed_work(&vpu_service_power_off_work);
+ vpu_service_power_on();
+ reg_copy_to_hw(reg);
+ }
+ spin_unlock_irqrestore(&service.lock, flag);
+ } else {
+ spin_unlock_irqrestore(&service.lock, flag);
+ schedule_delayed_work(&vpu_service_power_off_work, POWER_OFF_DELAY);
+ }
+}
+
+static int return_reg(vpu_reg *reg, u32 __user *dst)
+{
+ int ret = 0;
+ //FUN;
+ switch (reg->type) {
+ case VPU_ENC : {
+ if (copy_to_user(dst, ®->reg[0], SIZE_REG(REG_NUM_ENC)))
+ ret = -EFAULT;
+ break;
+ }
+ case VPU_DEC : {
+ if (copy_to_user(dst, ®->reg[0], SIZE_REG(REG_NUM_DEC)))
+ ret = -EFAULT;
+ break;
+ }
+ case VPU_PP : {
+ if (copy_to_user(dst, ®->reg[0], SIZE_REG(REG_NUM_PP)))
+ ret = -EFAULT;
+ break;
+ }
+ case VPU_DEC_PP : {
+ if (copy_to_user(dst, ®->reg[0], SIZE_REG(REG_NUM_DEC_PP)))
+ ret = -EFAULT;
+ break;
+ }
+ default : {
+ ret = -EFAULT;
+ pr_err("copy reg to user with unknown type %d\n", reg->type);
+ break;
+ }
+ }
+ reg_deinit(reg);
+ return ret;
+}
+
+static long vpu_service_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+{
+ vpu_session *session = (vpu_session *)filp->private_data;
+ //FUN;
+ if (NULL == session) {
+ return -EINVAL;
+ }
+
+ switch (cmd) {
+ case VPU_IOC_SET_CLIENT_TYPE : {
+ session->type = (VPU_CLIENT_TYPE)arg;
+ break;
+ }
+ case VPU_IOC_GET_HW_FUSE_STATUS : {
+ vpu_request req;
+ if (copy_from_user(&req, (void __user *)arg, sizeof(vpu_request))) {
+ pr_err("VPU_IOC_GET_HW_FUSE_STATUS copy_from_user failed\n");
+ return -EFAULT;
+ } else {
+ if (VPU_ENC != session->type) {
+ if (copy_to_user((void __user *)req.req, &service.dec_config, sizeof(VPUHwDecConfig_t))) {
+ pr_err("VPU_IOC_GET_HW_FUSE_STATUS copy_to_user failed type %d\n", session->type);
+ return -EFAULT;
+ }
+ } else {
+ if (copy_to_user((void __user *)req.req, &service.enc_config, sizeof(VPUHwEncConfig_t))) {
+ pr_err("VPU_IOC_GET_HW_FUSE_STATUS copy_to_user failed type %d\n", session->type);
+ return -EFAULT;
+ }
+ }
+ }
+
+ break;
+ }
+ case VPU_IOC_SET_REG : {
+ vpu_request req;
+ vpu_reg *reg;
+ if (copy_from_user(&req, (void __user *)arg, sizeof(vpu_request))) {
+ pr_err("VPU_IOC_SET_REG copy_from_user failed\n");
+ return -EFAULT;
+ }
+
+ reg = reg_init(session, (void __user *)req.req, req.size);
+ if (NULL == reg) {
+ return -EFAULT;
+ } else {
+ try_set_reg();
+ }
+
+ break;
+ }
+ case VPU_IOC_GET_REG : {
+ vpu_request req;
+ vpu_reg *reg;
+ if (copy_from_user(&req, (void __user *)arg, sizeof(vpu_request))) {
+ pr_err("VPU_IOC_GET_REG copy_from_user failed\n");
+ return -EFAULT;
+ } else {
+ int ret = wait_event_interruptible_timeout(session->wait, !list_empty(&session->done), HZ);
+ if (unlikely(ret < 0)) {
+ pr_err("pid %d wait task ret %d\n", session->pid, ret);
+ return ret;
+ } else if (0 == ret) {
+ pr_err("pid %d wait task done timeout\n", session->pid);
+ return -ETIMEDOUT;
+ }
+ }
+ {
+ unsigned long flag;
+ spin_lock_irqsave(&service.lock, flag);
+ reg = list_entry(session->done.next, vpu_reg, session_link);
+ return_reg(reg, (u32 __user *)req.req);
+ spin_unlock_irqrestore(&service.lock, flag);
+ }
+ break;
+ }
+ default : {
+ pr_err("unknow vpu service ioctl cmd %x\n", cmd);
+ break;
+ }
+ }
+
+ return 0;
+}
+
+static int vpu_service_check_hw_id(struct vpu_device * dev, const u16 *hwids, size_t num)
+{
+ u32 hwid = readl(dev->hwregs);
+ //FUN;
+ pr_info("HW ID = 0x%08x\n", hwid);
+
+ hwid = (hwid >> 16) & 0xFFFF; /* product version only */
+
+ while (num--) {
+ if (hwid == hwids[num]) {
+ pr_info("Compatible HW found at 0x%08lx\n", dev->iobaseaddr);
+ return 1;
+ }
+ }
+
+ pr_info("No Compatible HW found at 0x%08lx\n", dev->iobaseaddr);
+ return 0;
+}
+
+static void vpu_service_release_io(void)
+{
+ //FUN;
+ if (dec_dev.hwregs)
+ iounmap((void *)dec_dev.hwregs);
+ release_mem_region(dec_dev.iobaseaddr, dec_dev.iosize);
+
+ if (enc_dev.hwregs)
+ iounmap((void *)enc_dev.hwregs);
+ release_mem_region(enc_dev.iobaseaddr, enc_dev.iosize);
+}
+
+static int vpu_service_reserve_io(void)
+{
+ unsigned long iobaseaddr;
+ unsigned long iosize;
+
+ //FUN;
+ iobaseaddr = dec_dev.iobaseaddr;
+ iosize = dec_dev.iosize;
+
+ if (!request_mem_region(iobaseaddr, iosize, "vdpu_io")) {
+ pr_info("failed to reserve dec HW regs\n");
+ return -EBUSY;
+ }
+
+ dec_dev.hwregs = (volatile u32 *)ioremap_nocache(iobaseaddr, iosize);
+
+ if (dec_dev.hwregs == NULL) {
+ pr_info("failed to ioremap dec HW regs\n");
+ goto err;
+ }
+
+ /* check for correct HW */
+ if (!vpu_service_check_hw_id(&dec_dev, dec_hw_ids, ARRAY_SIZE(dec_hw_ids))) {
+ goto err;
+ }
+
+ iobaseaddr = enc_dev.iobaseaddr;
+ iosize = enc_dev.iosize;
+
+ if (!request_mem_region(iobaseaddr, iosize, "hx280enc")) {
+ pr_info("failed to reserve enc HW regs\n");
+ goto err;
+ }
+
+ enc_dev.hwregs = (volatile u32 *)ioremap_nocache(iobaseaddr, iosize);
+
+ if (enc_dev.hwregs == NULL) {
+ pr_info("failed to ioremap enc HW regs\n");
+ goto err;
+ }
+
+ /* check for correct HW */
+ if (!vpu_service_check_hw_id(&enc_dev, enc_hw_ids, ARRAY_SIZE(enc_hw_ids))) {
+ goto err;
+ }
+ return 0;
+
+err:
+ vpu_service_release_io();
+ return -EBUSY;
+}
+
+static int vpu_service_open(struct inode *inode, struct file *filp)
+{
+ vpu_session *session = (vpu_session *)kmalloc(sizeof(vpu_session), GFP_KERNEL);
+ //FUN;
+ if (NULL == session) {
+ pr_err("unable to allocate memory for vpu_session.");
+ return -ENOMEM;
+ }
+
+ session->type = VPU_TYPE_BUTT;
+ session->pid = current->pid;
+ INIT_LIST_HEAD(&session->waiting);
+ INIT_LIST_HEAD(&session->running);
+ INIT_LIST_HEAD(&session->done);
+ INIT_LIST_HEAD(&session->list_session);
+ init_waitqueue_head(&session->wait);
+ /* no need to protect */
+ list_add_tail(&session->list_session, &service.session);
+ filp->private_data = (void *)session;
+
+ pr_debug("dev opened\n");
+ return nonseekable_open(inode, filp);
+}
+
+static int vpu_service_release(struct inode *inode, struct file *filp)
+{
+ unsigned long flag;
+ vpu_session *session = (vpu_session *)filp->private_data;
+ //FUN;
+ if (NULL == session)
+ return -EINVAL;
+
+ wake_up_interruptible_sync(&session->wait);
+
+ msleep(50);
+ /* remove this filp from the asynchronusly notified filp's */
+ //vpu_service_fasync(-1, filp, 0);
+ list_del(&session->list_session);
+
+ spin_lock_irqsave(&service.lock, flag);
+ {
+ vpu_reg *reg, *n;
+ list_for_each_entry_safe(reg, n, &session->waiting, session_link) {
+ reg_deinit(reg);
+ }
+ list_for_each_entry_safe(reg, n, &session->running, session_link) {
+ reg_deinit(reg);
+ }
+ list_for_each_entry_safe(reg, n, &session->done, session_link) {
+ reg_deinit(reg);
+ }
+ }
+ spin_unlock_irqrestore(&service.lock, flag);
+
+ kfree(session);
+
+ pr_debug("dev closed\n");
+ return 0;
+}
+
+static const struct file_operations vpu_service_fops = {
+ .unlocked_ioctl = vpu_service_ioctl,
+ .open = vpu_service_open,
+ .release = vpu_service_release,
+ //.fasync = vpu_service_fasync,
+};
+
+static struct miscdevice vpu_service_misc_device = {
+ .minor = MISC_DYNAMIC_MINOR,
+ .name = "vpu_service",
+ .fops = &vpu_service_fops,
+};
+
+static void vpu_service_shutdown(struct platform_device *pdev)
+{
+ //FUN;
+ //printk("vpu_service_shutdown\n");
+ __cancel_delayed_work(&vpu_service_power_off_work);
+ vpu_service_power_off();
+ pr_cont("done\n");
+}
+
+static int vpu_service_suspend(struct platform_device *pdev, pm_message_t state)
+{
+ bool enabled;
+ //FUN;
+ //printk("vpu_service_suspend\n");
+ pr_info("suspend...");
+
+ __cancel_delayed_work(&vpu_service_power_off_work);
+ enabled = service.enabled;
+ vpu_service_power_off();
+ service.enabled = enabled;
+ return 0;
+}
+
+static int vpu_service_resume(struct platform_device *pdev)
+{
+ //FUN;
+ printk("vpu_service_resume\n");
+ if (service.enabled) {
+ service.enabled = false;
+ vpu_service_power_on();
+ }
+ return 0;
+}
+
+static struct platform_device vpu_service_device = {
+ .name = "vpu_service",
+ .id = -1,
+};
+
+static struct platform_driver vpu_service_driver = {
+ .driver = {
+ .name = "vpu_service",
+ .owner = THIS_MODULE,
+ },
+ .shutdown = vpu_service_shutdown,
+ .suspend = vpu_service_suspend,
+ .resume = vpu_service_resume,
+};
+
+static void get_hw_info(void)
+{
+ VPUHwDecConfig_t *dec = &service.dec_config;
+ VPUHwEncConfig_t *enc = &service.enc_config;
+ u32 configReg = dec_dev.hwregs[VPU_DEC_HWCFG0];
+ u32 asicID = dec_dev.hwregs[0];
+
+ dec->h264Support = (configReg >> DWL_H264_E) & 0x3U;
+ dec->jpegSupport = (configReg >> DWL_JPEG_E) & 0x01U;
+ if (dec->jpegSupport && ((configReg >> DWL_PJPEG_E) & 0x01U))
+ dec->jpegSupport = JPEG_PROGRESSIVE;
+ dec->mpeg4Support = (configReg >> DWL_MPEG4_E) & 0x3U;
+ dec->vc1Support = (configReg >> DWL_VC1_E) & 0x3U;
+ dec->mpeg2Support = (configReg >> DWL_MPEG2_E) & 0x01U;
+ dec->sorensonSparkSupport = (configReg >> DWL_SORENSONSPARK_E) & 0x01U;
+ dec->refBufSupport = (configReg >> DWL_REF_BUFF_E) & 0x01U;
+ dec->vp6Support = (configReg >> DWL_VP6_E) & 0x01U;
+ dec->maxDecPicWidth = configReg & 0x07FFU;
+
+ /* 2nd Config register */
+ configReg = dec_dev.hwregs[VPU_DEC_HWCFG1];
+ if (dec->refBufSupport) {
+ if ((configReg >> DWL_REF_BUFF_ILACE_E) & 0x01U)
+ dec->refBufSupport |= 2;
+ if ((configReg >> DWL_REF_BUFF_DOUBLE_E) & 0x01U)
+ dec->refBufSupport |= 4;
+ }
+ dec->customMpeg4Support = (configReg >> DWL_MPEG4_CUSTOM_E) & 0x01U;
+ dec->vp7Support = (configReg >> DWL_VP7_E) & 0x01U;
+ dec->vp8Support = (configReg >> DWL_VP8_E) & 0x01U;
+ dec->avsSupport = (configReg >> DWL_AVS_E) & 0x01U;
+
+ /* JPEG xtensions */
+ if (((asicID >> 16) >= 0x8190U) || ((asicID >> 16) == 0x6731U)) {
+ dec->jpegESupport = (configReg >> DWL_JPEG_EXT_E) & 0x01U;
+ } else {
+ dec->jpegESupport = JPEG_EXT_NOT_SUPPORTED;
+ }
+
+ if (((asicID >> 16) >= 0x9170U) || ((asicID >> 16) == 0x6731U) ) {
+ dec->rvSupport = (configReg >> DWL_RV_E) & 0x03U;
+ } else {
+ dec->rvSupport = RV_NOT_SUPPORTED;
+ }
+
+ dec->mvcSupport = (configReg >> DWL_MVC_E) & 0x03U;
+
+ if (dec->refBufSupport && (asicID >> 16) == 0x6731U ) {
+ dec->refBufSupport |= 8; /* enable HW support for offset */
+ }
+
+ {
+ VPUHwFuseStatus_t hwFuseSts;
+ /* Decoder fuse configuration */
+ u32 fuseReg = dec_dev.hwregs[VPU_DEC_HW_FUSE_CFG];
+
+ hwFuseSts.h264SupportFuse = (fuseReg >> DWL_H264_FUSE_E) & 0x01U;
+ hwFuseSts.mpeg4SupportFuse = (fuseReg >> DWL_MPEG4_FUSE_E) & 0x01U;
+ hwFuseSts.mpeg2SupportFuse = (fuseReg >> DWL_MPEG2_FUSE_E) & 0x01U;
+ hwFuseSts.sorensonSparkSupportFuse = (fuseReg >> DWL_SORENSONSPARK_FUSE_E) & 0x01U;
+ hwFuseSts.jpegSupportFuse = (fuseReg >> DWL_JPEG_FUSE_E) & 0x01U;
+ hwFuseSts.vp6SupportFuse = (fuseReg >> DWL_VP6_FUSE_E) & 0x01U;
+ hwFuseSts.vc1SupportFuse = (fuseReg >> DWL_VC1_FUSE_E) & 0x01U;
+ hwFuseSts.jpegProgSupportFuse = (fuseReg >> DWL_PJPEG_FUSE_E) & 0x01U;
+ hwFuseSts.rvSupportFuse = (fuseReg >> DWL_RV_FUSE_E) & 0x01U;
+ hwFuseSts.avsSupportFuse = (fuseReg >> DWL_AVS_FUSE_E) & 0x01U;
+ hwFuseSts.vp7SupportFuse = (fuseReg >> DWL_VP7_FUSE_E) & 0x01U;
+ hwFuseSts.vp8SupportFuse = (fuseReg >> DWL_VP8_FUSE_E) & 0x01U;
+ hwFuseSts.customMpeg4SupportFuse = (fuseReg >> DWL_CUSTOM_MPEG4_FUSE_E) & 0x01U;
+ hwFuseSts.mvcSupportFuse = (fuseReg >> DWL_MVC_FUSE_E) & 0x01U;
+
+ /* check max. decoder output width */
+
+ if (fuseReg & 0x8000U)
+ hwFuseSts.maxDecPicWidthFuse = 1920;
+ else if (fuseReg & 0x4000U)
+ hwFuseSts.maxDecPicWidthFuse = 1280;
+ else if (fuseReg & 0x2000U)
+ hwFuseSts.maxDecPicWidthFuse = 720;
+ else if (fuseReg & 0x1000U)
+ hwFuseSts.maxDecPicWidthFuse = 352;
+ else /* remove warning */
+ hwFuseSts.maxDecPicWidthFuse = 352;
+
+ hwFuseSts.refBufSupportFuse = (fuseReg >> DWL_REF_BUFF_FUSE_E) & 0x01U;
+
+ /* Pp configuration */
+ configReg = dec_dev.hwregs[VPU_PP_HW_SYNTH_CFG];
+
+ if ((configReg >> DWL_PP_E) & 0x01U) {
+ dec->ppSupport = 1;
+ dec->maxPpOutPicWidth = configReg & 0x07FFU;
+ /*pHwCfg->ppConfig = (configReg >> DWL_CFG_E) & 0x0FU; */
+ dec->ppConfig = configReg;
+ } else {
+ dec->ppSupport = 0;
+ dec->maxPpOutPicWidth = 0;
+ dec->ppConfig = 0;
+ }
+
+ /* check the HW versio */
+ if (((asicID >> 16) >= 0x8190U) || ((asicID >> 16) == 0x6731U)) {
+ /* Pp configuration */
+ configReg = dec_dev.hwregs[VPU_DEC_HW_FUSE_CFG];
+
+ if ((configReg >> DWL_PP_E) & 0x01U) {
+ /* Pp fuse configuration */
+ u32 fuseRegPp = dec_dev.hwregs[VPU_PP_HW_FUSE_CFG];
+
+ if ((fuseRegPp >> DWL_PP_FUSE_E) & 0x01U) {
+ hwFuseSts.ppSupportFuse = 1;
+ /* check max. pp output width */
+ if (fuseRegPp & 0x8000U) hwFuseSts.maxPpOutPicWidthFuse = 1920;
+ else if (fuseRegPp & 0x4000U) hwFuseSts.maxPpOutPicWidthFuse = 1280;
+ else if (fuseRegPp & 0x2000U) hwFuseSts.maxPpOutPicWidthFuse = 720;
+ else if (fuseRegPp & 0x1000U) hwFuseSts.maxPpOutPicWidthFuse = 352;
+ else hwFuseSts.maxPpOutPicWidthFuse = 352;
+ hwFuseSts.ppConfigFuse = fuseRegPp;
+ } else {
+ hwFuseSts.ppSupportFuse = 0;
+ hwFuseSts.maxPpOutPicWidthFuse = 0;
+ hwFuseSts.ppConfigFuse = 0;
+ }
+ } else {
+ hwFuseSts.ppSupportFuse = 0;
+ hwFuseSts.maxPpOutPicWidthFuse = 0;
+ hwFuseSts.ppConfigFuse = 0;
+ }
+
+ if (dec->maxDecPicWidth > hwFuseSts.maxDecPicWidthFuse)
+ dec->maxDecPicWidth = hwFuseSts.maxDecPicWidthFuse;
+ if (dec->maxPpOutPicWidth > hwFuseSts.maxPpOutPicWidthFuse)
+ dec->maxPpOutPicWidth = hwFuseSts.maxPpOutPicWidthFuse;
+ if (!hwFuseSts.h264SupportFuse) dec->h264Support = H264_NOT_SUPPORTED;
+ if (!hwFuseSts.mpeg4SupportFuse) dec->mpeg4Support = MPEG4_NOT_SUPPORTED;
+ if (!hwFuseSts.customMpeg4SupportFuse) dec->customMpeg4Support = MPEG4_CUSTOM_NOT_SUPPORTED;
+ if (!hwFuseSts.jpegSupportFuse) dec->jpegSupport = JPEG_NOT_SUPPORTED;
+ if ((dec->jpegSupport == JPEG_PROGRESSIVE) && !hwFuseSts.jpegProgSupportFuse)
+ dec->jpegSupport = JPEG_BASELINE;
+ if (!hwFuseSts.mpeg2SupportFuse) dec->mpeg2Support = MPEG2_NOT_SUPPORTED;
+ if (!hwFuseSts.vc1SupportFuse) dec->vc1Support = VC1_NOT_SUPPORTED;
+ if (!hwFuseSts.vp6SupportFuse) dec->vp6Support = VP6_NOT_SUPPORTED;
+ if (!hwFuseSts.vp7SupportFuse) dec->vp7Support = VP7_NOT_SUPPORTED;
+ if (!hwFuseSts.vp8SupportFuse) dec->vp8Support = VP8_NOT_SUPPORTED;
+ if (!hwFuseSts.ppSupportFuse) dec->ppSupport = PP_NOT_SUPPORTED;
+
+ /* check the pp config vs fuse status */
+ if ((dec->ppConfig & 0xFC000000) && ((hwFuseSts.ppConfigFuse & 0xF0000000) >> 5)) {
+ u32 deInterlace = ((dec->ppConfig & PP_DEINTERLACING) >> 25);
+ u32 alphaBlend = ((dec->ppConfig & PP_ALPHA_BLENDING) >> 24);
+ u32 deInterlaceFuse = (((hwFuseSts.ppConfigFuse >> 5) & PP_DEINTERLACING) >> 25);
+ u32 alphaBlendFuse = (((hwFuseSts.ppConfigFuse >> 5) & PP_ALPHA_BLENDING) >> 24);
+
+ if (deInterlace && !deInterlaceFuse) dec->ppConfig &= 0xFD000000;
+ if (alphaBlend && !alphaBlendFuse) dec->ppConfig &= 0xFE000000;
+ }
+ if (!hwFuseSts.sorensonSparkSupportFuse) dec->sorensonSparkSupport = SORENSON_SPARK_NOT_SUPPORTED;
+ if (!hwFuseSts.refBufSupportFuse) dec->refBufSupport = REF_BUF_NOT_SUPPORTED;
+ if (!hwFuseSts.rvSupportFuse) dec->rvSupport = RV_NOT_SUPPORTED;
+ if (!hwFuseSts.avsSupportFuse) dec->avsSupport = AVS_NOT_SUPPORTED;
+ if (!hwFuseSts.mvcSupportFuse) dec->mvcSupport = MVC_NOT_SUPPORTED;
+ }
+ }
+ configReg = enc_dev.hwregs[63];
+ enc->maxEncodedWidth = configReg & ((1 << 11) - 1);
+ enc->h264Enabled = (configReg >> 27) & 1;
+ enc->mpeg4Enabled = (configReg >> 26) & 1;
+ enc->jpegEnabled = (configReg >> 25) & 1;
+ enc->vsEnabled = (configReg >> 24) & 1;
+ enc->rgbEnabled = (configReg >> 28) & 1;
+ enc->busType = (configReg >> 20) & 15;
+ enc->synthesisLanguage = (configReg >> 16) & 15;
+ enc->busWidth = (configReg >> 12) & 15;
+}
+
+static irqreturn_t vdpu_isr(int irq, void *dev_id)
+{
+ vpu_device *dev = (vpu_device *) dev_id;
+ u32 irq_status_dec = readl(dev->hwregs + DEC_INTERRUPT_REGISTER);
+ u32 irq_status_pp = readl(dev->hwregs + PP_INTERRUPT_REGISTER);
+
+ pr_debug("vdpu_isr dec %x pp %x\n", irq_status_dec, irq_status_pp);
+
+ if (irq_status_dec & DEC_INTERRUPT_BIT) {
+ irq_status_dec = readl(dev->hwregs + DEC_INTERRUPT_REGISTER);
+ if ((irq_status_dec & 0x40001) == 0x40001)
+ {
+ do {
+ irq_status_dec = readl(dev->hwregs + DEC_INTERRUPT_REGISTER);
+ } while ((irq_status_dec & 0x40001) == 0x40001);
+ }
+ /* clear dec IRQ */
+ writel(irq_status_dec & (~DEC_INTERRUPT_BIT), dev->hwregs + DEC_INTERRUPT_REGISTER);
+ pr_debug("DEC IRQ received!\n");
+ if (NULL == service.reg_dec) {
+ pr_err("dec isr with no task waiting\n");
+ } else {
+ reg_from_run_to_done(service.reg_dec);
+ }
+ }
+
+ if (irq_status_pp & PP_INTERRUPT_BIT) {
+ /* clear pp IRQ */
+ writel(irq_status_pp & (~DEC_INTERRUPT_BIT), dev->hwregs + PP_INTERRUPT_REGISTER);
+ pr_debug("PP IRQ received!\n");
+
+ if (NULL == service.reg_pp) {
+ pr_err("pp isr with no task waiting\n");
+ } else {
+ reg_from_run_to_done(service.reg_pp);
+ }
+ }
+ try_set_reg();
+ return IRQ_HANDLED;
+}
+
+static irqreturn_t vepu_isr(int irq, void *dev_id)
+{
+ struct vpu_device *dev = (struct vpu_device *) dev_id;
+ u32 irq_status = readl(dev->hwregs + ENC_INTERRUPT_REGISTER);
+
+ pr_debug("enc_isr\n");
+
+ if (likely(irq_status & ENC_INTERRUPT_BIT)) {
+ /* clear enc IRQ */
+ writel(irq_status & (~ENC_INTERRUPT_BIT), dev->hwregs + ENC_INTERRUPT_REGISTER);
+ pr_debug("ENC IRQ received!\n");
+
+ if (NULL == service.reg_enc) {
+ pr_err("enc isr with no task waiting\n");
+ } else {
+ reg_from_run_to_done(service.reg_enc);
+ }
+ }
+ try_set_reg();
+ return IRQ_HANDLED;
+}
+
+static int __init vpu_service_init(void)
+{
+ int ret;
+
+ pr_debug("baseaddr = 0x%08x vdpu irq = %d vepu irq = %d\n", RK29_VCODEC_PHYS, IRQ_VDPU, IRQ_VEPU);
+
+ dec_dev.iobaseaddr = RK29_VCODEC_PHYS + 0x200;
+ dec_dev.iosize = DEC_IO_SIZE;
+ enc_dev.iobaseaddr = RK29_VCODEC_PHYS;
+ enc_dev.iosize = ENC_IO_SIZE;
+
+ INIT_LIST_HEAD(&service.waiting);
+ INIT_LIST_HEAD(&service.running);
+ INIT_LIST_HEAD(&service.done);
+ INIT_LIST_HEAD(&service.session);
+ spin_lock_init(&service.lock);
+ service.reg_dec = NULL;
+ service.reg_enc = NULL;
+ service.reg_pp = NULL;
+ atomic_set(&service.task_running, 0);
+ service.enabled = false;
+
+ vpu_get_clk();
+ vpu_service_power_on();
+
+ ret = vpu_service_reserve_io();
+ if (ret < 0) {
+ pr_err("reserve io failed\n");
+ goto err_reserve_io;
+ }
+
+ /* get the IRQ line */
+ ret = request_irq(IRQ_VDPU, vdpu_isr, IRQF_SHARED, "vdpu", (void *)&dec_dev);
+ if (ret) {
+ pr_err("can't request vdpu irq %d\n", IRQ_VDPU);
+ goto err_req_vdpu_irq;
+ }
+
+ ret = request_irq(IRQ_VEPU, vepu_isr, IRQF_SHARED, "vepu", (void *)&enc_dev);
+ if (ret) {
+ pr_err("can't request vepu irq %d\n", IRQ_VEPU);
+ goto err_req_vepu_irq;
+ }
+
+ ret = misc_register(&vpu_service_misc_device);
+ if (ret) {
+ pr_err("misc_register failed\n");
+ goto err_register;
+ }
+
+ platform_device_register(&vpu_service_device);
+ platform_driver_probe(&vpu_service_driver, NULL);
+ get_hw_info();
+ vpu_service_power_off();
+ pr_info("init success\n");
+
+ return 0;
+
+err_register:
+ free_irq(IRQ_VEPU, (void *)&enc_dev);
+err_req_vepu_irq:
+ free_irq(IRQ_VDPU, (void *)&dec_dev);
+err_req_vdpu_irq:
+ pr_info("init failed\n");
+err_reserve_io:
+ vpu_service_power_off();
+ vpu_service_release_io();
+ vpu_put_clk();
+ pr_info("init failed\n");
+ return ret;
+}
+
+static void __exit vpu_service_exit(void)
+{
+ __cancel_delayed_work(&vpu_service_power_off_work);
+ vpu_service_power_off();
+ platform_device_unregister(&vpu_service_device);
+ platform_driver_unregister(&vpu_service_driver);
+ misc_deregister(&vpu_service_misc_device);
+ free_irq(IRQ_VEPU, (void *)&enc_dev);
+ free_irq(IRQ_VDPU, (void *)&dec_dev);
+ vpu_put_clk();
+}
+
+module_init(vpu_service_init);
+module_exit(vpu_service_exit);
+MODULE_LICENSE("GPL");
+
+#ifdef CONFIG_PROC_FS
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+
+static int proc_vpu_service_show(struct seq_file *s, void *v)
+{
+ unsigned int i, n;
+ unsigned long flag;
+ vpu_reg *reg, *reg_tmp;
+ vpu_session *session, *session_tmp;
+
+ cancel_delayed_work_sync(&vpu_service_power_off_work);
+ vpu_service_power_on();
+ seq_printf(s, "\nENC Registers:\n");
+ n = enc_dev.iosize >> 2;
+ for (i = 0; i < n; i++) {
+ seq_printf(s, "\tswreg%d = %08X\n", i, readl(enc_dev.hwregs + i));
+ }
+ seq_printf(s, "\nDEC Registers:\n");
+ n = dec_dev.iosize >> 2;
+ for (i = 0; i < n; i++) {
+ seq_printf(s, "\tswreg%d = %08X\n", i, readl(dec_dev.hwregs + i));
+ }
+
+ seq_printf(s, "\nvpu service status:\n");
+ spin_lock_irqsave(&service.lock, flag);
+ list_for_each_entry_safe(session, session_tmp, &service.session, list_session) {
+ seq_printf(s, "session pid %d type %d:\n", session->pid, session->type);
+ //seq_printf(s, "waiting reg set %d\n");
+ list_for_each_entry_safe(reg, reg_tmp, &session->waiting, session_link) {
+ seq_printf(s, "waiting register set\n");
+ }
+ list_for_each_entry_safe(reg, reg_tmp, &session->running, session_link) {
+ seq_printf(s, "running register set\n");
+ }
+ list_for_each_entry_safe(reg, reg_tmp, &session->done, session_link) {
+ seq_printf(s, "done register set\n");
+ }
+ }
+ spin_unlock_irqrestore(&service.lock, flag);
+ schedule_delayed_work(&vpu_service_power_off_work, POWER_OFF_DELAY);
+
+ return 0;
+}
+
+static int proc_vpu_service_open(struct inode *inode, struct file *file)
+{
+ return single_open(file, proc_vpu_service_show, NULL);
+}
+
+static const struct file_operations proc_vpu_service_fops = {
+ .open = proc_vpu_service_open,
+ .read = seq_read,
+ .llseek = seq_lseek,
+ .release = single_release,
+};
+
+static int __init vpu_service_proc_init(void)
+{
+ proc_create("vpu_service", 0, NULL, &proc_vpu_service_fops);
+ return 0;
+
+}
+late_initcall(vpu_service_proc_init);
+#endif /* CONFIG_PROC_FS */
+