aboutsummaryrefslogtreecommitdiff
path: root/drivers/media/dvb/ngene/ngene-v4l2.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/media/dvb/ngene/ngene-v4l2.c')
-rw-r--r--drivers/media/dvb/ngene/ngene-v4l2.c1937
1 files changed, 1937 insertions, 0 deletions
diff --git a/drivers/media/dvb/ngene/ngene-v4l2.c b/drivers/media/dvb/ngene/ngene-v4l2.c
new file mode 100644
index 00000000000..c0a9147c44a
--- /dev/null
+++ b/drivers/media/dvb/ngene/ngene-v4l2.c
@@ -0,0 +1,1937 @@
+/*
+ * ngene_v4l2.c: nGene PCIe bridge driver V4L2 support
+ *
+ * Copyright (C) 2005-2007 Micronas
+ *
+ * Based on the initial V4L2 support port by Thomas Eschbach.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * version 2 only, 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.
+ *
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
+ * 02110-1301, USA
+ * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
+ */
+
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/delay.h>
+#include <linux/sched.h>
+#include <linux/spinlock.h>
+#include <linux/fs.h>
+#include <linux/unistd.h>
+#include <linux/time.h>
+#include <linux/pci.h>
+#include <linux/vmalloc.h>
+#include <linux/pagemap.h>
+#include <linux/videodev2.h>
+#include <linux/videodev.h>
+#include <linux/version.h>
+#include <asm/uaccess.h>
+#include <asm/semaphore.h>
+#include <asm/system.h>
+#include <asm/io.h>
+#include <asm/kmap_types.h>
+#include <linux/videodev.h>
+
+#include <media/v4l2-dev.h>
+
+#include "ngene.h"
+#include "ngene-ioctls.h"
+
+/****************************************************************************/
+
+static unsigned int gbuffers = 8;
+static unsigned int gbufsize = 0x208000;
+
+enum km_type ngene_km_types[] = {
+ KM_USER0,
+ KM_USER1,
+ KM_SOFTIRQ0,
+ KM_SOFTIRQ1,
+};
+
+#define V4L2_STD_NTSC_M_KOREA ((v4l2_std_id)0x00004000)
+#define V4L2_STD_SECAM_L1 ((v4l2_std_id)0x00008000)
+
+static inline void *my_video_get_drvdata(struct video_device *vd)
+{
+ return dev_get_drvdata(vd->dev);
+}
+
+static inline void my_video_set_drvdata(struct video_device *vd, void *d)
+{
+ dev_set_drvdata(vd->dev, d);
+}
+
+static struct ngene_tvnorm ngene_tvnorms_hd[] = {
+ {
+ .v4l2_id = V4L2_STD_PAL_BG,
+ .name = "1080i50",
+ .swidth = 1920,
+ .sheight = 1080,
+ .tuner_norm = 1,
+ .soundstd = 1,
+ }
+};
+
+static struct ngene_tvnorm ngene_tvnorms_sd[] = {
+ /* PAL-BDGHI */
+ /* max. active video is actually 922, but 924 is divisible by 4 & 3!*/
+ /* actually, max active PAL with HSCALE=0 is 948, NTSC is 768 - nil */
+ {
+ .v4l2_id = V4L2_STD_PAL_BG,
+ .name = "PAL-BG",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 1,
+ .soundstd = 1,
+ }, {
+ .v4l2_id = V4L2_STD_PAL_DK,
+ .name = "PAL-DK",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 2,
+ .soundstd = 2,
+ }, {
+ .v4l2_id = V4L2_STD_PAL_H,
+ .name = "PAL-H",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 0,
+ .soundstd = 1,
+ }, {
+ .v4l2_id = V4L2_STD_PAL_I,
+ .name = "PAL-I",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 4,
+ .soundstd = 4,
+ }, {
+ .v4l2_id = V4L2_STD_PAL_M,
+ .name = "PAL_M",
+ .swidth = 720,
+ .sheight = 5760,
+ .tuner_norm = 7,
+ .soundstd = 5,
+ }, {
+ .v4l2_id = V4L2_STD_NTSC_M,
+ .name = "NTSC_M",
+ .swidth = 720,
+ .sheight = 480,
+ .tuner_norm = 7,
+ .soundstd = 5,
+ }, {
+ .v4l2_id = V4L2_STD_NTSC_M_JP,
+ .name = "NTSC_M_JP",
+ .swidth = 720,
+ .sheight = 480,
+ .tuner_norm = 7,
+ .soundstd = 6,
+ }, {
+ .v4l2_id = V4L2_STD_PAL_N,
+ .name = "PAL-N",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 7,
+ .soundstd = 5,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_B,
+ .name = "SECAM_B",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 1,
+ .soundstd = 1,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_D,
+ .name = "SECAM_D",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 2,
+ .soundstd = 2,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_G,
+ .name = "SECAM_G",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 3,
+ .soundstd = 1,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_H,
+ .name = "SECAM_H",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 3,
+ .soundstd = 1,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_K,
+ .name = "SECAM_K",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 2,
+ .soundstd = 2,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_K1,
+ .name = "SECAM_K1",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 2,
+ .soundstd = 2,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_L,
+ .name = "SECAM_L",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 5,
+ .soundstd = 3,
+ }, {
+ .v4l2_id = V4L2_STD_NTSC_M_KOREA,
+ .name = "NTSC_M_KOREA",
+ .swidth = 720,
+ .sheight = 480,
+ .tuner_norm = 7,
+ .soundstd = 7,
+ }, {
+ .v4l2_id = V4L2_STD_SECAM_L1,
+ .name = "SECAM_L1",
+ .swidth = 720,
+ .sheight = 576,
+ .tuner_norm = 6,
+ .soundstd = 3,
+ }
+
+};
+
+static const int NGENE_TVNORMS = ARRAY_SIZE(ngene_tvnorms_sd);
+
+static u8 BlackLine[1440] = {
+ /* 0x80, */ 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80, 0x10, 0x80, 0x10, 0x80, 0x10, 0x80, 0x10,
+ 0x80,
+};
+
+#define V4L2_CID_PRIVATE_SHARPNESS (V4L2_CID_PRIVATE_BASE + 0)
+#define V4L2_CID_PRIVATE_LASTP1 (V4L2_CID_PRIVATE_BASE + 1)
+
+static const struct v4l2_queryctrl no_ctl = {
+ .name = "no_ctl",
+ .flags = V4L2_CTRL_FLAG_DISABLED,
+};
+
+static const struct v4l2_queryctrl ngene_ctls[] = {
+ /* --- video --- */
+ {
+ .id = V4L2_CID_BRIGHTNESS,
+ .name = "Brightness",
+ .minimum = -127,
+ .maximum = 127,
+ .step = 1,
+ .default_value = 0,
+ .type = V4L2_CTRL_TYPE_INTEGER,
+ }, {
+ .id = V4L2_CID_CONTRAST,
+ .name = "Contrast",
+ .minimum = 0,
+ .maximum = 63,
+ .step = 1,
+ .default_value = 30,
+ .type = V4L2_CTRL_TYPE_INTEGER,
+ }, {
+ .id = V4L2_CID_SATURATION,
+ .name = "Saturation",
+ .minimum = 0,
+ .maximum = 4094,
+ .step = 1,
+ .default_value = 2000,
+ .type = V4L2_CTRL_TYPE_INTEGER,
+ }, {
+ .id = V4L2_CID_HUE,
+ .name = "Hue",
+ .minimum = -2047,
+ .maximum = 2047,
+ .step = 1,
+ .default_value = 0,
+ .type = V4L2_CTRL_TYPE_INTEGER,
+ },
+ /* --- audio --- */
+ {
+ .id = V4L2_CID_AUDIO_MUTE,
+ .name = "Mute",
+ .minimum = 0,
+ .maximum = 1,
+ .type = V4L2_CTRL_TYPE_BOOLEAN,
+ }, {
+ .id = V4L2_CID_PRIVATE_SHARPNESS,
+ .name = "sharpness",
+ .minimum = 0,
+ .maximum = 100,
+ .step = 1,
+ .default_value = 50,
+ .type = V4L2_CTRL_TYPE_INTEGER,
+ },
+
+};
+
+static const int NGENE_CTLS = ARRAY_SIZE(ngene_ctls);
+
+static const struct ngene_format ngene_formats[] = {
+ {
+ .name = "4:2:2, packed, YUYV",
+ .palette = -1,
+ .fourcc = V4L2_PIX_FMT_YUYV,
+ .format = V4L2_PIX_FMT_YUYV,
+ .palette = VIDEO_PALETTE_YUYV,
+ .depth = 16,
+ .flags = 0x02,/* FORMAT_FLAGS_PACKED, */
+ }
+};
+
+static const unsigned int NGENE_FORMATS = ARRAY_SIZE(ngene_formats);
+
+/****************************************************************************/
+
+static struct videobuf_queue *ngene_queue(struct ngene_vopen *vopen)
+{
+ struct videobuf_queue *q = NULL;
+
+ switch (vopen->type) {
+ case V4L2_BUF_TYPE_VIDEO_CAPTURE:
+ q = &vopen->vbuf_q;
+ break;
+ case V4L2_BUF_TYPE_VBI_CAPTURE:
+ q = &vopen->vbi;
+ break;
+ default:
+ break;
+ }
+ return q;
+}
+
+static int ngene_resource(struct ngene_vopen *vopen)
+{
+ int res = 0;
+
+ switch (vopen->type) {
+ case V4L2_BUF_TYPE_VIDEO_CAPTURE:
+ res = RESOURCE_VIDEO;
+ break;
+ case V4L2_BUF_TYPE_VBI_CAPTURE:
+ res = RESOURCE_VBI;
+ break;
+ default:
+ break;
+ }
+ return res;
+}
+
+static int ngene_try_fmt(struct ngene_vopen *vopen, struct ngene_channel *chan,
+ struct v4l2_format *f)
+{
+ switch (f->type) {
+
+ case V4L2_BUF_TYPE_VIDEO_CAPTURE:
+ {
+ const struct ngene_format *fmt;
+ enum v4l2_field field;
+ unsigned int maxw, maxh;
+ int maxLinesPerField;
+
+ fmt = ngene_formats;
+ if (NULL == fmt)
+ return -EINVAL;
+
+ /* fixup format */
+ maxw = chan->tvnorms[chan->tvnorm].swidth;
+ maxLinesPerField = chan->tvnorms[chan->tvnorm].sheight;
+ maxh = maxLinesPerField;
+ field = f->fmt.pix.field;
+
+ if (V4L2_FIELD_ANY == field)
+ field = (f->fmt.pix.height > maxh / 2)
+ ? V4L2_FIELD_INTERLACED : V4L2_FIELD_BOTTOM;
+
+ if (V4L2_FIELD_SEQ_BT == field)
+ field = V4L2_FIELD_SEQ_TB;
+
+ /* update data for the application */
+ f->fmt.pix.field = field;
+ if (f->fmt.pix.width < 48)
+ f->fmt.pix.width = 48;
+ if (f->fmt.pix.height < 32)
+ f->fmt.pix.height = 32;
+ if (f->fmt.pix.width > maxw)
+ f->fmt.pix.width = maxw;
+ if (f->fmt.pix.height > maxh)
+ f->fmt.pix.height = maxh;
+ f->fmt.pix.width &= ~0x03;
+ f->fmt.pix.bytesperline =
+ (f->fmt.pix.width * fmt->depth) >> 3;
+ f->fmt.pix.sizeimage =
+ f->fmt.pix.height * f->fmt.pix.bytesperline;
+
+ return 0;
+ }
+
+ case V4L2_BUF_TYPE_VIDEO_OVERLAY:
+ return -EINVAL;
+
+ case V4L2_BUF_TYPE_VBI_CAPTURE:
+ return 0;
+
+ default:
+ return -EINVAL;
+ }
+}
+
+/****************************************************************************/
+/* Analog driver stuff ******************************************************/
+/****************************************************************************/
+
+static int check_alloc_res(struct ngene_channel *channel,
+ struct ngene_vopen *vopen, int bit)
+{
+ if (vopen->resources & bit)
+ /* have it already allocated */
+ return 1;
+
+ /* is it free? */
+ down(&channel->reslock);
+ if (channel->resources & bit) {
+ /* no, someone else uses it */
+ up(&channel->reslock);
+ return 0;
+ }
+ /* it's free, grab it */
+ vopen->resources |= bit;
+ channel->resources |= bit;
+ up(&channel->reslock);
+ return 1;
+}
+
+static int check_res(struct ngene_vopen *vopen, int bit)
+{
+ return vopen->resources & bit;
+}
+
+static int locked_res(struct ngene_channel *chan, int bit)
+{
+ return chan->resources & bit;
+}
+
+static void free_res(struct ngene_channel *channel,
+ struct ngene_vopen *vopen, int bits)
+{
+ down(&channel->reslock);
+ vopen->resources &= ~bits;
+ channel->resources &= ~bits;
+ up(&channel->reslock);
+}
+
+/****************************************************************************/
+/* MISC HELPERS *************************************************************/
+/****************************************************************************/
+
+static int ngene_g_fmt(struct ngene_vopen *vopen, struct v4l2_format *f)
+{
+ if (!vopen->fmt)
+ vopen->fmt = ngene_formats;
+
+ switch (f->type) {
+ case V4L2_BUF_TYPE_VIDEO_CAPTURE:
+ memset(&f->fmt.pix, 0, sizeof(struct v4l2_pix_format));
+ f->fmt.pix.width = vopen->width;
+ f->fmt.pix.height = vopen->height;
+ f->fmt.pix.field = vopen->vbuf_q.field;
+ f->fmt.pix.pixelformat = vopen->fmt->fourcc;
+ f->fmt.pix.bytesperline = (f->fmt.pix.width * 16) >> 3;
+ f->fmt.pix.sizeimage =
+ f->fmt.pix.height * f->fmt.pix.bytesperline;
+ return 0;
+
+ case V4L2_BUF_TYPE_VIDEO_OVERLAY:
+ memset(&f->fmt.win, 0, sizeof(struct v4l2_window));
+ return 0;
+ f->fmt.win.w = vopen->ov.w;
+ f->fmt.win.field = vopen->ov.field;
+ return 0;
+
+ case V4L2_BUF_TYPE_VBI_CAPTURE:
+ return -EINVAL;
+
+ default:
+ return -EINVAL;
+ }
+}
+
+static int ngene_switch_type(struct ngene_vopen *vopen, enum v4l2_buf_type type)
+{
+ struct videobuf_queue *q = ngene_queue(vopen);
+ int res = ngene_resource(vopen);
+
+ if (check_res(vopen, res))
+ return -EBUSY;
+ if (videobuf_queue_is_busy(q))
+ return -EBUSY;
+ vopen->type = type;
+ return 0;
+}
+
+static int ngene_s_fmt(struct ngene_vopen *vopen, struct ngene_channel *chan,
+ struct v4l2_format *f)
+{
+ int retval;
+
+ switch (f->type) {
+ case V4L2_BUF_TYPE_VIDEO_CAPTURE:
+ {
+ const struct ngene_format *fmt;
+ retval = ngene_try_fmt(vopen, chan, f);
+ if (0 != retval)
+ return retval;
+
+ retval = ngene_switch_type(vopen, f->type);
+ if (0 != retval)
+ return retval;
+ fmt = ngene_formats;
+
+ if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_YUYV)
+ return -EINVAL;
+ /* update our state informations */
+ mutex_lock(&vopen->vbuf_q.lock);
+ vopen->fmt = fmt;
+ vopen->vbuf_q.field = f->fmt.pix.field;
+ vopen->vbuf_q.last = V4L2_FIELD_INTERLACED;
+ vopen->width = f->fmt.pix.width;
+ vopen->height = f->fmt.pix.height;
+ chan->init.fmt = fmt;
+ chan->init.width = f->fmt.pix.width;
+ chan->init.height = f->fmt.pix.height;
+ mutex_unlock(&vopen->vbuf_q.lock);
+
+ return 0;
+ }
+ case V4L2_BUF_TYPE_VIDEO_OVERLAY:
+ return -EINVAL;
+ case V4L2_BUF_TYPE_VBI_CAPTURE:
+ return -EINVAL;
+ default:
+ return -EINVAL;
+ }
+}
+
+/****************************************************************************/
+/* SG support ***************************************************************/
+/****************************************************************************/
+
+static inline enum km_type ngene_kmap_type(int out)
+{
+ return ngene_km_types[(in_softirq() ? 2 : 0) + out];
+}
+
+static inline void *ngene_kmap(struct page *page, int out)
+{
+ return kmap_atomic(page, ngene_kmap_type(out));
+}
+
+static inline void ngene_kunmap(void *vaddr, int out)
+{
+ kunmap_atomic(vaddr, ngene_kmap_type(out));
+}
+
+struct scatter_walk {
+ struct scatterlist *sg;
+ struct page *page;
+ void *data;
+ unsigned int len_this_page;
+ unsigned int len_this_segment;
+ unsigned int offset;
+};
+
+static inline struct scatterlist *sg_next(struct scatterlist *sg)
+{
+ return sg + 1;
+}
+
+void *scatterwalk_whichbuf(struct scatter_walk *walk, unsigned int nbytes)
+{
+ if (nbytes <= walk->len_this_page &&
+ (((unsigned long)walk->data) &
+ (PAGE_CACHE_SIZE - 1)) + nbytes <= PAGE_CACHE_SIZE)
+ return walk->data;
+ else
+ return walk->data;
+}
+
+void scatterwalk_start(struct scatter_walk *walk, struct scatterlist *sg)
+{
+ unsigned int rest_of_page;
+
+ walk->sg = sg;
+ walk->page = sg->page;
+ walk->len_this_segment = sg->length;
+ rest_of_page = PAGE_CACHE_SIZE - (sg->offset & (PAGE_CACHE_SIZE - 1));
+ walk->len_this_page = min(sg->length, rest_of_page);
+ walk->offset = sg->offset;
+}
+
+void scatterwalk_map(struct scatter_walk *walk, int out)
+{
+ walk->data = ngene_kmap(walk->page, out) + walk->offset;
+}
+
+static void scatterwalk_pagedone(struct scatter_walk *walk, int out,
+ unsigned int more)
+{
+ /* walk->data may be pointing the first byte of the next page;
+ however, we know we transfered at least one byte. So,
+ walk->data - 1 will be a virtual address in the mapped page. */
+
+ if (out)
+ flush_dcache_page(walk->page);
+
+ if (more) {
+ walk->len_this_segment -= walk->len_this_page;
+
+ if (walk->len_this_segment) {
+ walk->page++;
+ walk->len_this_page = min(walk->len_this_segment,
+ (unsigned)PAGE_CACHE_SIZE);
+ walk->offset = 0;
+ } else {
+ scatterwalk_start(walk, sg_next(walk->sg));
+ }
+ }
+}
+
+void scatterwalk_done(struct scatter_walk *walk, int out, int more)
+{
+ ngene_kunmap(walk->data, out);
+ if (walk->len_this_page == 0 || !more)
+ scatterwalk_pagedone(walk, out, more);
+}
+
+/*
+ * Do not call this unless the total length of all of the fragments
+ * has been verified as multiple of the block size.
+ */
+int scatterwalk_copychunks(struct scatter_walk *walk, size_t nbytes, int out)
+{
+ walk->offset += nbytes;
+ walk->len_this_page -= nbytes;
+ walk->len_this_segment -= nbytes;
+ return 0;
+}
+
+static void *vid_exchange(void *priv, void *buf, u32 len, u32 clock, u32 flags)
+{
+ struct ngene_channel *chan = priv;
+ struct ngene_buffer *item;
+ int wstrich, hstrich;
+ u8 *odd, *even;
+ u32 bpl = chan->tvnorms[chan->tvnorm].swidth * 2;
+
+ struct scatter_walk walk_out;
+ const unsigned int bsize = PAGE_SIZE;
+ unsigned int nbytes;
+ int rest_of_buffer, ah, rwstrich;
+
+ spin_lock(&chan->s_lock);
+
+ if (list_empty(&chan->capture)) {
+ chan->evenbuffer = NULL;
+ goto out;
+ }
+ item = list_entry(chan->capture.next, struct ngene_buffer, vb.queue);
+
+ if (chan->tvnorms[chan->tvnorm].sheight == 1080)
+ buf += 3840;
+
+ odd = buf;
+
+ hstrich = item->vb.height;
+ if (hstrich > chan->tvnorms[chan->tvnorm].sheight)
+ hstrich = chan->tvnorms[chan->tvnorm].sheight;
+
+ wstrich = item->vb.width;
+ if (wstrich > chan->tvnorms[chan->tvnorm].swidth)
+ wstrich = chan->tvnorms[chan->tvnorm].swidth;
+ wstrich <<= 1;
+
+ if (flags & BEF_EVEN_FIELD) {
+ chan->evenbuffer = buf;
+ if (chan->lastbufferflag) {
+ chan->lastbufferflag = 0;
+ if (chan->tvnorms[chan->tvnorm].sheight == 576) {
+ memcpy(buf + 413280, BlackLine, 1440);
+ memcpy(buf + 411840, BlackLine, 1440);
+ }
+ goto out;
+ }
+ }
+ chan->lastbufferflag = 1;
+ if (chan->evenbuffer)
+ even = chan->evenbuffer;
+ else
+ even = odd;
+ if (chan->tvnorms[chan->tvnorm].sheight == 576) {
+ memcpy(odd + 413280, BlackLine, 1440);
+ memcpy(odd + 411840, BlackLine, 1440);
+ }
+ nbytes = item->vb.dma.sglen * PAGE_SIZE;
+ scatterwalk_start(&walk_out, item->vb.dma.sglist);
+ ah = 0;
+ rwstrich = wstrich;
+ do {
+ u8 *dst_p;
+
+ rest_of_buffer = bsize;
+ scatterwalk_map(&walk_out, 1);
+ dst_p = scatterwalk_whichbuf(&walk_out, bsize);
+ nbytes -= bsize;
+ scatterwalk_copychunks(&walk_out, bsize, 1);
+
+ while (rest_of_buffer > 0 && ah < hstrich) {
+ if (rest_of_buffer >= rwstrich) {
+ if (ah % 2 == 0) {
+ memcpy(walk_out.data +
+ (bsize - rest_of_buffer),
+ odd, rwstrich);
+ odd += bpl - (wstrich - rwstrich);
+ } else {
+ memcpy(walk_out.data +
+ (bsize - rest_of_buffer),
+ even, rwstrich);
+ even += bpl - (wstrich - rwstrich);
+ }
+ rest_of_buffer -= rwstrich;
+ ah++;
+ rwstrich = wstrich;
+ } else {
+ if (ah % 2 == 0) {
+ memcpy(walk_out.data +
+ (bsize - rest_of_buffer),
+ odd, rest_of_buffer);
+ odd += rest_of_buffer;
+ } else {
+ memcpy(walk_out.data +
+ (bsize - rest_of_buffer),
+ even, rest_of_buffer);
+ even += rest_of_buffer;
+ }
+ rwstrich -= rest_of_buffer;
+ rest_of_buffer = 0;
+ }
+ }
+ scatterwalk_done(&walk_out, 1, nbytes);
+ } while (nbytes && ah < hstrich);
+
+ {
+ struct timeval ts;
+ do_gettimeofday(&ts);
+ list_del(&item->vb.queue);
+ item->vb.state = STATE_DONE;
+ item->vb.ts = ts;
+ wake_up(&item->vb.done);
+ chan->evenbuffer = NULL;
+ }
+
+out:
+ spin_unlock(&chan->s_lock);
+ return 0;
+}
+
+static void *snd_exchange(void *priv, void *buf, u32 len, u32 clock, u32 flags)
+{
+ struct ngene_channel *chan = priv;
+ struct mychip *mychip = chan->mychip;
+
+ if (chan->audiomute == 0)
+ memcpy(chan->soundbuffer, (u8 *) buf, MAX_AUDIO_BUFFER_SIZE);
+ else
+ memset(chan->soundbuffer, 0, MAX_AUDIO_BUFFER_SIZE);
+
+ if (mychip->substream != NULL) {
+ if (chan->sndbuffflag == 0)
+ chan->sndbuffflag = 1;
+ else
+ chan->sndbuffflag = 0;
+ spin_unlock(&mychip->lock);
+ snd_pcm_period_elapsed(mychip->substream);
+ spin_lock(&mychip->lock);
+ }
+ return 0;
+}
+
+static void set_analog_transfer(struct ngene_channel *chan, int state)
+{
+ struct ngene_channel *ch;
+ u8 flags = 0;
+
+ ch = &chan->dev->channel[chan->number + 2];
+ /* printk(KERN_INFO "set_analog_transfer %d\n", state); */
+
+ if (1) { /* chan->tun_dec_rdy == 1){ */
+ if (state) {
+
+ chan->Capture1Length =
+ chan->tvnorms[chan->tvnorm].swidth *
+ chan->tvnorms[chan->tvnorm].sheight;
+ if (chan->tvnorms[chan->tvnorm].sheight == 576)
+ chan->nLines = 287;
+ else if (chan->tvnorms[chan->tvnorm].sheight == 1080)
+ chan->nLines = 541;
+ else
+ chan->nLines =
+ chan->tvnorms[chan->tvnorm].sheight / 2;
+ chan->nBytesPerLine =
+ chan->tvnorms[chan->tvnorm].swidth * 2;
+ if (chan->dev->card_info->io_type[chan->number] ==
+ NGENE_IO_HDTV) {
+ chan->itumode = 2;
+ flags = SFLAG_ORDER_LUMA_CHROMA;
+ } else {
+ chan->itumode = 0;
+ flags = SFLAG_ORDER_LUMA_CHROMA;
+ }
+ chan->pBufferExchange = vid_exchange;
+ ngene_command_stream_control(chan->dev, chan->number,
+ 0x80,
+ SMODE_VIDEO_CAPTURE,
+ flags);
+
+ ch->Capture1Length = MAX_AUDIO_BUFFER_SIZE;
+ ch->pBufferExchange = snd_exchange;
+ ngene_command_stream_control(ch->dev, ch->number,
+ 0x80,
+ SMODE_AUDIO_CAPTURE, 0);
+ ch->soundstreamon = 1;
+ } else {
+ ngene_command_stream_control(chan->dev, chan->number,
+ 0, 0, 0);
+ ngene_command_stream_control(ch->dev, ch->number,
+ 0, 0, 0);
+ ch->soundstreamon = 0;
+ }
+ }
+}
+
+static int ngene_analog_start_feed(struct ngene_channel *chan)
+{
+ int freerunmode = 1;
+ struct i2c_adapter *adapter = &chan->i2c_adapter;
+
+ if (chan->users == 0 && chan->number < 2) {
+ chan->evenbuffer = NULL;
+ chan->users = 1;
+ i2c_clients_command(adapter, IOCTL_MIC_DEC_FREESYNC,
+ &freerunmode);
+ msleep(25);
+ set_analog_transfer(chan, 1);
+ msleep(25);
+ freerunmode = 0;
+ i2c_clients_command(adapter, IOCTL_MIC_DEC_FREESYNC,
+ &freerunmode);
+ }
+ return chan->users;
+}
+
+static int ngene_analog_stop_feed(struct ngene_channel *chan)
+{
+ int freerunmode = 1;
+ struct i2c_adapter *adapter = &chan->i2c_adapter;
+ if (chan->users == 1 && chan->number < 2) {
+ chan->users = 0;
+ i2c_clients_command(adapter,
+ IOCTL_MIC_DEC_FREESYNC, &freerunmode);
+ msleep(20);
+ set_analog_transfer(chan, 0);
+ }
+ return 0;
+}
+
+/****************************************************************************/
+/* V4L2 API interface *******************************************************/
+/****************************************************************************/
+
+void ngene_dma_free(struct videobuf_queue *q,
+ struct ngene_channel *chan, struct ngene_buffer *buf)
+{
+ videobuf_waiton(&buf->vb, 0, 0);
+ videobuf_dma_unmap(q, &buf->vb.dma);
+ videobuf_dma_free(&buf->vb.dma);
+ buf->vb.state = STATE_NEEDS_INIT;
+}
+
+static int ngene_prepare_buffer(struct videobuf_queue *q,
+ struct ngene_channel *chan,
+ struct ngene_buffer *buf,
+ const struct ngene_format *fmt,
+ unsigned int width, unsigned int height,
+ enum v4l2_field field)
+{
+ int rc = 0;
+ /* check settings */
+ if (NULL == fmt)
+ return -EINVAL;
+
+ if (width < 48 || height < 32)
+ return -EINVAL;
+
+ buf->vb.size = (width * height * 16 /* fmt->depth */) >> 3;
+ if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size)
+ return -EINVAL;
+
+ /* alloc + fill struct ngene_buffer (if changed) */
+ if (buf->vb.width != width || buf->vb.height != height ||
+ buf->vb.field != field || buf->fmt != fmt ||
+ buf->tvnorm != chan->tvnorm) {
+
+ buf->vb.width = width;
+ buf->vb.height = height;
+ buf->vb.field = field;
+ buf->tvnorm = chan->tvnorm;
+ buf->fmt = fmt;
+
+ ngene_dma_free(q, chan, buf);
+ }
+
+ if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size)
+ return -EINVAL;
+
+ if (buf->vb.field == 0)
+ buf->vb.field = V4L2_FIELD_INTERLACED;
+
+ if (STATE_NEEDS_INIT == buf->vb.state) {
+ buf->vb.width = width;
+ buf->vb.height = height;
+ buf->vb.field = field;
+ buf->tvnorm = chan->tvnorm;
+ buf->fmt = fmt;
+
+ rc = videobuf_iolock(q, &buf->vb, &chan->fbuf);
+ if (0 != rc)
+ goto fail;
+ }
+ if (!buf->vb.dma.bus_addr)
+ videobuf_dma_sync(q, &buf->vb.dma);
+ buf->vb.state = STATE_PREPARED;
+ return 0;
+
+fail:
+ ngene_dma_free(q, chan, buf);
+ return rc;
+
+}
+
+static int buffer_setup(struct videobuf_queue *q,
+ unsigned int *count, unsigned int *size)
+{
+ struct ngene_vopen *vopen = q->priv_data;
+ *size = 2 * vopen->width * vopen->height;
+ if (0 == *count)
+ *count = gbuffers;
+ while (*size * *count > gbuffers * gbufsize)
+ (*count)--;
+ q->field = V4L2_FIELD_INTERLACED;
+ q->last = V4L2_FIELD_INTERLACED;
+ return 0;
+}
+
+static int buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
+ enum v4l2_field field)
+{
+ struct ngene_buffer *buf = container_of(vb, struct ngene_buffer, vb);
+ struct ngene_vopen *vopen = q->priv_data;
+ return ngene_prepare_buffer(q, vopen->ch, buf, vopen->fmt,
+ vopen->width, vopen->height, field);
+}
+
+static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
+{
+ struct ngene_buffer *buf = container_of(vb, struct ngene_buffer, vb);
+ struct ngene_vopen *vopen = q->priv_data;
+ ngene_dma_free(q, vopen->ch, buf);
+}
+
+static void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
+{
+ struct ngene_buffer *buf = container_of(vb, struct ngene_buffer, vb);
+ struct ngene_vopen *vopen = q->priv_data;
+ struct ngene_channel *chan = vopen->ch;
+
+ buf->vb.state = STATE_QUEUED;
+ list_add_tail(&buf->vb.queue, &chan->capture);
+}
+
+static struct videobuf_queue_ops ngene_video_qops = {
+ .buf_setup = buffer_setup,
+ .buf_prepare = buffer_prepare,
+ .buf_queue = buffer_queue,
+ .buf_release = buffer_release,
+};
+
+int video_open(struct inode *inode, struct file *flip)
+{
+ struct ngene_vopen *vopen = NULL;
+ enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+ struct video_device *vd = video_devdata(flip);
+ struct ngene_channel *chan = my_video_get_drvdata(vd);
+
+ vopen = kmalloc(sizeof(*vopen), GFP_KERNEL);
+ if (!vopen)
+ return -ENOMEM;
+ memset(vopen, 0, sizeof(*vopen));
+ flip->private_data = vopen;
+ v4l2_prio_open(&chan->prio, &vopen->prio);
+ vopen->ch = chan;
+ vopen->picxcount = 0;
+ vopen->type = type;
+ videobuf_queue_init(&vopen->vbuf_q, &ngene_video_qops,
+ chan->dev->pci_dev, &chan->s_lock,
+ V4L2_BUF_TYPE_VIDEO_CAPTURE,
+ V4L2_FIELD_INTERLACED,
+ sizeof(struct ngene_buffer), vopen);
+
+ vopen->ovfmt = ngene_formats;
+ chan->videousers++;
+ if (chan->dev->card_info->switch_ctrl)
+ chan->dev->card_info->switch_ctrl(chan, 2, 1);
+ return 0;
+}
+
+int video_close(struct inode *inode, struct file *filp)
+{
+ struct ngene_vopen *vopen = filp->private_data;
+ struct ngene_channel *chan = vopen->ch;
+
+ chan->videousers--;
+ if (!chan->videousers) {
+ if (chan->dev->card_info->switch_ctrl)
+ chan->dev->card_info->switch_ctrl(chan, 2, 0);
+ ngene_analog_stop_feed(chan);
+ }
+ videobuf_mmap_free(&vopen->vbuf_q);
+ v4l2_prio_close(&chan->prio, &vopen->prio);
+ filp->private_data = NULL;
+ kfree(vopen);
+ return 0;
+}
+
+/****************************************************************************/
+
+static int vid_do_ioctl(struct inode *inode, struct file *file,
+ unsigned int cmd, void *parg)
+{
+ struct ngene_vopen *vopen = file->private_data;
+ struct ngene_channel *chan = vopen->ch;
+ struct ngene *dev = chan->dev;
+ struct i2c_adapter *adap = &chan->i2c_adapter;
+ int retval = 0;
+ int err = 0;
+
+ switch (cmd) {
+
+ case VIDIOC_S_CTRL:
+ {
+ struct v4l2_control *c = parg;
+
+ err = v4l2_prio_check(&chan->prio, &vopen->prio);
+ if (err)
+ return err;
+
+ if (c->id == V4L2_CID_AUDIO_MUTE) {
+ if (c->value)
+ (dev->channel[chan->number + 2]).audiomute = 1;
+ else
+ (dev->channel[chan->number + 2]).audiomute = 0;
+ return 0;
+ }
+ if (c->value != V4L2_CID_AUDIO_MUTE)
+ ngene_analog_stop_feed(chan);
+ i2c_clients_command(adap, cmd, parg);
+ return 0;
+ }
+
+ case VIDIOC_S_TUNER:
+ {
+ err = v4l2_prio_check(&chan->prio, &vopen->prio);
+ if (err != 0)
+ return err;
+ i2c_clients_command(adap, cmd, parg);
+ return 0;
+ }
+
+ case VIDIOC_S_FREQUENCY:
+ {
+ struct v4l2_frequency *f = parg;
+ u8 drxa = dev->card_info->demoda[chan->number];
+
+ if (chan->fe && chan->fe->ops.tuner_ops.set_frequency)
+ chan->fe->ops.tuner_ops.
+ set_frequency(chan->fe, f->frequency * 62500);
+ if (drxa)
+ ;
+ }
+
+ case VIDIOC_S_INPUT:
+ {
+ err = v4l2_prio_check(&chan->prio, &vopen->prio);
+ if (err != 0)
+ return err;
+ i2c_clients_command(adap, cmd, parg);
+ return 0;
+ }
+
+ case VIDIOC_G_STD:
+ {
+ v4l2_std_id *id = parg;
+ *id = chan->tvnorms[chan->tvnorm].v4l2_id;
+ return 0;
+ }
+
+ case VIDIOC_S_STD:
+ {
+ v4l2_std_id *id = parg;
+ unsigned int i;
+
+ err = v4l2_prio_check(&chan->prio, &vopen->prio);
+ if (err != 0)
+ return err;
+ ngene_analog_stop_feed(chan);
+ i2c_clients_command(adap, cmd, parg);
+ for (i = 0; i < chan->tvnorm_num; i++)
+ if (*id & chan->tvnorms[i].v4l2_id)
+ break;
+ if (i == chan->tvnorm_num)
+ return -EINVAL;
+
+ chan->tvnorm = i;
+ mdelay(50);
+ ngene_analog_start_feed(chan);
+ return 0;
+ }
+
+ case VIDIOC_G_FREQUENCY:
+ case VIDIOC_G_INPUT:
+ case VIDIOC_S_AUDIO:
+ case VIDIOC_G_AUDIO:
+ case VIDIOC_ENUMAUDIO:
+ case VIDIOC_S_MODULATOR:
+ case VIDIOC_G_MODULATOR:
+ case VIDIOC_G_CTRL:
+ {
+ i2c_clients_command(adap, cmd, parg);
+ return 0;
+ }
+
+ case VIDIOC_G_TUNER:
+ {
+ struct v4l2_tuner *tuner = parg;
+ if (tuner->index != 0)
+ return -EINVAL;
+ i2c_clients_command(adap, cmd, parg);
+
+ if (chan->fe && chan->fe->ops.tuner_ops.get_status) {
+ u32 status;
+
+ chan->fe->ops.tuner_ops.get_status(chan->fe, &status);
+ tuner->signal = status;
+ }
+ return 0;
+ }
+
+ case VIDIOC_QUERYCTRL:
+ {
+ struct v4l2_queryctrl *c = parg;
+ int i;
+
+ if ((c->id < V4L2_CID_BASE ||
+ c->id >= V4L2_CID_LASTP1) &&
+ (c->id < V4L2_CID_PRIVATE_BASE ||
+ c->id >= V4L2_CID_PRIVATE_LASTP1))
+ return -EINVAL;
+ for (i = 0; i < NGENE_CTLS; i++)
+ if (ngene_ctls[i].id == c->id)
+ break;
+ if (i == NGENE_CTLS) {
+ *c = no_ctl;
+ return 0;
+ }
+ *c = ngene_ctls[i];
+ return 0;
+ }
+
+ case VIDIOC_G_FMT:
+ {
+ struct v4l2_format *f = parg;
+ ngene_g_fmt(vopen, f);
+ }
+
+ case VIDIOC_S_FMT:
+ {
+ struct v4l2_format *f = parg;
+
+ ngene_analog_stop_feed(chan);
+ return ngene_s_fmt(vopen, chan, f);
+ }
+
+ case VIDIOC_ENUM_FMT:
+ {
+ struct v4l2_fmtdesc *f = parg;
+ enum v4l2_buf_type type;
+ unsigned int i;
+ int index;
+
+ type = f->type;
+ if (V4L2_BUF_TYPE_VBI_CAPTURE == type) {
+ /* vbi
+ index = f->index;
+ if (0 != index)
+ return -EINVAL;
+ memset(f, 0, sizeof(*f));
+ f->index = index;
+ f->type = type;
+ f->pixelformat = V4L2_PIX_FMT_GREY;
+ strcpy(f->description, "vbi data"); */
+ return EINVAL;
+ }
+
+ /* video capture + overlay */
+ index = -1;
+ for (i = 0; i < NGENE_FORMATS; i++) {
+ if (ngene_formats[i].fourcc != -1)
+ index++;
+ if ((unsigned int)index == f->index)
+ break;
+ }
+ if (NGENE_FORMATS == i)
+ return -EINVAL;
+
+ switch (f->type) {
+ case V4L2_BUF_TYPE_VIDEO_CAPTURE:
+ break;
+ case V4L2_BUF_TYPE_VIDEO_OVERLAY:
+ /* dprintk(KERN_DEBUG
+ "Video Overlay not supported yet.\n"); */
+ return -EINVAL;
+ break;
+ default:
+ return -EINVAL;
+ }
+ memset(f, 0, sizeof(*f));
+ f->index = index;
+ f->type = type;
+ f->pixelformat = ngene_formats[i].fourcc;
+ strlcpy(f->description, ngene_formats[i].name,
+ sizeof(f->description));
+ return 0;
+
+ }
+
+ case VIDIOC_QUERYSTD:
+ {
+ v4l2_std_id *id = parg;
+ *id = V4L2_STD_625_50 | V4L2_STD_525_60;
+ return 0;
+ }
+
+ case VIDIOC_ENUMSTD:
+ {
+ struct v4l2_standard *e = parg;
+ unsigned int index = e->index;
+
+ if (index >= chan->tvnorm_num)
+ return -EINVAL;
+ v4l2_video_std_construct(e, chan->tvnorms[e->index].v4l2_id,
+ chan->tvnorms[e->index].name);
+ e->index = index;
+ return 0;
+ }
+
+ case VIDIOC_QUERYCAP:
+ {
+ static char driver[] = {'n', 'G', 'e', 'n', 'e', '\0'};
+ static char card[] = {'M', 'k', '4', 'x', 'x', '\0'};
+ struct v4l2_capability *cap = parg;
+
+ memset(cap, 0, sizeof(*cap));
+ if (dev->nr == 0)
+ card[3] = '0';
+ else
+ card[3] = '1';
+ if (chan->number)
+ card[4] = 'a';
+ else
+ card[4] = 'b';
+ strlcpy(cap->driver, driver, sizeof(cap->driver));
+ strlcpy(cap->card, card, sizeof(cap->card));
+ cap->bus_info[0] = 0;
+ cap->version = KERNEL_VERSION(0, 8, 1);
+ cap->capabilities = V4L2_CAP_VIDEO_CAPTURE|
+ V4L2_CAP_TUNER|V4L2_CAP_AUDIO|
+ V4L2_CAP_READWRITE|V4L2_CAP_STREAMING;
+ return 0;
+ }
+
+ case VIDIOC_ENUMINPUT:
+ {
+ static char *inputname[2] = {
+ "AnalogTuner",
+ "S-Video"
+ };
+
+ struct v4l2_input *i = parg;
+ unsigned int index;
+ index = i->index;
+
+ if (index > 1)
+ return -EINVAL;
+
+ memset(i, 0, sizeof(*i));
+ i->index = index;
+ strlcpy(i->name, inputname[index], sizeof(i->name));
+
+ i->type = index ? V4L2_INPUT_TYPE_CAMERA :
+ V4L2_INPUT_TYPE_TUNER;
+ i->audioset = 0;
+ i->tuner = 0;
+ i->std = V4L2_STD_PAL_BG | V4L2_STD_NTSC_M;
+ i->status = 0;/* V4L2_IN_ST_NO_H_LOCK; */
+ return 0;
+ }
+
+ case VIDIOC_G_PARM:
+ return -EINVAL;
+
+ case VIDIOC_S_PARM:
+ return -EINVAL;
+
+ case VIDIOC_G_PRIORITY:
+ {
+ enum v4l2_priority *prio = parg;
+ *prio = v4l2_prio_max(&chan->prio);
+ return 0;
+ }
+
+ case VIDIOC_S_PRIORITY:
+ {
+ enum v4l2_priority *prio = parg;
+ return v4l2_prio_change(&chan->prio, &vopen->prio, *prio);
+ return 0;
+ }
+
+ case VIDIOC_CROPCAP:
+ return -EINVAL;
+
+ case VIDIOC_G_CROP:
+ return -EINVAL;
+
+ case VIDIOC_S_CROP:
+ return -EINVAL;
+
+ case VIDIOC_G_FBUF:
+ {
+ struct v4l2_framebuffer *fb = parg;
+
+ *fb = chan->fbuf;
+ fb->capability = 0;
+ if (vopen->ovfmt)
+ fb->fmt.pixelformat = vopen->ovfmt->fourcc;
+ return 0;
+ }
+
+ case VIDIOC_REQBUFS:
+ return videobuf_reqbufs(ngene_queue(vopen), parg);
+
+ case VIDIOC_QUERYBUF:
+ return videobuf_querybuf(ngene_queue(vopen), parg);
+
+ case VIDIOC_QBUF:
+ return videobuf_qbuf(ngene_queue(vopen), parg);
+
+ case VIDIOC_DQBUF:
+ return videobuf_dqbuf(ngene_queue(vopen), parg,
+ file->f_flags & O_NONBLOCK);
+
+ case VIDIOC_S_FBUF:
+ {
+ /* ngene_analog_stop_feed(chan); */
+ struct v4l2_framebuffer *fb = parg;
+ const struct ngene_format *fmt;
+
+ if (!capable(CAP_SYS_ADMIN) && !capable(CAP_SYS_RAWIO))
+ return -EPERM;
+
+ /* check args */
+ fmt = ngene_formats; /*format_by_fourcc(fb->fmt.pixelformat);*/
+ if (NULL == fmt)
+ return -EINVAL;
+
+ if (0 == (fmt->flags & 0x02 /*FORMAT_FLAGS_PACKED*/))
+ return -EINVAL;
+
+ mutex_lock(&vopen->vbuf_q.lock);
+ retval = -EINVAL;
+
+ if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) {
+ int maxLinesPerField;
+
+ if (fb->fmt.width >
+ chan->tvnorms[chan->tvnorm].swidth)
+ goto vopen_unlock_and_return;
+ maxLinesPerField = chan->tvnorms[chan->tvnorm].sheight;
+ if (fb->fmt.height > maxLinesPerField)
+ goto vopen_unlock_and_return;
+ }
+
+ /* ok, accept it */
+ chan->fbuf.base = fb->base;
+ chan->fbuf.fmt.width = fb->fmt.width;
+ chan->fbuf.fmt.height = fb->fmt.height;
+ if (0 != fb->fmt.bytesperline)
+ chan->fbuf.fmt.bytesperline = fb->fmt.bytesperline;
+ else
+ chan->fbuf.fmt.bytesperline =
+ chan->fbuf.fmt.width * fmt->depth / 8;
+
+ retval = 0;
+ vopen->ovfmt = fmt;
+ chan->init.ovfmt = fmt;
+
+vopen_unlock_and_return:
+ mutex_unlock(&vopen->vbuf_q.lock);
+ return retval;
+
+ }
+
+ case VIDIOC_ENUMOUTPUT:
+ return -EINVAL;
+
+ case VIDIOC_TRY_FMT:
+ {
+ struct v4l2_format *f = parg;
+ return ngene_try_fmt(vopen, chan, f);
+
+ }
+
+ case VIDIOC_STREAMON:
+ {
+ int res = ngene_resource(vopen);
+ if (!check_alloc_res(chan, vopen, res))
+ return -EBUSY;
+ ngene_analog_start_feed(chan);
+ return videobuf_streamon(ngene_queue(vopen));
+ }
+
+ case VIDIOC_STREAMOFF:
+ {
+ int res = ngene_resource(vopen);
+ int retval = videobuf_streamoff(ngene_queue(vopen));
+ ngene_analog_stop_feed(chan);
+ if (retval < 0)
+ return retval;
+
+ free_res(chan, vopen, res);
+ return 0;
+ }
+
+ case VIDIOC_OVERLAY:
+ return -EINVAL;
+
+ case VIDIOCGFBUF:
+ {
+ struct video_buffer *vb = parg;
+
+ memset(vb, 0, sizeof(*vb));
+ return 0;
+ }
+
+ default:
+ err = -EINVAL;
+ break;
+ }
+ return err;
+}
+
+/*
+static int vid_ioctl(struct inode *inode, struct file *file,
+ unsigned int cmd, unsigned long arg)
+{
+ return video_usercopy(inode, file, cmd, arg, vid_do_ioctl);
+}
+*/
+static unsigned int video_fix_command(unsigned int cmd)
+{
+ switch (cmd) {
+ }
+ return cmd;
+}
+
+static int vid_ioctl(struct inode *inode, struct file *file,
+ unsigned int cmd, unsigned long arg)
+{
+ void *parg = (void *)arg, *pbuf = NULL;
+ char buf[64];
+ int res = -EFAULT;
+ cmd = video_fix_command(cmd);
+
+ if (_IOC_DIR(cmd) & _IOC_WRITE) {
+ parg = buf;
+ if (_IOC_SIZE(cmd) > sizeof(buf)) {
+ pbuf = kmalloc(_IOC_SIZE(cmd), GFP_KERNEL);
+ if (!pbuf)
+ return -ENOMEM;
+ parg = pbuf;
+ }
+ if (copy_from_user(parg, (void __user *)arg, _IOC_SIZE(cmd)))
+ goto error;
+ }
+ res = vid_do_ioctl(inode, file, cmd, parg);
+ if (res < 0)
+ goto error;
+ if (_IOC_DIR(cmd) & _IOC_READ)
+ if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd)))
+ res = -EFAULT;
+error:
+ kfree(pbuf);
+ return res;
+}
+
+static int ngene_mmap(struct file *file, struct vm_area_struct *vma)
+{
+ struct ngene_vopen *vopen = file->private_data;
+ return videobuf_mmap_mapper(ngene_queue(vopen), vma);
+}
+
+#define MAGIC_BUFFER 0x20040302
+void *my_videobuf_alloc(unsigned int size)
+{
+ struct videobuf_buffer *vb;
+
+ vb = kmalloc(size, GFP_KERNEL);
+ if (NULL != vb) {
+ memset(vb, 0, size);
+ videobuf_dma_init(&vb->dma);
+ init_waitqueue_head(&vb->done);
+ vb->magic = MAGIC_BUFFER;
+ }
+ return vb;
+}
+
+static ssize_t driver_read(struct file *file, char *user,
+ size_t count, loff_t *offset)
+{
+ char __user *data = user;
+ struct ngene_channel *chan;
+ int retval = 0;
+ struct videobuf_queue *q;
+ struct ngene_vopen *vopen = file->private_data;
+ int nonblocking = file->f_flags & O_NONBLOCK;
+ enum v4l2_field field;
+ unsigned long flags;
+ unsigned size, nbufs, bytes;
+
+ if (!vopen)
+ return 0;
+
+ chan = vopen->ch;
+ q = &vopen->vbuf_q;
+
+ mutex_lock(&q->lock);
+ nbufs = 1;
+ size = 0;
+ q->ops->buf_setup(q, &nbufs, &size);
+
+ if (NULL == q->read_buf) {
+ /* need to capture a new frame */
+ retval = -ENOMEM;
+ q->read_buf = my_videobuf_alloc(q->msize);
+ if (NULL == q->read_buf)
+ goto done;
+
+ q->read_buf->memory = V4L2_MEMORY_USERPTR;
+ field = V4L2_FIELD_INTERLACED;
+ retval = q->ops->buf_prepare(q, q->read_buf, field);
+ if (0 != retval) {
+ kfree(q->read_buf);
+ q->read_buf = NULL;
+ goto done;
+ }
+
+ spin_lock_irqsave(q->irqlock, flags);
+ q->ops->buf_queue(q, q->read_buf);
+ spin_unlock_irqrestore(q->irqlock, flags);
+ q->read_off = 0;
+ }
+
+ ngene_analog_start_feed(chan);
+ /* wait until capture is done */
+ retval = videobuf_waiton(q->read_buf, nonblocking, 1);
+ if (0 != retval)
+ goto done;
+ videobuf_dma_sync(q, &q->read_buf->dma);
+
+ if (STATE_ERROR == q->read_buf->state) {
+ /* catch I/O errors */
+ q->ops->buf_release(q, q->read_buf);
+ kfree(q->read_buf);
+ q->read_buf = NULL;
+ retval = -EIO;
+ goto done;
+ }
+
+ /* copy to userspace */
+ bytes = count;
+ if (bytes > q->read_buf->size - q->read_off)
+ bytes = q->read_buf->size - q->read_off;
+ retval = -EFAULT;
+
+ if (copy_to_user(data, q->read_buf->dma.vmalloc + q->read_off, bytes))
+ goto done;
+
+ retval = bytes;
+
+ q->read_off += bytes;
+ if (q->read_off == q->read_buf->size) {
+ /* all data copied, cleanup */
+ q->ops->buf_release(q, q->read_buf);
+ kfree(q->read_buf);
+ q->read_buf = NULL;
+ }
+
+done:
+ mutex_unlock(&q->lock);
+
+ ngene_analog_stop_feed(chan);
+
+ return retval;
+}
+
+static unsigned int ngene_poll(struct file *file, poll_table *wait)
+{
+ struct ngene_vopen *vopen = file->private_data;
+ struct ngene_buffer *buf;
+ enum v4l2_field field;
+
+ if (check_res(vopen, RESOURCE_VIDEO)) {
+ /* streaming capture */
+ if (list_empty(&vopen->vbuf_q.stream))
+ return POLLERR;
+ buf = list_entry(vopen->vbuf_q.stream.next,
+ struct ngene_buffer, vb.stream);
+ } else {
+ /* read() capture */
+ mutex_lock(&vopen->vbuf_q.lock);
+ if (NULL == vopen->vbuf_q.read_buf) {
+ /* need to capture a new frame */
+ if (locked_res(vopen->ch, RESOURCE_VIDEO)) {
+ mutex_unlock(&vopen->vbuf_q.lock);
+ return POLLERR;
+ }
+ vopen->vbuf_q.read_buf =
+ videobuf_alloc(vopen->vbuf_q.msize);
+ if (NULL == vopen->vbuf_q.read_buf) {
+ mutex_unlock(&vopen->vbuf_q.lock);
+ return POLLERR;
+ }
+ vopen->vbuf_q.read_buf->memory = V4L2_MEMORY_USERPTR;
+ field = videobuf_next_field(&vopen->vbuf_q);
+ if (0 !=
+ vopen->vbuf_q.ops->
+ buf_prepare(&vopen->vbuf_q,
+ vopen->vbuf_q.read_buf, field)) {
+ mutex_unlock(&vopen->vbuf_q.lock);
+ return POLLERR;
+ }
+ vopen->vbuf_q.ops->buf_queue(&vopen->vbuf_q,
+ vopen->vbuf_q.read_buf);
+ vopen->vbuf_q.read_off = 0;
+ }
+ mutex_unlock(&vopen->vbuf_q.lock);
+ buf = (struct ngene_buffer *)vopen->vbuf_q.read_buf;
+ }
+
+ poll_wait(file, &buf->vb.done, wait);
+ if (buf->vb.state == STATE_DONE || buf->vb.state == STATE_ERROR)
+ return POLLIN | POLLRDNORM;
+ return 0;
+}
+
+static const struct file_operations ngene_fops = {
+ .owner = THIS_MODULE,
+ .read = driver_read,
+ .write = 0,
+ .open = video_open,
+ .release = video_close,
+ .ioctl = vid_ioctl,
+ .poll = ngene_poll,
+ .mmap = ngene_mmap,
+};
+
+static struct video_device ngene_cinfo = {
+ .name = "analog_Ngene",
+ .type = VID_TYPE_CAPTURE | VID_TYPE_TUNER | VID_TYPE_SCALES,
+ .fops = &ngene_fops,
+ .minor = -1,
+};
+
+void ngene_v4l2_remove(struct ngene_channel *chan)
+{
+ video_unregister_device(chan->v4l_dev);
+}
+
+int ngene_v4l2_init(struct ngene_channel *chan)
+{
+ int ret = 0;
+ struct video_device *v_dev;
+
+ chan->evenbuffer = NULL;
+ chan->dma_on = 0;
+
+ v_dev = video_device_alloc();
+ *v_dev = ngene_cinfo;
+ /* v_dev->dev = &(chan->dev->pci_dev->dev); */
+ v_dev->release = video_device_release;
+ v_dev->minor = -1;
+ video_register_device(v_dev, VFL_TYPE_GRABBER, -1);
+ snprintf(v_dev->name, sizeof(v_dev->name), "AnalognGene%d",
+ v_dev->minor);
+ chan->v4l_dev = v_dev;
+ chan->minor = v_dev->minor;
+ printk(KERN_INFO "nGene V4L2 device video%d registered.\n",
+ v_dev->minor);
+
+ v_dev->dev = &chan->device;
+ my_video_set_drvdata(chan->v4l_dev, chan);
+
+ v4l2_prio_init(&chan->prio);
+
+ if (chan->dev->card_info->io_type[chan->number] == NGENE_IO_HDTV) {
+ chan->tvnorms = ngene_tvnorms_hd;
+ chan->tvnorm_num = 1;
+ } else {
+ chan->tvnorms = ngene_tvnorms_sd;
+ chan->tvnorm_num = NGENE_TVNORMS;
+ }
+ chan->tvnorm = 0;
+
+ spin_lock_init(&chan->s_lock);
+ init_MUTEX(&chan->reslock);
+ INIT_LIST_HEAD(&chan->capture);
+ chan->users = 0;
+ chan->videousers = 0;
+ chan->init.ov.w.width = 384;
+ chan->init.ov.w.height = 288;
+ chan->init.fmt = ngene_formats;
+ chan->init.width = 384;
+ chan->init.height = 288;
+ chan->tun_rdy = 0;
+ chan->dec_rdy = 0;
+ chan->tun_dec_rdy = 0;
+ chan->lastbufferflag = -1;
+
+ if (chan->dev->card_info->avf[chan->number])
+ avf4910a_attach(&chan->i2c_adapter,
+ chan->dev->card_info->avf[chan->number]);
+
+ return ret;
+}