asgardius/android_kernel_motorola_sm6225
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions
android_kernel_motorola_sm6225/drivers/media/video/usbvideo/ultracam.c
Tim Schmielau cd354f1ae7 [PATCH] remove many unneeded #includes of sched.h 
After Al Viro (finally) succeeded in removing the sched.h #include in module.h
recently, it makes sense again to remove other superfluous sched.h includes.
There are quite a lot of files which include it but don't actually need
anything defined in there.  Presumably these includes were once needed for
macros that used to live in sched.h, but moved to other header files in the
course of cleaning it up.

To ease the pain, this time I did not fiddle with any header files and only
removed #includes from .c-files, which tend to cause less trouble.

Compile tested against 2.6.20-rc2 and 2.6.20-rc2-mm2 (with offsets) on alpha,
arm, i386, ia64, mips, powerpc, and x86_64 with allnoconfig, defconfig,
allmodconfig, and allyesconfig as well as a few randconfigs on x86_64 and all
configs in arch/arm/configs on arm.  I also checked that no new warnings were
introduced by the patch (actually, some warnings are removed that were emitted
by unnecessarily included header files).

Signed-off-by: Tim Schmielau <tim@physik3.uni-rostock.de>
Acked-by: Russell King <rmk+kernel@arm.linux.org.uk>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2007-02-14 08:09:54 -08:00

678 lines
21 KiB
C
Raw Blame History

/*
* USB NB Camera driver
*
* HISTORY:
* 25-Dec-2002 Dmitri Removed lighting, sharpness parameters, methods.
*/
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include "usbvideo.h"
#define ULTRACAM_VENDOR_ID 0x0461
#define ULTRACAM_PRODUCT_ID 0x0813
#define MAX_CAMERAS 4 /* How many devices we allow to connect */
/*
* This structure lives in uvd_t->user field.
*/
typedef struct {
int initialized; /* Had we already sent init sequence? */
int camera_model; /* What type of IBM camera we got? */
int has_hdr;
} ultracam_t;
#define ULTRACAM_T(uvd) ((ultracam_t *)((uvd)->user_data))
static struct usbvideo *cams = NULL;
static int debug = 0;
static int flags = 0; /* FLAGS_DISPLAY_HINTS | FLAGS_OVERLAY_STATS; */
static const int min_canvasWidth = 8;
static const int min_canvasHeight = 4;
#define FRAMERATE_MIN 0
#define FRAMERATE_MAX 6
static int framerate = -1;
/*
* Here we define several initialization variables. They may
* be used to automatically set color, hue, brightness and
* contrast to desired values. This is particularly useful in
* case of webcams (which have no controls and no on-screen
* output) and also when a client V4L software is used that
* does not have some of those controls. In any case it's
* good to have startup values as options.
*
* These values are all in [0..255] range. This simplifies
* operation. Note that actual values of V4L variables may
* be scaled up (as much as << 8). User can see that only
* on overlay output, however, or through a V4L client.
*/
static int init_brightness = 128;
static int init_contrast = 192;
static int init_color = 128;
static int init_hue = 128;
static int hue_correction = 128;
module_param(debug, int, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug level: 0-9 (default=0)");
module_param(flags, int, 0);
MODULE_PARM_DESC(flags,
"Bitfield: 0=VIDIOCSYNC, "
"1=B/W, "
"2=show hints, "
"3=show stats, "
"4=test pattern, "
"5=separate frames, "
"6=clean frames");
module_param(framerate, int, 0);
MODULE_PARM_DESC(framerate, "Framerate setting: 0=slowest, 6=fastest (default=2)");
module_param(init_brightness, int, 0);
MODULE_PARM_DESC(init_brightness, "Brightness preconfiguration: 0-255 (default=128)");
module_param(init_contrast, int, 0);
MODULE_PARM_DESC(init_contrast, "Contrast preconfiguration: 0-255 (default=192)");
module_param(init_color, int, 0);
MODULE_PARM_DESC(init_color, "Color preconfiguration: 0-255 (default=128)");
module_param(init_hue, int, 0);
MODULE_PARM_DESC(init_hue, "Hue preconfiguration: 0-255 (default=128)");
module_param(hue_correction, int, 0);
MODULE_PARM_DESC(hue_correction, "YUV colorspace regulation: 0-255 (default=128)");
/*
* ultracam_ProcessIsocData()
*
* Generic routine to parse the ring queue data. It employs either
* ultracam_find_header() or ultracam_parse_lines() to do most
* of work.
*
* 02-Nov-2000 First (mostly dummy) version.
* 06-Nov-2000 Rewrote to dump all data into frame.
*/
static void ultracam_ProcessIsocData(struct uvd *uvd, struct usbvideo_frame *frame)
{
int n;
assert(uvd != NULL);
assert(frame != NULL);
/* Try to move data from queue into frame buffer */
n = RingQueue_GetLength(&uvd->dp);
if (n > 0) {
int m;
/* See how much spare we have left */
m = uvd->max_frame_size - frame->seqRead_Length;
if (n > m)
n = m;
/* Now move that much data into frame buffer */
RingQueue_Dequeue(
&uvd->dp,
frame->data + frame->seqRead_Length,
m);
frame->seqRead_Length += m;
}
/* See if we filled the frame */
if (frame->seqRead_Length >= uvd->max_frame_size) {
frame->frameState = FrameState_Done;
uvd->curframe = -1;
uvd->stats.frame_num++;
}
}
/*
* ultracam_veio()
*
* History:
* 1/27/00 Added check for dev == NULL; this happens if camera is unplugged.
*/
static int ultracam_veio(
struct uvd *uvd,
unsigned char req,
unsigned short value,
unsigned short index,
int is_out)
{
static const char proc[] = "ultracam_veio";
unsigned char cp[8] /* = { 0xde, 0xad, 0xbe, 0xef, 0xde, 0xad, 0xbe, 0xef } */;
int i;
if (!CAMERA_IS_OPERATIONAL(uvd))
return 0;
if (!is_out) {
i = usb_control_msg(
uvd->dev,
usb_rcvctrlpipe(uvd->dev, 0),
req,
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
value,
index,
cp,
sizeof(cp),
1000);
#if 1
info("USB => %02x%02x%02x%02x%02x%02x%02x%02x "
"(req=$%02x val=$%04x ind=$%04x)",
cp[0],cp[1],cp[2],cp[3],cp[4],cp[5],cp[6],cp[7],
req, value, index);
#endif
} else {
i = usb_control_msg(
uvd->dev,
usb_sndctrlpipe(uvd->dev, 0),
req,
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
value,
index,
NULL,
0,
1000);
}
if (i < 0) {
err("%s: ERROR=%d. Camera stopped; Reconnect or reload driver.",
proc, i);
uvd->last_error = i;
}
return i;
}
/*
* ultracam_calculate_fps()
*/
static int ultracam_calculate_fps(struct uvd *uvd)
{
return 3 + framerate*4 + framerate/2;
}
/*
* ultracam_adjust_contrast()
*/
static void ultracam_adjust_contrast(struct uvd *uvd)
{
}
/*
* ultracam_set_brightness()
*
* This procedure changes brightness of the picture.
*/
static void ultracam_set_brightness(struct uvd *uvd)
{
}
static void ultracam_set_hue(struct uvd *uvd)
{
}
/*
* ultracam_adjust_picture()
*
* This procedure gets called from V4L interface to update picture settings.
* Here we change brightness and contrast.
*/
static void ultracam_adjust_picture(struct uvd *uvd)
{
ultracam_adjust_contrast(uvd);
ultracam_set_brightness(uvd);
ultracam_set_hue(uvd);
}
/*
* ultracam_video_stop()
*
* This code tells camera to stop streaming. The interface remains
* configured and bandwidth - claimed.
*/
static void ultracam_video_stop(struct uvd *uvd)
{
}
/*
* ultracam_reinit_iso()
*
* This procedure sends couple of commands to the camera and then
* resets the video pipe. This sequence was observed to reinit the
* camera or, at least, to initiate ISO data stream.
*/
static void ultracam_reinit_iso(struct uvd *uvd, int do_stop)
{
}
static void ultracam_video_start(struct uvd *uvd)
{
ultracam_reinit_iso(uvd, 0);
}
static int ultracam_resetPipe(struct uvd *uvd)
{
usb_clear_halt(uvd->dev, uvd->video_endp);
return 0;
}
static int ultracam_alternateSetting(struct uvd *uvd, int setting)
{
static const char proc[] = "ultracam_alternateSetting";
int i;
i = usb_set_interface(uvd->dev, uvd->iface, setting);
if (i < 0) {
err("%s: usb_set_interface error", proc);
uvd->last_error = i;
return -EBUSY;
}
return 0;
}
/*
* Return negative code on failure, 0 on success.
*/
static int ultracam_setup_on_open(struct uvd *uvd)
{
int setup_ok = 0; /* Success by default */
/* Send init sequence only once, it's large! */
if (!ULTRACAM_T(uvd)->initialized) {
ultracam_alternateSetting(uvd, 0x04);
ultracam_alternateSetting(uvd, 0x00);
ultracam_veio(uvd, 0x02, 0x0004, 0x000b, 1);
ultracam_veio(uvd, 0x02, 0x0001, 0x0005, 1);
ultracam_veio(uvd, 0x02, 0x8000, 0x0000, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0000, 1);
ultracam_veio(uvd, 0x00, 0x00b0, 0x0001, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0002, 1);
ultracam_veio(uvd, 0x00, 0x000c, 0x0003, 1);
ultracam_veio(uvd, 0x00, 0x000b, 0x0004, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0005, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0006, 1);
ultracam_veio(uvd, 0x00, 0x0079, 0x0007, 1);
ultracam_veio(uvd, 0x00, 0x003b, 0x0008, 1);
ultracam_veio(uvd, 0x00, 0x0002, 0x000f, 1);
ultracam_veio(uvd, 0x00, 0x0001, 0x0010, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0011, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00bf, 1);
ultracam_veio(uvd, 0x00, 0x0001, 0x00c0, 1);
ultracam_veio(uvd, 0x00, 0x0010, 0x00cb, 1);
ultracam_veio(uvd, 0x01, 0x00a4, 0x0001, 1);
ultracam_veio(uvd, 0x01, 0x0010, 0x0002, 1);
ultracam_veio(uvd, 0x01, 0x0066, 0x0007, 1);
ultracam_veio(uvd, 0x01, 0x000b, 0x0008, 1);
ultracam_veio(uvd, 0x01, 0x0034, 0x0009, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x000a, 1);
ultracam_veio(uvd, 0x01, 0x002e, 0x000b, 1);
ultracam_veio(uvd, 0x01, 0x00d6, 0x000c, 1);
ultracam_veio(uvd, 0x01, 0x00fc, 0x000d, 1);
ultracam_veio(uvd, 0x01, 0x00f1, 0x000e, 1);
ultracam_veio(uvd, 0x01, 0x00da, 0x000f, 1);
ultracam_veio(uvd, 0x01, 0x0036, 0x0010, 1);
ultracam_veio(uvd, 0x01, 0x000b, 0x0011, 1);
ultracam_veio(uvd, 0x01, 0x0001, 0x0012, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x0013, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x0014, 1);
ultracam_veio(uvd, 0x01, 0x0087, 0x0051, 1);
ultracam_veio(uvd, 0x01, 0x0040, 0x0052, 1);
ultracam_veio(uvd, 0x01, 0x0058, 0x0053, 1);
ultracam_veio(uvd, 0x01, 0x0040, 0x0054, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x0040, 1);
ultracam_veio(uvd, 0x01, 0x0010, 0x0041, 1);
ultracam_veio(uvd, 0x01, 0x0020, 0x0042, 1);
ultracam_veio(uvd, 0x01, 0x0030, 0x0043, 1);
ultracam_veio(uvd, 0x01, 0x0040, 0x0044, 1);
ultracam_veio(uvd, 0x01, 0x0050, 0x0045, 1);
ultracam_veio(uvd, 0x01, 0x0060, 0x0046, 1);
ultracam_veio(uvd, 0x01, 0x0070, 0x0047, 1);
ultracam_veio(uvd, 0x01, 0x0080, 0x0048, 1);
ultracam_veio(uvd, 0x01, 0x0090, 0x0049, 1);
ultracam_veio(uvd, 0x01, 0x00a0, 0x004a, 1);
ultracam_veio(uvd, 0x01, 0x00b0, 0x004b, 1);
ultracam_veio(uvd, 0x01, 0x00c0, 0x004c, 1);
ultracam_veio(uvd, 0x01, 0x00d0, 0x004d, 1);
ultracam_veio(uvd, 0x01, 0x00e0, 0x004e, 1);
ultracam_veio(uvd, 0x01, 0x00f0, 0x004f, 1);
ultracam_veio(uvd, 0x01, 0x00ff, 0x0050, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x0056, 1);
ultracam_veio(uvd, 0x00, 0x0080, 0x00c1, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c2, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00ca, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0080, 0x00c1, 1);
ultracam_veio(uvd, 0x00, 0x0004, 0x00c2, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00ca, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0002, 0x00c1, 1);
ultracam_veio(uvd, 0x00, 0x0020, 0x00c2, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00ca, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c3, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c4, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c5, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c6, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c7, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c8, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c3, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c4, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c5, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c6, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c7, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c8, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0040, 0x00c1, 1);
ultracam_veio(uvd, 0x00, 0x0017, 0x00c2, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00ca, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c3, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c4, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c5, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c6, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c7, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c8, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c3, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c4, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c5, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c6, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c7, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c8, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c9, 1);
ultracam_veio(uvd, 0x00, 0x00c0, 0x00c1, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00c2, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00ca, 1);
ultracam_veio(uvd, 0x02, 0xc040, 0x0001, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x0008, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x0009, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x000a, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x000b, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x000c, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x000d, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x000e, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x000f, 0);
ultracam_veio(uvd, 0x01, 0x0000, 0x0010, 0);
ultracam_veio(uvd, 0x01, 0x000b, 0x0008, 1);
ultracam_veio(uvd, 0x01, 0x0034, 0x0009, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x000a, 1);
ultracam_veio(uvd, 0x01, 0x002e, 0x000b, 1);
ultracam_veio(uvd, 0x01, 0x00d6, 0x000c, 1);
ultracam_veio(uvd, 0x01, 0x00fc, 0x000d, 1);
ultracam_veio(uvd, 0x01, 0x00f1, 0x000e, 1);
ultracam_veio(uvd, 0x01, 0x00da, 0x000f, 1);
ultracam_veio(uvd, 0x01, 0x0036, 0x0010, 1);
ultracam_veio(uvd, 0x01, 0x0000, 0x0001, 0);
ultracam_veio(uvd, 0x01, 0x0064, 0x0001, 1);
ultracam_veio(uvd, 0x01, 0x0059, 0x0051, 1);
ultracam_veio(uvd, 0x01, 0x003f, 0x0052, 1);
ultracam_veio(uvd, 0x01, 0x0094, 0x0053, 1);
ultracam_veio(uvd, 0x01, 0x00ff, 0x0011, 1);
ultracam_veio(uvd, 0x01, 0x0003, 0x0012, 1);
ultracam_veio(uvd, 0x01, 0x00f7, 0x0013, 1);
ultracam_veio(uvd, 0x00, 0x0009, 0x0011, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0001, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x0000, 1);
ultracam_veio(uvd, 0x00, 0x0020, 0x00c1, 1);
ultracam_veio(uvd, 0x00, 0x0010, 0x00c2, 1);
ultracam_veio(uvd, 0x00, 0x0000, 0x00ca, 1);
ultracam_alternateSetting(uvd, 0x04);
ultracam_veio(uvd, 0x02, 0x0000, 0x0001, 1);
ultracam_veio(uvd, 0x02, 0x0000, 0x0001, 1);
ultracam_veio(uvd, 0x02, 0x0000, 0x0006, 1);
ultracam_veio(uvd, 0x02, 0x9000, 0x0007, 1);
ultracam_veio(uvd, 0x02, 0x0042, 0x0001, 1);
ultracam_veio(uvd, 0x02, 0x0000, 0x000b, 0);
ultracam_resetPipe(uvd);
ULTRACAM_T(uvd)->initialized = (setup_ok != 0);
}
return setup_ok;
}
static void ultracam_configure_video(struct uvd *uvd)
{
if (uvd == NULL)
return;
RESTRICT_TO_RANGE(init_brightness, 0, 255);
RESTRICT_TO_RANGE(init_contrast, 0, 255);
RESTRICT_TO_RANGE(init_color, 0, 255);
RESTRICT_TO_RANGE(init_hue, 0, 255);
RESTRICT_TO_RANGE(hue_correction, 0, 255);
memset(&uvd->vpic, 0, sizeof(uvd->vpic));
memset(&uvd->vpic_old, 0x55, sizeof(uvd->vpic_old));
uvd->vpic.colour = init_color << 8;
uvd->vpic.hue = init_hue << 8;
uvd->vpic.brightness = init_brightness << 8;
uvd->vpic.contrast = init_contrast << 8;
uvd->vpic.whiteness = 105 << 8; /* This one isn't used */
uvd->vpic.depth = 24;
uvd->vpic.palette = VIDEO_PALETTE_RGB24;
memset(&uvd->vcap, 0, sizeof(uvd->vcap));
strcpy(uvd->vcap.name, "IBM Ultra Camera");
uvd->vcap.type = VID_TYPE_CAPTURE;
uvd->vcap.channels = 1;
uvd->vcap.audios = 0;
uvd->vcap.maxwidth = VIDEOSIZE_X(uvd->canvas);
uvd->vcap.maxheight = VIDEOSIZE_Y(uvd->canvas);
uvd->vcap.minwidth = min_canvasWidth;
uvd->vcap.minheight = min_canvasHeight;
memset(&uvd->vchan, 0, sizeof(uvd->vchan));
uvd->vchan.flags = 0;
uvd->vchan.tuners = 0;
uvd->vchan.channel = 0;
uvd->vchan.type = VIDEO_TYPE_CAMERA;
strcpy(uvd->vchan.name, "Camera");
}
/*
* ultracam_probe()
*
* This procedure queries device descriptor and accepts the interface
* if it looks like our camera.
*
* History:
* 12-Nov-2000 Reworked to comply with new probe() signature.
* 23-Jan-2001 Added compatibility with 2.2.x kernels.
*/
static int ultracam_probe(struct usb_interface *intf, const struct usb_device_id *devid)
{
struct usb_device *dev = interface_to_usbdev(intf);
struct uvd *uvd = NULL;
int ix, i, nas;
int actInterface=-1, inactInterface=-1, maxPS=0;
unsigned char video_ep = 0;
if (debug >= 1)
info("ultracam_probe(%p)", intf);
/* We don't handle multi-config cameras */
if (dev->descriptor.bNumConfigurations != 1)
return -ENODEV;
info("IBM Ultra camera found (rev. 0x%04x)",
le16_to_cpu(dev->descriptor.bcdDevice));
/* Validate found interface: must have one ISO endpoint */
nas = intf->num_altsetting;
if (debug > 0)
info("Number of alternate settings=%d.", nas);
if (nas < 8) {
err("Too few alternate settings for this camera!");
return -ENODEV;
}
/* Validate all alternate settings */
for (ix=0; ix < nas; ix++) {
const struct usb_host_interface *interface;
const struct usb_endpoint_descriptor *endpoint;
interface = &intf->altsetting[ix];
i = interface->desc.bAlternateSetting;
if (interface->desc.bNumEndpoints != 1) {
err("Interface %d. has %u. endpoints!",
interface->desc.bInterfaceNumber,
(unsigned)(interface->desc.bNumEndpoints));
return -ENODEV;
}
endpoint = &interface->endpoint[0].desc;
if (video_ep == 0)
video_ep = endpoint->bEndpointAddress;
else if (video_ep != endpoint->bEndpointAddress) {
err("Alternate settings have different endpoint addresses!");
return -ENODEV;
}
if ((endpoint->bmAttributes & 0x03) != 0x01) {
err("Interface %d. has non-ISO endpoint!",
interface->desc.bInterfaceNumber);
return -ENODEV;
}
if ((endpoint->bEndpointAddress & 0x80) == 0) {
err("Interface %d. has ISO OUT endpoint!",
interface->desc.bInterfaceNumber);
return -ENODEV;
}
if (le16_to_cpu(endpoint->wMaxPacketSize) == 0) {
if (inactInterface < 0)
inactInterface = i;
else {
err("More than one inactive alt. setting!");
return -ENODEV;
}
} else {
if (actInterface < 0) {
actInterface = i;
maxPS = le16_to_cpu(endpoint->wMaxPacketSize);
if (debug > 0)
info("Active setting=%d. maxPS=%d.", i, maxPS);
} else {
/* Got another active alt. setting */
if (maxPS < le16_to_cpu(endpoint->wMaxPacketSize)) {
/* This one is better! */
actInterface = i;
maxPS = le16_to_cpu(endpoint->wMaxPacketSize);
if (debug > 0) {
info("Even better ctive setting=%d. maxPS=%d.",
i, maxPS);
}
}
}
}
}
if ((maxPS <= 0) || (actInterface < 0) || (inactInterface < 0)) {
err("Failed to recognize the camera!");
return -ENODEV;
}
uvd = usbvideo_AllocateDevice(cams);
if (uvd != NULL) {
/* Here uvd is a fully allocated uvd object */
uvd->flags = flags;
uvd->debug = debug;
uvd->dev = dev;
uvd->iface = intf->altsetting->desc.bInterfaceNumber;
uvd->ifaceAltInactive = inactInterface;
uvd->ifaceAltActive = actInterface;
uvd->video_endp = video_ep;
uvd->iso_packet_len = maxPS;
uvd->paletteBits = 1L << VIDEO_PALETTE_RGB24;
uvd->defaultPalette = VIDEO_PALETTE_RGB24;
uvd->canvas = VIDEOSIZE(640, 480); /* FIXME */
uvd->videosize = uvd->canvas; /* ultracam_size_to_videosize(size);*/
/* Initialize ibmcam-specific data */
assert(ULTRACAM_T(uvd) != NULL);
ULTRACAM_T(uvd)->camera_model = 0; /* Not used yet */
ULTRACAM_T(uvd)->initialized = 0;
ultracam_configure_video(uvd);
i = usbvideo_RegisterVideoDevice(uvd);
if (i != 0) {
err("usbvideo_RegisterVideoDevice() failed.");
uvd = NULL;
}
}
if (uvd) {
usb_set_intfdata (intf, uvd);
return 0;
}
return -EIO;
}
static struct usb_device_id id_table[] = {
{ USB_DEVICE(ULTRACAM_VENDOR_ID, ULTRACAM_PRODUCT_ID) },
{ } /* Terminating entry */
};
/*
* ultracam_init()
*
* This code is run to initialize the driver.
*/
static int __init ultracam_init(void)
{
struct usbvideo_cb cbTbl;
memset(&cbTbl, 0, sizeof(cbTbl));
cbTbl.probe = ultracam_probe;
cbTbl.setupOnOpen = ultracam_setup_on_open;
cbTbl.videoStart = ultracam_video_start;
cbTbl.videoStop = ultracam_video_stop;
cbTbl.processData = ultracam_ProcessIsocData;
cbTbl.postProcess = usbvideo_DeinterlaceFrame;
cbTbl.adjustPicture = ultracam_adjust_picture;
cbTbl.getFPS = ultracam_calculate_fps;
return usbvideo_register(
&cams,
MAX_CAMERAS,
sizeof(ultracam_t),
"ultracam",
&cbTbl,
THIS_MODULE,
id_table);
}
static void __exit ultracam_cleanup(void)
{
usbvideo_Deregister(&cams);
}
MODULE_DEVICE_TABLE(usb, id_table);
MODULE_LICENSE("GPL");
module_init(ultracam_init);
module_exit(ultracam_cleanup);
Reference in a new issue View git blame Copy permalink