openkylin
/
linux
mirror of https://gitee.com/openkylin/linux.git
9
0
Fork 0
Code Issues Projects Releases Wiki Activity

V4L/DVB: s2255drv: Add support for 2257 device 

2257 is 2255 with 2 svideo inputs

Signed-off-by: Dean Anderson <dean@sensoray.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Dean Anderson 2010-03-05 19:59:48 -03:00 committed by Mauro Carvalho Chehab
parent 2e70db9a45
commit 5a34d9dfaf
1 changed files with 129 additions and 25 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

152
drivers/media/video/s2255drv.c
View File

@ -120,9 +120,10 @@
#define COLOR_YUVPK 2 /* YUV packed */ #define COLOR_YUVPK 2 /* YUV packed */
#define COLOR_Y8 4 /* monochrome */ #define COLOR_Y8 4 /* monochrome */
#define COLOR_JPG 5 /* JPEG */ #define COLOR_JPG 5 /* JPEG */
#define MASK_COLOR 0xff
#define MASK_JPG_QUALITY 0xff00
#define MASK_COLOR 0x000000ff
#define MASK_JPG_QUALITY 0x0000ff00
#define MASK_INPUT_TYPE 0x000f0000
/* frame decimation. Not implemented by V4L yet(experimental in V4L) */ /* frame decimation. Not implemented by V4L yet(experimental in V4L) */
#define FDEC_1 1 /* capture every frame. default */ #define FDEC_1 1 /* capture every frame. default */
#define FDEC_2 2 /* capture every 2nd frame */ #define FDEC_2 2 /* capture every 2nd frame */
@ -196,7 +197,6 @@ struct s2255_dmaqueue {
#define S2255_FW_SUCCESS 2 #define S2255_FW_SUCCESS 2
#define S2255_FW_FAILED 3 #define S2255_FW_FAILED 3
#define S2255_FW_DISCONNECTING 4 #define S2255_FW_DISCONNECTING 4
#define S2255_FW_MARKER cpu_to_le32(0x22552f2f) #define S2255_FW_MARKER cpu_to_le32(0x22552f2f)
/* 2255 read states */ /* 2255 read states */
#define S2255_READ_IDLE 0 #define S2255_READ_IDLE 0
@ -267,12 +267,12 @@ struct s2255_dev {
int vidstatus[MAX_CHANNELS]; int vidstatus[MAX_CHANNELS];
wait_queue_head_t wait_vidstatus[MAX_CHANNELS]; wait_queue_head_t wait_vidstatus[MAX_CHANNELS];
int vidstatus_ready[MAX_CHANNELS]; int vidstatus_ready[MAX_CHANNELS];
int chn_ready; int chn_ready;
struct kref kref;
spinlock_t slock; spinlock_t slock;
/* dsp firmware version (f2255usb.bin) */ /* dsp firmware version (f2255usb.bin) */
int dsp_fw_ver; int dsp_fw_ver;
u16 pid; /* product id */
struct kref kref;
}; };
#define to_s2255_dev(d) container_of(d, struct s2255_dev, kref) #define to_s2255_dev(d) container_of(d, struct s2255_dev, kref)
@ -306,20 +306,49 @@ struct s2255_fh {
/* current cypress EEPROM firmware version */ /* current cypress EEPROM firmware version */
#define S2255_CUR_USB_FWVER ((3 << 8) | 6) #define S2255_CUR_USB_FWVER ((3 << 8) | 6)
/* current DSP FW version */ /* current DSP FW version */
#define S2255_CUR_DSP_FWVER 5 #define S2255_CUR_DSP_FWVER 8
/* Need DSP version 5+ for video status feature */ /* Need DSP version 5+ for video status feature */
#define S2255_MIN_DSP_STATUS 5 #define S2255_MIN_DSP_STATUS 5
#define S2255_MIN_DSP_COLORFILTER 8
#define S2255_MAJOR_VERSION 1 #define S2255_MAJOR_VERSION 1
#define S2255_MINOR_VERSION 17 #define S2255_MINOR_VERSION 18
#define S2255_RELEASE 0 #define S2255_RELEASE 0
#define S2255_VERSION KERNEL_VERSION(S2255_MAJOR_VERSION, \ #define S2255_VERSION KERNEL_VERSION(S2255_MAJOR_VERSION, \
S2255_MINOR_VERSION, \ S2255_MINOR_VERSION, \
S2255_RELEASE) S2255_RELEASE)
/* vendor ids */
#define USB_S2255_VENDOR_ID 0x1943
#define USB_S2255_PRODUCT_ID 0x2255
#define S2255_NORMS (V4L2_STD_PAL | V4L2_STD_NTSC) #define S2255_NORMS (V4L2_STD_PAL | V4L2_STD_NTSC)
/* private V4L2 controls */
/*
* The following chart displays how COLORFILTER should be set
* =========================================================
* = fourcc = COLORFILTER =
* = ===============================
* = = 0 = 1 =
* =========================================================
* = V4L2_PIX_FMT_GREY(Y8) = monochrome from = monochrome=
* = = s-video or = composite =
* = = B/W camera = input =
* =========================================================
* = other = color, svideo = color, =
* = = = composite =
* =========================================================
*
* Notes:
* channels 0-3 on 2255 are composite
* channels 0-1 on 2257 are composite, 2-3 are s-video
* If COLORFILTER is 0 with a composite color camera connected,
* the output will appear monochrome but hatching
* will occur.
* COLORFILTER is different from "color killer" and "color effects"
* for reasons above.
*/
#define S2255_V4L2_YC_ON 1
#define S2255_V4L2_YC_OFF 0
#define V4L2_CID_PRIVATE_COLORFILTER (V4L2_CID_PRIVATE_BASE + 0)
/* frame prefix size (sent once every frame) */ /* frame prefix size (sent once every frame) */
#define PREFIX_SIZE 512 #define PREFIX_SIZE 512
@ -360,7 +389,6 @@ static long s2255_vendor_req(struct s2255_dev *dev, unsigned char req,
static struct usb_driver s2255_driver; static struct usb_driver s2255_driver;
/* Declare static vars that will be used as parameters */ /* Declare static vars that will be used as parameters */
static unsigned int vid_limit = 16; /* Video memory limit, in Mb */ static unsigned int vid_limit = 16; /* Video memory limit, in Mb */
@ -375,13 +403,14 @@ module_param(video_nr, int, 0644);
MODULE_PARM_DESC(video_nr, "start video minor(-1 default autodetect)"); MODULE_PARM_DESC(video_nr, "start video minor(-1 default autodetect)");
/* USB device table */ /* USB device table */
#define USB_SENSORAY_VID 0x1943
static struct usb_device_id s2255_table[] = { static struct usb_device_id s2255_table[] = {
{USB_DEVICE(USB_S2255_VENDOR_ID, USB_S2255_PRODUCT_ID)}, {USB_DEVICE(USB_SENSORAY_VID, 0x2255)},
{USB_DEVICE(USB_SENSORAY_VID, 0x2257)}, /*same family as 2255*/
{ } /* Terminating entry */ { } /* Terminating entry */
}; };
MODULE_DEVICE_TABLE(usb, s2255_table); MODULE_DEVICE_TABLE(usb, s2255_table);
#define BUFFER_TIMEOUT msecs_to_jiffies(400) #define BUFFER_TIMEOUT msecs_to_jiffies(400)
/* image formats. */ /* image formats. */
@ -798,6 +827,28 @@ static void res_free(struct s2255_dev *dev, struct s2255_fh *fh)
dprintk(1, "res: put\n"); dprintk(1, "res: put\n");
} }
static int vidioc_querymenu(struct file *file, void *priv,
struct v4l2_querymenu *qmenu)
{
static const char *colorfilter[] = {
"Off",
"On",
NULL
};
if (qmenu->id == V4L2_CID_PRIVATE_COLORFILTER) {
int i;
const char **menu_items = colorfilter;
for (i = 0; i < qmenu->index && menu_items[i]; i++)
; /* do nothing (from v4l2-common.c) */
if (menu_items[i] == NULL || menu_items[i][0] == '\0')
return -EINVAL;
strlcpy(qmenu->name, menu_items[qmenu->index],
sizeof(qmenu->name));
return 0;
}
return v4l2_ctrl_query_menu(qmenu, NULL, NULL);
}
static int vidioc_querycap(struct file *file, void *priv, static int vidioc_querycap(struct file *file, void *priv,
struct v4l2_capability *cap) struct v4l2_capability *cap)
@ -1007,19 +1058,23 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
/* color mode */ /* color mode */
switch (fh->fmt->fourcc) { switch (fh->fmt->fourcc) {
case V4L2_PIX_FMT_GREY: case V4L2_PIX_FMT_GREY:
fh->mode.color = COLOR_Y8; fh->mode.color &= ~MASK_COLOR;
fh->mode.color |= COLOR_Y8;
break; break;
case V4L2_PIX_FMT_JPEG: case V4L2_PIX_FMT_JPEG:
fh->mode.color = COLOR_JPG | fh->mode.color &= ~MASK_COLOR;
(fh->dev->jc[fh->channel].quality << 8); fh->mode.color |= COLOR_JPG;
fh->mode.color |= (fh->dev->jc[fh->channel].quality << 8);
break; break;
case V4L2_PIX_FMT_YUV422P: case V4L2_PIX_FMT_YUV422P:
fh->mode.color = COLOR_YUVPL; fh->mode.color &= ~MASK_COLOR;
fh->mode.color |= COLOR_YUVPL;
break; break;
case V4L2_PIX_FMT_YUYV: case V4L2_PIX_FMT_YUYV:
case V4L2_PIX_FMT_UYVY: case V4L2_PIX_FMT_UYVY:
default: default:
fh->mode.color = COLOR_YUVPK; fh->mode.color &= ~MASK_COLOR;
fh->mode.color |= COLOR_YUVPK;
break; break;
} }
ret = 0; ret = 0;
@ -1186,8 +1241,12 @@ static int s2255_set_mode(struct s2255_dev *dev, unsigned long chn,
dprintk(2, "mode contrast %x\n", mode->contrast); dprintk(2, "mode contrast %x\n", mode->contrast);
/* if JPEG, set the quality */ /* if JPEG, set the quality */
if ((mode->color & MASK_COLOR) == COLOR_JPG) if ((mode->color & MASK_COLOR) == COLOR_JPG) {
mode->color = (dev->jc[chn].quality << 8) | COLOR_JPG; mode->color &= ~MASK_COLOR;
mode->color |= COLOR_JPG;
mode->color &= ~MASK_JPG_QUALITY;
mode->color |= (dev->jc[chn].quality << 8);
}
/* save the mode */ /* save the mode */
dev->mode[chn] = *mode; dev->mode[chn] = *mode;
@ -1296,7 +1355,7 @@ static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
new_mode = &fh->mode; new_mode = &fh->mode;
old_mode = &fh->dev->mode[chn]; old_mode = &fh->dev->mode[chn];
if (new_mode->color != old_mode->color) if ((new_mode->color & MASK_COLOR) != (old_mode->color & MASK_COLOR))
new_mode->restart = 1; new_mode->restart = 1;
else if (new_mode->scale != old_mode->scale) else if (new_mode->scale != old_mode->scale)
new_mode->restart = 1; new_mode->restart = 1;
@ -1354,6 +1413,7 @@ static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *i)
int ret = 0; int ret = 0;
mutex_lock(&q->vb_lock); mutex_lock(&q->vb_lock);
if (videobuf_queue_is_busy(q)) { if (videobuf_queue_is_busy(q)) {
dprintk(1, "queue busy\n"); dprintk(1, "queue busy\n");
ret = -EBUSY; ret = -EBUSY;
@ -1366,7 +1426,6 @@ static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *i)
goto out_s_std; goto out_s_std;
} }
mode = &fh->mode; mode = &fh->mode;
if (*i & V4L2_STD_NTSC) { if (*i & V4L2_STD_NTSC) {
dprintk(4, "vidioc_s_std NTSC\n"); dprintk(4, "vidioc_s_std NTSC\n");
mode->format = FORMAT_NTSC; mode->format = FORMAT_NTSC;
@ -1409,7 +1468,16 @@ static int vidioc_enum_input(struct file *file, void *priv,
inp->status = (status & 0x01) ? 0 inp->status = (status & 0x01) ? 0
: V4L2_IN_ST_NO_SIGNAL; : V4L2_IN_ST_NO_SIGNAL;
} }
strlcpy(inp->name, "Camera", sizeof(inp->name)); switch (dev->pid) {
case 0x2255:
default:
strlcpy(inp->name, "Composite", sizeof(inp->name));
break;
case 0x2257:
strlcpy(inp->name, (fh->channel < 2) ? "Composite" : "S-Video",
sizeof(inp->name));
break;
}
return 0; return 0;
} }
@ -1429,6 +1497,8 @@ static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
static int vidioc_queryctrl(struct file *file, void *priv, static int vidioc_queryctrl(struct file *file, void *priv,
struct v4l2_queryctrl *qc) struct v4l2_queryctrl *qc)
{ {
struct s2255_fh *fh = priv;
struct s2255_dev *dev = fh->dev;
switch (qc->id) { switch (qc->id) {
case V4L2_CID_BRIGHTNESS: case V4L2_CID_BRIGHTNESS:
v4l2_ctrl_query_fill(qc, -127, 127, 1, DEF_BRIGHT); v4l2_ctrl_query_fill(qc, -127, 127, 1, DEF_BRIGHT);
@ -1442,6 +1512,19 @@ static int vidioc_queryctrl(struct file *file, void *priv,
case V4L2_CID_HUE: case V4L2_CID_HUE:
v4l2_ctrl_query_fill(qc, 0, 255, 1, DEF_HUE); v4l2_ctrl_query_fill(qc, 0, 255, 1, DEF_HUE);
break; break;
case V4L2_CID_PRIVATE_COLORFILTER:
if (dev->dsp_fw_ver < S2255_MIN_DSP_COLORFILTER)
return -EINVAL;
if ((dev->pid == 0x2257) && (fh->channel > 1))
return -EINVAL;
strlcpy(qc->name, "Color Filter", sizeof(qc->name));
qc->type = V4L2_CTRL_TYPE_MENU;
qc->minimum = 0;
qc->maximum = 1;
qc->step = 1;
qc->default_value = 1;
qc->flags = 0;
break;
default: default:
return -EINVAL; return -EINVAL;
} }
@ -1453,6 +1536,7 @@ static int vidioc_g_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl) struct v4l2_control *ctrl)
{ {
struct s2255_fh *fh = priv; struct s2255_fh *fh = priv;
struct s2255_dev *dev = fh->dev;
switch (ctrl->id) { switch (ctrl->id) {
case V4L2_CID_BRIGHTNESS: case V4L2_CID_BRIGHTNESS:
ctrl->value = fh->mode.bright; ctrl->value = fh->mode.bright;
@ -1466,6 +1550,13 @@ static int vidioc_g_ctrl(struct file *file, void *priv,
case V4L2_CID_HUE: case V4L2_CID_HUE:
ctrl->value = fh->mode.hue; ctrl->value = fh->mode.hue;
break; break;
case V4L2_CID_PRIVATE_COLORFILTER:
if (dev->dsp_fw_ver < S2255_MIN_DSP_COLORFILTER)
return -EINVAL;
if ((dev->pid == 0x2257) && (fh->channel > 1))
return -EINVAL;
ctrl->value = !((fh->mode.color & MASK_INPUT_TYPE) >> 16);
break;
default: default:
return -EINVAL; return -EINVAL;
} }
@ -1495,6 +1586,14 @@ static int vidioc_s_ctrl(struct file *file, void *priv,
case V4L2_CID_SATURATION: case V4L2_CID_SATURATION:
mode->saturation = ctrl->value; mode->saturation = ctrl->value;
break; break;
case V4L2_CID_PRIVATE_COLORFILTER:
if (dev->dsp_fw_ver < S2255_MIN_DSP_COLORFILTER)
return -EINVAL;
if ((dev->pid == 0x2257) && (fh->channel > 1))
return -EINVAL;
mode->color &= ~MASK_INPUT_TYPE;
mode->color |= ((ctrl->value ? 0 : 1) << 16);
break;
default: default:
return -EINVAL; return -EINVAL;
} }
@ -1807,6 +1906,7 @@ static const struct v4l2_file_operations s2255_fops_v4l = {
}; };
static const struct v4l2_ioctl_ops s2255_ioctl_ops = { static const struct v4l2_ioctl_ops s2255_ioctl_ops = {
.vidioc_querymenu = vidioc_querymenu,
.vidioc_querycap = vidioc_querycap, .vidioc_querycap = vidioc_querycap,
.vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
.vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
@ -2230,6 +2330,8 @@ static int s2255_board_init(struct s2255_dev *dev)
for (j = 0; j < MAX_CHANNELS; j++) { for (j = 0; j < MAX_CHANNELS; j++) {
dev->b_acquire[j] = 0; dev->b_acquire[j] = 0;
dev->mode[j] = mode_def; dev->mode[j] = mode_def;
if (dev->pid == 0x2257 && j > 1)
dev->mode[j].color |= (1 << 16);
dev->jc[j].quality = S2255_DEF_JPEG_QUAL; dev->jc[j].quality = S2255_DEF_JPEG_QUAL;
dev->cur_fmt[j] = &formats[0]; dev->cur_fmt[j] = &formats[0];
dev->mode[j].restart = 1; dev->mode[j].restart = 1;
@ -2506,7 +2608,7 @@ static int s2255_probe(struct usb_interface *interface,
s2255_dev_err(&interface->dev, "out of memory\n"); s2255_dev_err(&interface->dev, "out of memory\n");
goto error; goto error;
} }
dev->pid = id->idProduct;
dev->fw_data = kzalloc(sizeof(struct s2255_fw), GFP_KERNEL); dev->fw_data = kzalloc(sizeof(struct s2255_fw), GFP_KERNEL);
if (!dev->fw_data) if (!dev->fw_data)
goto error; goto error;
@ -2589,6 +2691,8 @@ static int s2255_probe(struct usb_interface *interface,
dev->dsp_fw_ver = *pRel; dev->dsp_fw_ver = *pRel;
if (*pRel < S2255_CUR_DSP_FWVER) if (*pRel < S2255_CUR_DSP_FWVER)
printk(KERN_INFO "s2255: f2255usb.bin out of date.\n"); printk(KERN_INFO "s2255: f2255usb.bin out of date.\n");
if (dev->pid == 0x2257 && *pRel < S2255_MIN_DSP_COLORFILTER)
printk(KERN_WARNING "s2255: 2257 requires firmware 8 or above.\n");
} }
/* loads v4l specific */ /* loads v4l specific */
s2255_probe_v4l(dev); s2255_probe_v4l(dev);