Skip to content

L
linux
Commit 39c3d488 authored by Hans Verkuil's avatar Hans Verkuil Committed by Mauro Carvalho Chehab
Browse files
Options

[media] cpia, stradis: remove deprecated V4L1 drivers 

Nobody stepped in to convert these drivers to V4L2, so they are now
removed from the kernel.
Signed-off-by: default avatarHans Verkuil <hverkuil@xs4all.nl>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 71bb2876
Hide whitespace changes
Inline Side-by-side
Showing with 0 additions and 8466 deletions
Documentation/video4linux/README.cpia deleted 100644 → 0
View file @ 71bb2876
This is a driver for the CPiA PPC2 driven parallel connected
Camera. For example the Creative WebcamII is CPiA driven.
) [1]Peter Pregler, Linz 2000, published under the [2]GNU GPL
---------------------------------------------------------------------------
USAGE:
General:
========
1) Make sure you have created the video devices (/dev/video*):
- if you have a recent MAKEDEV do a 'cd /dev;./MAKEDEV video'
- otherwise do a:
cd /dev
mknod video0 c 81 0
ln -s video0 video
2) Compile the kernel (see below for the list of options to use),
configure your parport and reboot.
3) If all worked well you should get messages similar
to the following (your versions may be different) on the console:
V4L-Driver for Vision CPiA based cameras v0.7.4
parport0: read2 timeout.
parport0: Multimedia device, VLSI Vision Ltd PPC2
Parallel port driver for Vision CPiA based camera
CPIA Version: 1.20 (2.0)
CPIA PnP-ID: 0553:0002:0100
VP-Version: 1.0 0100
1 camera(s) found
As modules:
===========
Make sure you have selected the following kernel options (you can
select all stuff as modules):
The cpia-stuff is in the section 'Character devices -> Video For Linux'.
CONFIG_PARPORT=m
CONFIG_PARPORT_PC=m
CONFIG_PARPORT_PC_FIFO=y
CONFIG_PARPORT_1284=y
CONFIG_VIDEO_DEV=m
CONFIG_VIDEO_CPIA=m
CONFIG_VIDEO_CPIA_PP=m
For autoloading of all those modules you need to tell module-init-tools
some stuff. Add the following line to your module-init-tools config-file
(e.g. /etc/modprobe.conf or wherever your distribution does store that
stuff):
options parport_pc io=0x378 irq=7 dma=3
alias char-major-81 cpia_pp
The first line tells the dma/irq channels to use. Those _must_ match
the settings of your BIOS. Do NOT simply use the values above. See
Documentation/parport.txt for more information about this. The second
line associates the video-device file with the driver. Of cause you
can also load the modules once upon boot (usually done in /etc/modules).
Linked into the kernel:
=======================
Make sure you have selected the following kernel options. Note that
you cannot compile the parport-stuff as modules and the cpia-driver
statically (the other way round is okay though).
The cpia-stuff is in the section 'Character devices -> Video For Linux'.
CONFIG_PARPORT=y
CONFIG_PARPORT_PC=y
CONFIG_PARPORT_PC_FIFO=y
CONFIG_PARPORT_1284=y
CONFIG_VIDEO_DEV=y
CONFIG_VIDEO_CPIA=y
CONFIG_VIDEO_CPIA_PP=y
To use DMA/irq you will need to tell the kernel upon boot time the
hardware configuration of the parport. You can give the boot-parameter
at the LILO-prompt or specify it in lilo.conf. I use the following
append-line in lilo.conf:
append="parport=0x378,7,3"
See Documentation/parport.txt for more information about the
configuration of the parport and the values given above. Do not simply
use the values given above.
---------------------------------------------------------------------------
FEATURES:
- mmap/read v4l-interface (but no overlay)
- image formats: CIF/QCIF, SIF/QSIF, various others used by isabel;
note: all sizes except CIF/QCIF are implemented by clipping, i.e.
pixels are not uploaded from the camera
- palettes: VIDEO_PALETTE_GRAY, VIDEO_PALETTE_RGB565, VIDEO_PALETTE_RGB555,
VIDEO_PALETTE_RGB24, VIDEO_PALETTE_RGB32, VIDEO_PALETTE_YUYV,
VIDEO_PALETTE_UYVY, VIDEO_PALETTE_YUV422
- state information (color balance, exposure, ...) is preserved between
device opens
- complete control over camera via proc-interface (_all_ camera settings are
supported), there is also a python-gtk application available for this [3]
- works under SMP (but the driver is completely serialized and synchronous)
so you get no benefit from SMP, but at least it does not crash your box
- might work for non-Intel architecture, let us know about this
---------------------------------------------------------------------------
TESTED APPLICATIONS:
- a simple test application based on Xt is available at [3]
- another test-application based on gqcam-0.4 (uses GTK)
- gqcam-0.6 should work
- xawtv-3.x (also the webcam software)
- xawtv-2.46
- w3cam (cgi-interface and vidcat, e.g. you may try out 'vidcat |xv
-maxpect -root -quit +noresetroot -rmode 5 -')
- vic, the MBONE video conferencing tool (version 2.8ucl4-1)
- isabel 3R4beta (barely working, but AFAICT all the problems are on
their side)
- camserv-0.40
See [3] for pointers to v4l-applications.
---------------------------------------------------------------------------
KNOWN PROBLEMS:
- some applications do not handle the image format correctly, you will
see strange horizontal stripes instead of a nice picture -> make sure
your application does use a supported image size or queries the driver
for the actually used size (reason behind this: the camera cannot
provide any image format, so if size NxM is requested the driver will
use a format to the closest fitting N1xM1, the application should now
query for this granted size, most applications do not).
- all the todo ;)
- if there is not enough light and the picture is too dark try to
adjust the SetSensorFPS setting, automatic frame rate adjustment
has its price
- do not try out isabel 3R4beta (built 135), you will be disappointed
---------------------------------------------------------------------------
TODO:
- multiple camera support (struct camera or something) - This should work,
but hasn't been tested yet.
- architecture independence?
- SMP-safe asynchronous mmap interface
- nibble mode for old parport interfaces
- streaming capture, this should give a performance gain
---------------------------------------------------------------------------
IMPLEMENTATION NOTES:
The camera can act in two modes, streaming or grabbing. Right now a
polling grab-scheme is used. Maybe interrupt driven streaming will be
used for a asynchronous mmap interface in the next major release of the
driver. This might give a better frame rate.
---------------------------------------------------------------------------
THANKS (in no particular order):
- Scott J. Bertin <sbertin@mindspring.com> for cleanups, the proc-filesystem
and much more
- Henry Bruce <whb@vvl.co.uk> for providing developers information about
the CPiA chip, I wish all companies would treat Linux as seriously
- Karoly Erdei <Karoly.Erdei@risc.uni-linz.ac.at> and RISC-Linz for being
my boss ;) resp. my employer and for providing me the hardware and
allow me to devote some working time to this project
- Manuel J. Petit de Gabriel <mpetit@dit.upm.es> for providing help
with Isabel (http://isabel.dit.upm.es/)
- Bas Huisman <bhuism@cs.utwente.nl> for writing the initial parport code
- Jarl Totland <Jarl.Totland@bdc.no> for setting up the mailing list
and maintaining the web-server[3]
- Chris Whiteford <Chris@informinteractive.com> for fixes related to the
1.02 firmware
- special kudos to all the tester whose machines crashed and/or
will crash. :)
---------------------------------------------------------------------------
REFERENCES
1. http://www.risc.uni-linz.ac.at/
mailto:Peter_Pregler@email.com
2. see the file COPYING in the top directory of the kernel tree
3. http://webcam.sourceforge.net/
Documentation/video4linux/bttv/Cards
View file @ 39c3d488
......@@ -464,10 +464,6 @@ Siemens
-------
Multimedia eXtension Board (MXB) (SAA7146, SAA7111)
Stradis
-------
SDM275,SDM250,SDM026,SDM025 (SAA7146, IBMMPEG2): MPEG2 decoder only
Powercolor
----------
MTV878
......
MAINTAINERS
View file @ 39c3d488
......@@ -5697,12 +5697,6 @@ M: Ion Badulescu <ionut@badula.org>
S: Odd Fixes
F: drivers/net/starfire*
STRADIS MPEG-2 DECODER DRIVER
M: Nathan Laredo <laredo@gnu.org>
W: http://www.stradis.com/
S: Maintained
F: drivers/media/video/stradis.c
SUN3/3X
M: Sam Creasey <sammy@sammy.net>
W: http://sammy.net/sun3/
......
drivers/staging/Kconfig
View file @ 39c3d488
......@@ -51,10 +51,6 @@ source "drivers/staging/cx25821/Kconfig"
source "drivers/staging/tm6000/Kconfig"
source "drivers/staging/cpia/Kconfig"
source "drivers/staging/stradis/Kconfig"
source "drivers/staging/se401/Kconfig"
source "drivers/staging/usbvideo/Kconfig"
......
drivers/staging/Makefile
View file @ 39c3d488
......@@ -8,8 +8,6 @@ obj-$(CONFIG_SLICOSS) += slicoss/
obj-$(CONFIG_VIDEO_GO7007) += go7007/
obj-$(CONFIG_VIDEO_CX25821) += cx25821/
obj-$(CONFIG_VIDEO_TM6000) += tm6000/
obj-$(CONFIG_VIDEO_CPIA) += cpia/
obj-$(CONFIG_VIDEO_STRADIS) += stradis/
obj-$(CONFIG_USB_VICAM) += usbvideo/
obj-$(CONFIG_USB_SE401) += se401/
obj-$(CONFIG_LIRC_STAGING) += lirc/
......
drivers/staging/cpia/Kconfig deleted 100644 → 0
View file @ 71bb2876
config VIDEO_CPIA
tristate "CPiA Video For Linux (DEPRECATED)"
depends on VIDEO_V4L1
default n
---help---
This driver is DEPRECATED please use the gspca cpia1 module
instead. Note that you need atleast version 0.6.4 of libv4l for
the cpia1 gspca module.
This is the video4linux driver for cameras based on Vision's CPiA
(Colour Processor Interface ASIC), such as the Creative Labs Video
Blaster Webcam II. If you have one of these cameras, say Y here
and select parallel port and/or USB lowlevel support below,
otherwise say N. This will not work with the Creative Webcam III.
Please read <file:Documentation/video4linux/README.cpia> for more
information.
This driver is also available as a module (cpia).
config VIDEO_CPIA_PP
tristate "CPiA Parallel Port Lowlevel Support"
depends on PARPORT_1284 && VIDEO_CPIA && PARPORT
help
This is the lowlevel parallel port support for cameras based on
Vision's CPiA (Colour Processor Interface ASIC), such as the
Creative Webcam II. If you have the parallel port version of one
of these cameras, say Y here, otherwise say N. It is also available
as a module (cpia_pp).
config VIDEO_CPIA_USB
tristate "CPiA USB Lowlevel Support"
depends on VIDEO_CPIA && USB
help
This is the lowlevel USB support for cameras based on Vision's CPiA
(Colour Processor Interface ASIC), such as the Creative Webcam II.
If you have the USB version of one of these cameras, say Y here,
otherwise say N. This will not work with the Creative Webcam III.
It is also available as a module (cpia_usb).
drivers/staging/cpia/Makefile deleted 100644 → 0
View file @ 71bb2876
obj-$(CONFIG_VIDEO_CPIA) += cpia.o
obj-$(CONFIG_VIDEO_CPIA_PP) += cpia_pp.o
obj-$(CONFIG_VIDEO_CPIA_USB) += cpia_usb.o
EXTRA_CFLAGS += -Idrivers/media/video
drivers/staging/cpia/TODO deleted 100644 → 0
View file @ 71bb2876
This is an obsolete driver for some cpia-based webcams that use the parallel port.
We couldn't find anyone with this hardware in order to port it to use V4L2.
Also, parallel-port webcams are obsolete nowadays.
If nobody take care on it, the driver will be removed for 2.6.38.
Please send patches to linux-media@vger.kernel.org
drivers/staging/cpia/cpia.c deleted 100644 → 0
View file @ 71bb2876
This source diff could not be displayed because it is too large. You can view the blob instead.
drivers/staging/cpia/cpia.h deleted 100644 → 0
View file @ 71bb2876
#ifndef cpia_h
#define cpia_h
/*
* CPiA Parallel Port Video4Linux driver
*
* Supports CPiA based parallel port Video Camera's.
*
* (C) Copyright 1999 Bas Huisman,
* Peter Pregler,
* Scott J. Bertin,
* VLSI Vision Ltd.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#define CPIA_MAJ_VER 1
#define CPIA_MIN_VER 2
#define CPIA_PATCH_VER 3
#define CPIA_PP_MAJ_VER CPIA_MAJ_VER
#define CPIA_PP_MIN_VER CPIA_MIN_VER
#define CPIA_PP_PATCH_VER CPIA_PATCH_VER
#define CPIA_USB_MAJ_VER CPIA_MAJ_VER
#define CPIA_USB_MIN_VER CPIA_MIN_VER
#define CPIA_USB_PATCH_VER CPIA_PATCH_VER
#define CPIA_MAX_FRAME_SIZE_UNALIGNED (352 * 288 * 4) /* CIF at RGB32 */
#define CPIA_MAX_FRAME_SIZE ((CPIA_MAX_FRAME_SIZE_UNALIGNED + PAGE_SIZE - 1) & ~(PAGE_SIZE - 1)) /* align above to PAGE_SIZE */
#ifdef __KERNEL__
#include <asm/uaccess.h>
#include <linux/videodev.h>
#include <media/v4l2-common.h>
#include <media/v4l2-ioctl.h>
#include <linux/list.h>
#include <linux/mutex.h>
struct cpia_camera_ops
{
/* open sets privdata to point to structure for this camera.
* Returns negative value on error, otherwise 0.
*/
int (*open)(void *privdata);
/* Registers callback function cb to be called with cbdata
* when an image is ready. If cb is NULL, only single image grabs
* should be used. cb should immediately call streamRead to read
* the data or data may be lost. Returns negative value on error,
* otherwise 0.
*/
int (*registerCallback)(void *privdata, void (*cb)(void *cbdata),
void *cbdata);
/* transferCmd sends commands to the camera. command MUST point to
* an 8 byte buffer in kernel space. data can be NULL if no extra
* data is needed. The size of the data is given by the last 2
* bytes of command. data must also point to memory in kernel space.
* Returns negative value on error, otherwise 0.
*/
int (*transferCmd)(void *privdata, u8 *command, u8 *data);
/* streamStart initiates stream capture mode.
* Returns negative value on error, otherwise 0.
*/
int (*streamStart)(void *privdata);
/* streamStop terminates stream capture mode.
* Returns negative value on error, otherwise 0.
*/
int (*streamStop)(void *privdata);
/* streamRead reads a frame from the camera. buffer points to a
* buffer large enough to hold a complete frame in kernel space.
* noblock indicates if this should be a non blocking read.
* Returns the number of bytes read, or negative value on error.
*/
int (*streamRead)(void *privdata, u8 *buffer, int noblock);
/* close disables the device until open() is called again.
* Returns negative value on error, otherwise 0.
*/
int (*close)(void *privdata);
/* If wait_for_stream_ready is non-zero, wait until the streamState
* is STREAM_READY before calling streamRead.
*/
int wait_for_stream_ready;
/*
* Used to maintain lowlevel module usage counts
*/
struct module *owner;
};
struct cpia_frame {
u8 *data;
int count;
int width;
int height;
volatile int state;
};
struct cam_params {
struct {
u8 firmwareVersion;
u8 firmwareRevision;
u8 vcVersion;
u8 vcRevision;
} version;
struct {
u16 vendor;
u16 product;
u16 deviceRevision;
} pnpID;
struct {
u8 vpVersion;
u8 vpRevision;
u16 cameraHeadID;
} vpVersion;
struct {
u8 systemState;
u8 grabState;
u8 streamState;
u8 fatalError;
u8 cmdError;
u8 debugFlags;
u8 vpStatus;
u8 errorCode;
} status;
struct {
u8 brightness;
u8 contrast;
u8 saturation;
} colourParams;
struct {
u8 gainMode;
u8 expMode;
u8 compMode;
u8 centreWeight;
u8 gain;
u8 fineExp;
u8 coarseExpLo;
u8 coarseExpHi;
u8 redComp;
u8 green1Comp;
u8 green2Comp;
u8 blueComp;
} exposure;
struct {
u8 balanceMode;
u8 redGain;
u8 greenGain;
u8 blueGain;
} colourBalance;
struct {
u8 divisor;
u8 baserate;
} sensorFps;
struct {
u8 gain1;
u8 gain2;
u8 gain4;
u8 gain8;
} apcor;
struct {
u8 disabled;
u8 flickerMode;
u8 coarseJump;
int allowableOverExposure;
} flickerControl;
struct {
u8 gain1;
u8 gain2;
u8 gain4;
u8 gain8;
} vlOffset;
struct {
u8 mode;
u8 decimation;
} compression;
struct {
u8 frTargeting;
u8 targetFR;
u8 targetQ;
} compressionTarget;
struct {
u8 yThreshold;
u8 uvThreshold;
} yuvThreshold;
struct {
u8 hysteresis;
u8 threshMax;
u8 smallStep;
u8 largeStep;
u8 decimationHysteresis;
u8 frDiffStepThresh;
u8 qDiffStepThresh;
u8 decimationThreshMod;
} compressionParams;
struct {
u8 videoSize; /* CIF/QCIF */
u8 subSample;
u8 yuvOrder;
} format;
struct { /* Intel QX3 specific data */
u8 qx3_detected; /* a QX3 is present */
u8 toplight; /* top light lit , R/W */
u8 bottomlight; /* bottom light lit, R/W */
u8 button; /* snapshot button pressed (R/O) */
u8 cradled; /* microscope is in cradle (R/O) */
} qx3;
struct {
u8 colStart; /* skip first 8*colStart pixels */
u8 colEnd; /* finish at 8*colEnd pixels */
u8 rowStart; /* skip first 4*rowStart lines */
u8 rowEnd; /* finish at 4*rowEnd lines */
} roi;
u8 ecpTiming;
u8 streamStartLine;
};
enum v4l_camstates {
CPIA_V4L_IDLE = 0,
CPIA_V4L_ERROR,
CPIA_V4L_COMMAND,
CPIA_V4L_GRABBING,
CPIA_V4L_STREAMING,
CPIA_V4L_STREAMING_PAUSED,
};
#define FRAME_NUM 2 /* double buffering for now */
struct cam_data {
struct list_head cam_data_list;
struct mutex busy_lock; /* guard against SMP multithreading */
struct cpia_camera_ops *ops; /* lowlevel driver operations */
void *lowlevel_data; /* private data for lowlevel driver */
u8 *raw_image; /* buffer for raw image data */
struct cpia_frame decompressed_frame;
/* buffer to hold decompressed frame */
int image_size; /* sizeof last decompressed image */
int open_count; /* # of process that have camera open */
/* camera status */
int fps; /* actual fps reported by the camera */
int transfer_rate; /* transfer rate from camera in kB/s */
u8 mainsFreq; /* for flicker control */
/* proc interface */
struct mutex param_lock; /* params lock for this camera */
struct cam_params params; /* camera settings */
struct proc_dir_entry *proc_entry; /* /proc/cpia/videoX */
/* v4l */
int video_size; /* VIDEO_SIZE_ */
volatile enum v4l_camstates camstate; /* v4l layer status */
struct video_device vdev; /* v4l videodev */
struct video_picture vp; /* v4l camera settings */
struct video_window vw; /* v4l capture area */
struct video_capture vc; /* v4l subcapture area */
/* mmap interface */
int curframe; /* the current frame to grab into */
u8 *frame_buf; /* frame buffer data */
struct cpia_frame frame[FRAME_NUM];
/* FRAME_NUM-buffering, so we need a array */
int first_frame;
int mmap_kludge; /* 'wrong' byte order for mmap */
volatile u32 cmd_queue; /* queued commands */
int exposure_status; /* EXPOSURE_* */
int exposure_count; /* number of frames at this status */
};
/* cpia_register_camera is called by low level driver for each camera.
* A unique camera number is returned, or a negative value on error */
struct cam_data *cpia_register_camera(struct cpia_camera_ops *ops, void *lowlevel);
/* cpia_unregister_camera is called by low level driver when a camera
* is removed. This must not fail. */
void cpia_unregister_camera(struct cam_data *cam);
/* raw CIF + 64 byte header + (2 bytes line_length + EOL) per line + 4*EOI +
* one byte 16bit DMA alignment
*/
#define CPIA_MAX_IMAGE_SIZE ((352*288*2)+64+(288*3)+5)
/* constant value's */
#define MAGIC_0 0x19
#define MAGIC_1 0x68
#define DATA_IN 0xC0
#define DATA_OUT 0x40
#define VIDEOSIZE_QCIF 0 /* 176x144 */
#define VIDEOSIZE_CIF 1 /* 352x288 */
#define VIDEOSIZE_SIF 2 /* 320x240 */
#define VIDEOSIZE_QSIF 3 /* 160x120 */
#define VIDEOSIZE_48_48 4 /* where no one has gone before, iconsize! */
#define VIDEOSIZE_64_48 5
#define VIDEOSIZE_128_96 6
#define VIDEOSIZE_160_120 VIDEOSIZE_QSIF
#define VIDEOSIZE_176_144 VIDEOSIZE_QCIF
#define VIDEOSIZE_192_144 7
#define VIDEOSIZE_224_168 8
#define VIDEOSIZE_256_192 9
#define VIDEOSIZE_288_216 10
#define VIDEOSIZE_320_240 VIDEOSIZE_SIF
#define VIDEOSIZE_352_288 VIDEOSIZE_CIF
#define VIDEOSIZE_88_72 11 /* quarter CIF */
#define SUBSAMPLE_420 0
#define SUBSAMPLE_422 1
#define YUVORDER_YUYV 0
#define YUVORDER_UYVY 1
#define NOT_COMPRESSED 0
#define COMPRESSED 1
#define NO_DECIMATION 0
#define DECIMATION_ENAB 1
#define EOI 0xff /* End Of Image */
#define EOL 0xfd /* End Of Line */
#define FRAME_HEADER_SIZE 64
/* Image grab modes */
#define CPIA_GRAB_SINGLE 0
#define CPIA_GRAB_CONTINUOUS 1
/* Compression parameters */
#define CPIA_COMPRESSION_NONE 0
#define CPIA_COMPRESSION_AUTO 1
#define CPIA_COMPRESSION_MANUAL 2
#define CPIA_COMPRESSION_TARGET_QUALITY 0
#define CPIA_COMPRESSION_TARGET_FRAMERATE 1
/* Return offsets for GetCameraState */
#define SYSTEMSTATE 0
#define GRABSTATE 1
#define STREAMSTATE 2
#define FATALERROR 3
#define CMDERROR 4
#define DEBUGFLAGS 5
#define VPSTATUS 6
#define ERRORCODE 7
/* SystemState */
#define UNINITIALISED_STATE 0
#define PASS_THROUGH_STATE 1
#define LO_POWER_STATE 2
#define HI_POWER_STATE 3
#define WARM_BOOT_STATE 4
/* GrabState */
#define GRAB_IDLE 0
#define GRAB_ACTIVE 1
#define GRAB_DONE 2
/* StreamState */
#define STREAM_NOT_READY 0
#define STREAM_READY 1
#define STREAM_OPEN 2
#define STREAM_PAUSED 3
#define STREAM_FINISHED 4
/* Fatal Error, CmdError, and DebugFlags */
#define CPIA_FLAG 1
#define SYSTEM_FLAG 2
#define INT_CTRL_FLAG 4
#define PROCESS_FLAG 8
#define COM_FLAG 16
#define VP_CTRL_FLAG 32
#define CAPTURE_FLAG 64
#define DEBUG_FLAG 128
/* VPStatus */
#define VP_STATE_OK 0x00
#define VP_STATE_FAILED_VIDEOINIT 0x01
#define VP_STATE_FAILED_AECACBINIT 0x02
#define VP_STATE_AEC_MAX 0x04
#define VP_STATE_ACB_BMAX 0x08
#define VP_STATE_ACB_RMIN 0x10
#define VP_STATE_ACB_GMIN 0x20
#define VP_STATE_ACB_RMAX 0x40
#define VP_STATE_ACB_GMAX 0x80
/* default (minimum) compensation values */
#define COMP_RED 220
#define COMP_GREEN1 214
#define COMP_GREEN2 COMP_GREEN1
#define COMP_BLUE 230
/* exposure status */
#define EXPOSURE_VERY_LIGHT 0
#define EXPOSURE_LIGHT 1
#define EXPOSURE_NORMAL 2
#define EXPOSURE_DARK 3
#define EXPOSURE_VERY_DARK 4
/* ErrorCode */
#define ERROR_FLICKER_BELOW_MIN_EXP 0x01 /*flicker exposure got below minimum exposure */
#define ALOG(fmt,args...) printk(fmt, ##args)
#define LOG(fmt,args...) ALOG(KERN_INFO __FILE__ ":%s(%d):" fmt, __func__ , __LINE__ , ##args)
#ifdef _CPIA_DEBUG_
#define ADBG(fmt,args...) printk(fmt, jiffies, ##args)
#define DBG(fmt,args...) ADBG(KERN_DEBUG __FILE__" (%ld):%s(%d):" fmt, __func__, __LINE__ , ##args)
#else
#define DBG(fmn,args...) do {} while(0)
#endif
#define DEB_BYTE(p)\
DBG("%1d %1d %1d %1d %1d %1d %1d %1d \n",\
(p)&0x80?1:0, (p)&0x40?1:0, (p)&0x20?1:0, (p)&0x10?1:0,\
(p)&0x08?1:0, (p)&0x04?1:0, (p)&0x02?1:0, (p)&0x01?1:0);
#endif /* __KERNEL__ */
#endif /* cpia_h */
drivers/staging/cpia/cpia_pp.c deleted 100644 → 0
View file @ 71bb2876
/*
* cpia_pp CPiA Parallel Port driver
*
* Supports CPiA based parallel port Video Camera's.
*
* (C) Copyright 1999 Bas Huisman <bhuism@cs.utwente.nl>
* (C) Copyright 1999-2000 Scott J. Bertin <sbertin@securenym.net>,
* (C) Copyright 1999-2000 Peter Pregler <Peter_Pregler@email.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
/* define _CPIA_DEBUG_ for verbose debug output (see cpia.h) */
/* #define _CPIA_DEBUG_ 1 */
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/parport.h>
#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/workqueue.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/kmod.h>
/* #define _CPIA_DEBUG_ define for verbose debug output */
#include "cpia.h"
static int cpia_pp_open(void *privdata);
static int cpia_pp_registerCallback(void *privdata, void (*cb) (void *cbdata),
void *cbdata);
static int cpia_pp_transferCmd(void *privdata, u8 *command, u8 *data);
static int cpia_pp_streamStart(void *privdata);
static int cpia_pp_streamStop(void *privdata);
static int cpia_pp_streamRead(void *privdata, u8 *buffer, int noblock);
static int cpia_pp_close(void *privdata);
#define ABOUT "Parallel port driver for Vision CPiA based cameras"
#define PACKET_LENGTH 8
/* Magic numbers for defining port-device mappings */
#define PPCPIA_PARPORT_UNSPEC -4
#define PPCPIA_PARPORT_AUTO -3
#define PPCPIA_PARPORT_OFF -2
#define PPCPIA_PARPORT_NONE -1
static int parport_nr[PARPORT_MAX] = {[0 ... PARPORT_MAX - 1] = PPCPIA_PARPORT_UNSPEC};
static char *parport[PARPORT_MAX] = {NULL,};
MODULE_AUTHOR("B. Huisman <bhuism@cs.utwente.nl> & Peter Pregler <Peter_Pregler@email.com>");
MODULE_DESCRIPTION("Parallel port driver for Vision CPiA based cameras");
MODULE_LICENSE("GPL");
module_param_array(parport, charp, NULL, 0);
MODULE_PARM_DESC(parport, "'auto' or a list of parallel port numbers. Just like lp.");
struct pp_cam_entry {
struct pardevice *pdev;
struct parport *port;
struct work_struct cb_task;
void (*cb_func)(void *cbdata);
void *cb_data;
int open_count;
wait_queue_head_t wq_stream;
/* image state flags */
int image_ready; /* we got an interrupt */
int image_complete; /* we have seen 4 EOI */
int streaming; /* we are in streaming mode */
int stream_irq;
};
static struct cpia_camera_ops cpia_pp_ops =
{
cpia_pp_open,
cpia_pp_registerCallback,
cpia_pp_transferCmd,
cpia_pp_streamStart,
cpia_pp_streamStop,
cpia_pp_streamRead,
cpia_pp_close,
1,
THIS_MODULE
};
static LIST_HEAD(cam_list);
static spinlock_t cam_list_lock_pp;
/* FIXME */
static void cpia_parport_enable_irq( struct parport *port ) {
parport_enable_irq(port);
mdelay(10);
return;
}
static void cpia_parport_disable_irq( struct parport *port ) {
parport_disable_irq(port);
mdelay(10);
return;
}
/* Special CPiA PPC modes: These are invoked by using the 1284 Extensibility
* Link Flag during negotiation */
#define UPLOAD_FLAG 0x08
#define NIBBLE_TRANSFER 0x01
#define ECP_TRANSFER 0x03
#define PARPORT_CHUNK_SIZE PAGE_SIZE
static void cpia_pp_run_callback(struct work_struct *work)
{
void (*cb_func)(void *cbdata);
void *cb_data;
struct pp_cam_entry *cam;
cam = container_of(work, struct pp_cam_entry, cb_task);
cb_func = cam->cb_func;
cb_data = cam->cb_data;
cb_func(cb_data);
}
/****************************************************************************
*
* CPiA-specific low-level parport functions for nibble uploads
*
***************************************************************************/
/* CPiA nonstandard "Nibble" mode (no nDataAvail signal after each byte). */
/* The standard kernel parport_ieee1284_read_nibble() fails with the CPiA... */
static size_t cpia_read_nibble (struct parport *port,
void *buffer, size_t len,
int flags)
{
/* adapted verbatim, with one change, from
parport_ieee1284_read_nibble() in drivers/parport/ieee1284-ops.c */
unsigned char *buf = buffer;
int i;
unsigned char byte = 0;
len *= 2; /* in nibbles */
for (i=0; i < len; i++) {
unsigned char nibble;
/* The CPiA firmware suppresses the use of nDataAvail (nFault LO)
* after every second nibble to signal that more
* data is available. (the total number of Bytes that
* should be sent is known; if too few are received, an error
* will be recorded after a timeout).
* This is incompatible with parport_ieee1284_read_nibble(),
* which expects to find nFault LO after every second nibble.
*/
/* Solution: modify cpia_read_nibble to only check for
* nDataAvail before the first nibble is sent.
*/
/* Does the error line indicate end of data? */
if (((i /*& 1*/) == 0) &&
(parport_read_status(port) & PARPORT_STATUS_ERROR)) {
DBG("%s: No more nibble data (%d bytes)\n",
port->name, i/2);
goto end_of_data;
}
/* Event 7: Set nAutoFd low. */
parport_frob_control (port,
PARPORT_CONTROL_AUTOFD,
PARPORT_CONTROL_AUTOFD);
/* Event 9: nAck goes low. */
port->ieee1284.phase = IEEE1284_PH_REV_DATA;
if (parport_wait_peripheral (port,
PARPORT_STATUS_ACK, 0)) {
/* Timeout -- no more data? */
DBG("%s: Nibble timeout at event 9 (%d bytes)\n",
port->name, i/2);
parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0);
break;
}
/* Read a nibble. */
nibble = parport_read_status (port) >> 3;
nibble &= ~8;
if ((nibble & 0x10) == 0)
nibble |= 8;
nibble &= 0xf;
/* Event 10: Set nAutoFd high. */
parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0);
/* Event 11: nAck goes high. */
if (parport_wait_peripheral (port,
PARPORT_STATUS_ACK,
PARPORT_STATUS_ACK)) {
/* Timeout -- no more data? */
DBG("%s: Nibble timeout at event 11\n",
port->name);
break;
}
if (i & 1) {
/* Second nibble */
byte |= nibble << 4;
*buf++ = byte;
} else
byte = nibble;
}
if (i == len) {
/* Read the last nibble without checking data avail. */
if (parport_read_status (port) & PARPORT_STATUS_ERROR) {
end_of_data:
/* Go to reverse idle phase. */
parport_frob_control (port,
PARPORT_CONTROL_AUTOFD,
PARPORT_CONTROL_AUTOFD);
port->physport->ieee1284.phase = IEEE1284_PH_REV_IDLE;
}
else
port->physport->ieee1284.phase = IEEE1284_PH_HBUSY_DAVAIL;
}
return i/2;
}
/* CPiA nonstandard "Nibble Stream" mode (2 nibbles per cycle, instead of 1)
* (See CPiA Data sheet p. 31)
*
* "Nibble Stream" mode used by CPiA for uploads to non-ECP ports is a
* nonstandard variant of nibble mode which allows the same (mediocre)
* data flow of 8 bits per cycle as software-enabled ECP by TRISTATE-capable
* parallel ports, but works also for non-TRISTATE-capable ports.
* (Standard nibble mode only send 4 bits per cycle)
*
*/
static size_t cpia_read_nibble_stream(struct parport *port,
void *buffer, size_t len,
int flags)
{
int i;
unsigned char *buf = buffer;
int endseen = 0;
for (i=0; i < len; i++) {
unsigned char nibble[2], byte = 0;
int j;
/* Image Data is complete when 4 consecutive EOI bytes (0xff) are seen */
if (endseen > 3 )
break;
/* Event 7: Set nAutoFd low. */
parport_frob_control (port,
PARPORT_CONTROL_AUTOFD,
PARPORT_CONTROL_AUTOFD);
/* Event 9: nAck goes low. */
port->ieee1284.phase = IEEE1284_PH_REV_DATA;
if (parport_wait_peripheral (port,
PARPORT_STATUS_ACK, 0)) {
/* Timeout -- no more data? */
DBG("%s: Nibble timeout at event 9 (%d bytes)\n",
port->name, i/2);
parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0);
break;
}
/* Read lower nibble */
nibble[0] = parport_read_status (port) >>3;
/* Event 10: Set nAutoFd high. */
parport_frob_control (port, PARPORT_CONTROL_AUTOFD, 0);
/* Event 11: nAck goes high. */
if (parport_wait_peripheral (port,
PARPORT_STATUS_ACK,
PARPORT_STATUS_ACK)) {
/* Timeout -- no more data? */
DBG("%s: Nibble timeout at event 11\n",
port->name);
break;
}
/* Read upper nibble */
nibble[1] = parport_read_status (port) >>3;
/* reassemble the byte */
for (j = 0; j < 2 ; j++ ) {
nibble[j] &= ~8;
if ((nibble[j] & 0x10) == 0)
nibble[j] |= 8;
nibble[j] &= 0xf;
}
byte = (nibble[0] |(nibble[1] << 4));
*buf++ = byte;
if(byte == EOI)
endseen++;
else
endseen = 0;
}
return i;
}
/****************************************************************************
*
* EndTransferMode
*
***************************************************************************/
static void EndTransferMode(struct pp_cam_entry *cam)
{
parport_negotiate(cam->port, IEEE1284_MODE_COMPAT);
}
/****************************************************************************
*
* ForwardSetup
*
***************************************************************************/
static int ForwardSetup(struct pp_cam_entry *cam)
{
int retry;
/* The CPiA uses ECP protocol for Downloads from the Host to the camera.
* This will be software-emulated if ECP hardware is not present
*/
/* the usual camera maximum response time is 10ms, but after receiving
* some commands, it needs up to 40ms. (Data Sheet p. 32)*/
for(retry = 0; retry < 4; ++retry) {
if(!parport_negotiate(cam->port, IEEE1284_MODE_ECP)) {
break;
}
mdelay(10);
}
if(retry == 4) {
DBG("Unable to negotiate IEEE1284 ECP Download mode\n");
return -1;
}
return 0;
}
/****************************************************************************
*
* ReverseSetup
*
***************************************************************************/
static int ReverseSetup(struct pp_cam_entry *cam, int extensibility)
{
int retry;
int upload_mode, mode = IEEE1284_MODE_ECP;
int transfer_mode = ECP_TRANSFER;
if (!(cam->port->modes & PARPORT_MODE_ECP) &&
!(cam->port->modes & PARPORT_MODE_TRISTATE)) {
mode = IEEE1284_MODE_NIBBLE;
transfer_mode = NIBBLE_TRANSFER;
}
upload_mode = mode;
if(extensibility) mode = UPLOAD_FLAG|transfer_mode|IEEE1284_EXT_LINK;
/* the usual camera maximum response time is 10ms, but after
* receiving some commands, it needs up to 40ms. */
for(retry = 0; retry < 4; ++retry) {
if(!parport_negotiate(cam->port, mode)) {
break;
}
mdelay(10);
}
if(retry == 4) {
if(extensibility)
DBG("Unable to negotiate upload extensibility mode\n");
else
DBG("Unable to negotiate upload mode\n");
return -1;
}
if(extensibility) cam->port->ieee1284.mode = upload_mode;
return 0;
}
/****************************************************************************
*
* WritePacket
*
***************************************************************************/
static int WritePacket(struct pp_cam_entry *cam, const u8 *packet, size_t size)
{
int retval=0;
int size_written;
if (packet == NULL) {
return -EINVAL;
}
if (ForwardSetup(cam)) {
DBG("Write failed in setup\n");
return -EIO;
}
size_written = parport_write(cam->port, packet, size);
if(size_written != size) {
DBG("Write failed, wrote %d/%d\n", size_written, size);
retval = -EIO;
}
EndTransferMode(cam);
return retval;
}
/****************************************************************************
*
* ReadPacket
*
***************************************************************************/
static int ReadPacket(struct pp_cam_entry *cam, u8 *packet, size_t size)
{
int retval=0;
if (packet == NULL) {
return -EINVAL;
}
if (ReverseSetup(cam, 0)) {
return -EIO;
}
/* support for CPiA variant nibble reads */
if(cam->port->ieee1284.mode == IEEE1284_MODE_NIBBLE) {
if(cpia_read_nibble(cam->port, packet, size, 0) != size)
retval = -EIO;
} else {
if(parport_read(cam->port, packet, size) != size)
retval = -EIO;
}
EndTransferMode(cam);
return retval;
}
/****************************************************************************
*
* cpia_pp_streamStart
*
***************************************************************************/
static int cpia_pp_streamStart(void *privdata)
{
struct pp_cam_entry *cam = privdata;
DBG("\n");
cam->streaming=1;
cam->image_ready=0;
//if (ReverseSetup(cam,1)) return -EIO;
if(cam->stream_irq) cpia_parport_enable_irq(cam->port);
return 0;
}
/****************************************************************************
*
* cpia_pp_streamStop
*
***************************************************************************/
static int cpia_pp_streamStop(void *privdata)
{
struct pp_cam_entry *cam = privdata;
DBG("\n");
cam->streaming=0;
cpia_parport_disable_irq(cam->port);
//EndTransferMode(cam);
return 0;
}
/****************************************************************************
*
* cpia_pp_streamRead
*
***************************************************************************/
static int cpia_pp_read(struct parport *port, u8 *buffer, int len)
{
int bytes_read;
/* support for CPiA variant "nibble stream" reads */
if(port->ieee1284.mode == IEEE1284_MODE_NIBBLE)
bytes_read = cpia_read_nibble_stream(port,buffer,len,0);
else {
int new_bytes;
for(bytes_read=0; bytes_read<len; bytes_read += new_bytes) {
new_bytes = parport_read(port, buffer+bytes_read,
len-bytes_read);
if(new_bytes < 0) break;
}
}
return bytes_read;
}
static int cpia_pp_streamRead(void *privdata, u8 *buffer, int noblock)
{
struct pp_cam_entry *cam = privdata;
int read_bytes = 0;
int i, endseen, block_size, new_bytes;
if(cam == NULL) {
DBG("Internal driver error: cam is NULL\n");
return -EINVAL;
}
if(buffer == NULL) {
DBG("Internal driver error: buffer is NULL\n");
return -EINVAL;
}
//if(cam->streaming) DBG("%d / %d\n", cam->image_ready, noblock);
if( cam->stream_irq ) {
DBG("%d\n", cam->image_ready);
cam->image_ready--;
}
cam->image_complete=0;
if (0/*cam->streaming*/) {
if(!cam->image_ready) {
if(noblock) return -EWOULDBLOCK;
interruptible_sleep_on(&cam->wq_stream);
if( signal_pending(current) ) return -EINTR;
DBG("%d\n", cam->image_ready);
}
} else {
if (ReverseSetup(cam, 1)) {
DBG("unable to ReverseSetup\n");
return -EIO;
}
}
endseen = 0;
block_size = PARPORT_CHUNK_SIZE;
while( !cam->image_complete ) {
cond_resched();
new_bytes = cpia_pp_read(cam->port, buffer, block_size );
if( new_bytes <= 0 ) {
break;
}
i=-1;
while(++i<new_bytes && endseen<4) {
if(*buffer==EOI) {
endseen++;
} else {
endseen=0;
}
buffer++;
}
read_bytes += i;
if( endseen==4 ) {
cam->image_complete=1;
break;
}
if( CPIA_MAX_IMAGE_SIZE-read_bytes <= PARPORT_CHUNK_SIZE ) {
block_size=CPIA_MAX_IMAGE_SIZE-read_bytes;
}
}
EndTransferMode(cam);
return cam->image_complete ? read_bytes : -EIO;
}
/****************************************************************************
*
* cpia_pp_transferCmd
*
***************************************************************************/
static int cpia_pp_transferCmd(void *privdata, u8 *command, u8 *data)
{
int err;
int retval=0;
int databytes;
struct pp_cam_entry *cam = privdata;
if(cam == NULL) {
DBG("Internal driver error: cam is NULL\n");
return -EINVAL;
}
if(command == NULL) {
DBG("Internal driver error: command is NULL\n");
return -EINVAL;
}
databytes = (((int)command[7])<<8) | command[6];
if ((err = WritePacket(cam, command, PACKET_LENGTH)) < 0) {
DBG("Error writing command\n");
return err;
}
if(command[0] == DATA_IN) {
u8 buffer[8];
if(data == NULL) {
DBG("Internal driver error: data is NULL\n");
return -EINVAL;
}
if((err = ReadPacket(cam, buffer, 8)) < 0) {
DBG("Error reading command result\n");
return err;
}
memcpy(data, buffer, databytes);
} else if(command[0] == DATA_OUT) {
if(databytes > 0) {
if(data == NULL) {
DBG("Internal driver error: data is NULL\n");
retval = -EINVAL;
} else {
if((err=WritePacket(cam, data, databytes)) < 0){
DBG("Error writing command data\n");
return err;
}
}
}
} else {
DBG("Unexpected first byte of command: %x\n", command[0]);
retval = -EINVAL;
}
return retval;
}
/****************************************************************************
*
* cpia_pp_open
*
***************************************************************************/
static int cpia_pp_open(void *privdata)
{
struct pp_cam_entry *cam = (struct pp_cam_entry *)privdata;
if (cam == NULL)
return -EINVAL;
if(cam->open_count == 0) {
if (parport_claim(cam->pdev)) {
DBG("failed to claim the port\n");
return -EBUSY;
}
parport_negotiate(cam->port, IEEE1284_MODE_COMPAT);
parport_data_forward(cam->port);
parport_write_control(cam->port, PARPORT_CONTROL_SELECT);
udelay(50);
parport_write_control(cam->port,
PARPORT_CONTROL_SELECT
| PARPORT_CONTROL_INIT);
}
++cam->open_count;
return 0;
}
/****************************************************************************
*
* cpia_pp_registerCallback
*
***************************************************************************/
static int cpia_pp_registerCallback(void *privdata, void (*cb)(void *cbdata), void *cbdata)
{
struct pp_cam_entry *cam = privdata;
int retval = 0;
if(cam->port->irq != PARPORT_IRQ_NONE) {
cam->cb_func = cb;
cam->cb_data = cbdata;
INIT_WORK(&cam->cb_task, cpia_pp_run_callback);
} else {
retval = -1;
}
return retval;
}
/****************************************************************************
*
* cpia_pp_close
*
***************************************************************************/
static int cpia_pp_close(void *privdata)
{
struct pp_cam_entry *cam = privdata;
if (--cam->open_count == 0) {
parport_release(cam->pdev);
}
return 0;
}
/****************************************************************************
*
* cpia_pp_register
*
***************************************************************************/
static int cpia_pp_register(struct parport *port)
{
struct pardevice *pdev = NULL;
struct pp_cam_entry *cam;
struct cam_data *cpia;
if (!(port->modes & PARPORT_MODE_PCSPP)) {
LOG("port is not supported by CPiA driver\n");
return -ENXIO;
}
cam = kzalloc(sizeof(struct pp_cam_entry), GFP_KERNEL);
if (cam == NULL) {
LOG("failed to allocate camera structure\n");
return -ENOMEM;
}
pdev = parport_register_device(port, "cpia_pp", NULL, NULL,
NULL, 0, cam);
if (!pdev) {
LOG("failed to parport_register_device\n");
kfree(cam);
return -ENXIO;
}
cam->pdev = pdev;
cam->port = port;
init_waitqueue_head(&cam->wq_stream);
cam->streaming = 0;
cam->stream_irq = 0;
if((cpia = cpia_register_camera(&cpia_pp_ops, cam)) == NULL) {
LOG("failed to cpia_register_camera\n");
parport_unregister_device(pdev);
kfree(cam);
return -ENXIO;
}
spin_lock( &cam_list_lock_pp );
list_add( &cpia->cam_data_list, &cam_list );
spin_unlock( &cam_list_lock_pp );
return 0;
}
static void cpia_pp_detach (struct parport *port)
{
struct list_head *tmp;
struct cam_data *cpia = NULL;
struct pp_cam_entry *cam;
spin_lock( &cam_list_lock_pp );
list_for_each (tmp, &cam_list) {
cpia = list_entry(tmp, struct cam_data, cam_data_list);
cam = (struct pp_cam_entry *) cpia->lowlevel_data;
if (cam && cam->port->number == port->number) {
list_del(&cpia->cam_data_list);
break;
}
cpia = NULL;
}
spin_unlock( &cam_list_lock_pp );
if (!cpia) {
DBG("cpia_pp_detach failed to find cam_data in cam_list\n");
return;
}
cam = (struct pp_cam_entry *) cpia->lowlevel_data;
cpia_unregister_camera(cpia);
if(cam->open_count > 0)
cpia_pp_close(cam);
parport_unregister_device(cam->pdev);
cpia->lowlevel_data = NULL;
kfree(cam);
}
static void cpia_pp_attach (struct parport *port)
{
unsigned int i;
switch (parport_nr[0])
{
case PPCPIA_PARPORT_UNSPEC:
case PPCPIA_PARPORT_AUTO:
if (port->probe_info[0].class != PARPORT_CLASS_MEDIA ||
port->probe_info[0].cmdset == NULL ||
strncmp(port->probe_info[0].cmdset, "CPIA_1", 6) != 0)
return;
cpia_pp_register(port);
break;
default:
for (i = 0; i < PARPORT_MAX; ++i) {
if (port->number == parport_nr[i]) {
cpia_pp_register(port);
break;
}
}
break;
}
}
static struct parport_driver cpia_pp_driver = {
.name = "cpia_pp",
.attach = cpia_pp_attach,
.detach = cpia_pp_detach,
};
static int __init cpia_pp_init(void)
{
printk(KERN_INFO "%s v%d.%d.%d\n",ABOUT,
CPIA_PP_MAJ_VER,CPIA_PP_MIN_VER,CPIA_PP_PATCH_VER);
if(parport_nr[0] == PPCPIA_PARPORT_OFF) {
printk(" disabled\n");
return 0;
}
spin_lock_init( &cam_list_lock_pp );
if (parport_register_driver (&cpia_pp_driver)) {
LOG ("unable to register with parport\n");
return -EIO;
}
return 0;
}
static int __init cpia_init(void)
{
if (parport[0]) {
/* The user gave some parameters. Let's see what they were. */
if (!strncmp(parport[0], "auto", 4)) {
parport_nr[0] = PPCPIA_PARPORT_AUTO;
} else {
int n;
for (n = 0; n < PARPORT_MAX && parport[n]; n++) {
if (!strncmp(parport[n], "none", 4)) {
parport_nr[n] = PPCPIA_PARPORT_NONE;
} else {
char *ep;
unsigned long r = simple_strtoul(parport[n], &ep, 0);
if (ep != parport[n]) {
parport_nr[n] = r;
} else {
LOG("bad port specifier `%s'\n", parport[n]);
return -ENODEV;
}
}
}
}
}
return cpia_pp_init();
}
static void __exit cpia_cleanup(void)
{
parport_unregister_driver(&cpia_pp_driver);
return;
}
module_init(cpia_init);
module_exit(cpia_cleanup);
drivers/staging/cpia/cpia_usb.c deleted 100644 → 0
View file @ 71bb2876
/*
* cpia_usb CPiA USB driver
*
* Supports CPiA based parallel port Video Camera's.
*
* Copyright (C) 1999 Jochen Scharrlach <Jochen.Scharrlach@schwaben.de>
* Copyright (C) 1999, 2000 Johannes Erdfelt <johannes@erdfelt.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
/* define _CPIA_DEBUG_ for verbose debug output (see cpia.h) */
/* #define _CPIA_DEBUG_ 1 */
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/wait.h>
#include <linux/list.h>
#include <linux/slab.h>
#include <linux/vmalloc.h>
#include <linux/usb.h>
#include "cpia.h"
#define USB_REQ_CPIA_GRAB_FRAME 0xC1
#define USB_REQ_CPIA_UPLOAD_FRAME 0xC2
#define WAIT_FOR_NEXT_FRAME 0
#define FORCE_FRAME_UPLOAD 1
#define FRAMES_PER_DESC 10
#define FRAME_SIZE_PER_DESC 960 /* Shouldn't be hardcoded */
#define CPIA_NUMSBUF 2
#define STREAM_BUF_SIZE (PAGE_SIZE * 4)
#define SCRATCH_BUF_SIZE (STREAM_BUF_SIZE * 2)
struct cpia_sbuf {
char *data;
struct urb *urb;
};
#define FRAMEBUF_LEN (CPIA_MAX_FRAME_SIZE+100)
enum framebuf_status {
FRAME_EMPTY,
FRAME_READING,
FRAME_READY,
FRAME_ERROR,
};
struct framebuf {
int length;
enum framebuf_status status;
u8 data[FRAMEBUF_LEN];
struct framebuf *next;
};
struct usb_cpia {
/* Device structure */
struct usb_device *dev;
unsigned char iface;
wait_queue_head_t wq_stream;
int cursbuf; /* Current receiving sbuf */
struct cpia_sbuf sbuf[CPIA_NUMSBUF]; /* Double buffering */
int streaming;
int open;
int present;
struct framebuf *buffers[3];
struct framebuf *curbuff, *workbuff;
};
static int cpia_usb_open(void *privdata);
static int cpia_usb_registerCallback(void *privdata, void (*cb) (void *cbdata),
void *cbdata);
static int cpia_usb_transferCmd(void *privdata, u8 *command, u8 *data);
static int cpia_usb_streamStart(void *privdata);
static int cpia_usb_streamStop(void *privdata);
static int cpia_usb_streamRead(void *privdata, u8 *frame, int noblock);
static int cpia_usb_close(void *privdata);
#define ABOUT "USB driver for Vision CPiA based cameras"
static struct cpia_camera_ops cpia_usb_ops = {
cpia_usb_open,
cpia_usb_registerCallback,
cpia_usb_transferCmd,
cpia_usb_streamStart,
cpia_usb_streamStop,
cpia_usb_streamRead,
cpia_usb_close,
0,
THIS_MODULE
};
static LIST_HEAD(cam_list);
static spinlock_t cam_list_lock_usb;
static void cpia_usb_complete(struct urb *urb)
{
int i;
char *cdata;
struct usb_cpia *ucpia;
if (!urb || !urb->context)
return;
ucpia = (struct usb_cpia *) urb->context;
if (!ucpia->dev || !ucpia->streaming || !ucpia->present || !ucpia->open)
return;
if (ucpia->workbuff->status == FRAME_EMPTY) {
ucpia->workbuff->status = FRAME_READING;
ucpia->workbuff->length = 0;
}
for (i = 0; i < urb->number_of_packets; i++) {
int n = urb->iso_frame_desc[i].actual_length;
int st = urb->iso_frame_desc[i].status;
cdata = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
if (st)
printk(KERN_DEBUG "cpia data error: [%d] len=%d, status=%X\n", i, n, st);
if (FRAMEBUF_LEN < ucpia->workbuff->length + n) {
printk(KERN_DEBUG "cpia: scratch buf overflow!scr_len: %d, n: %d\n", ucpia->workbuff->length, n);
return;
}
if (n) {
if ((ucpia->workbuff->length > 0) ||
(0x19 == cdata[0] && 0x68 == cdata[1])) {
memcpy(ucpia->workbuff->data + ucpia->workbuff->length, cdata, n);
ucpia->workbuff->length += n;
} else
DBG("Ignoring packet!\n");
} else {
if (ucpia->workbuff->length > 4 &&
0xff == ucpia->workbuff->data[ucpia->workbuff->length-1] &&
0xff == ucpia->workbuff->data[ucpia->workbuff->length-2] &&
0xff == ucpia->workbuff->data[ucpia->workbuff->length-3] &&
0xff == ucpia->workbuff->data[ucpia->workbuff->length-4]) {
ucpia->workbuff->status = FRAME_READY;
ucpia->curbuff = ucpia->workbuff;
ucpia->workbuff = ucpia->workbuff->next;
ucpia->workbuff->status = FRAME_EMPTY;
ucpia->workbuff->length = 0;
if (waitqueue_active(&ucpia->wq_stream))
wake_up_interruptible(&ucpia->wq_stream);
}
}
}
/* resubmit */
urb->dev = ucpia->dev;
if ((i = usb_submit_urb(urb, GFP_ATOMIC)) != 0)
printk(KERN_ERR "%s: usb_submit_urb ret %d\n", __func__, i);
}
static int cpia_usb_open(void *privdata)
{
struct usb_cpia *ucpia = (struct usb_cpia *) privdata;
struct urb *urb;
int ret, retval = 0, fx, err;
if (!ucpia)
return -EINVAL;
ucpia->sbuf[0].data = kmalloc(FRAMES_PER_DESC * FRAME_SIZE_PER_DESC, GFP_KERNEL);
if (!ucpia->sbuf[0].data)
return -EINVAL;
ucpia->sbuf[1].data = kmalloc(FRAMES_PER_DESC * FRAME_SIZE_PER_DESC, GFP_KERNEL);
if (!ucpia->sbuf[1].data) {
retval = -EINVAL;
goto error_0;
}
ret = usb_set_interface(ucpia->dev, ucpia->iface, 3);
if (ret < 0) {
printk(KERN_ERR "cpia_usb_open: usb_set_interface error (ret = %d)\n", ret);
retval = -EBUSY;
goto error_1;
}
ucpia->buffers[0]->status = FRAME_EMPTY;
ucpia->buffers[0]->length = 0;
ucpia->buffers[1]->status = FRAME_EMPTY;
ucpia->buffers[1]->length = 0;
ucpia->buffers[2]->status = FRAME_EMPTY;
ucpia->buffers[2]->length = 0;
ucpia->curbuff = ucpia->buffers[0];
ucpia->workbuff = ucpia->buffers[1];
/* We double buffer the Iso lists, and also know the polling
* interval is every frame (1 == (1 << (bInterval -1))).
*/
urb = usb_alloc_urb(FRAMES_PER_DESC, GFP_KERNEL);
if (!urb) {
printk(KERN_ERR "cpia_init_isoc: usb_alloc_urb 0\n");
retval = -ENOMEM;
goto error_1;
}
ucpia->sbuf[0].urb = urb;
urb->dev = ucpia->dev;
urb->context = ucpia;
urb->pipe = usb_rcvisocpipe(ucpia->dev, 1);
urb->transfer_flags = URB_ISO_ASAP;
urb->transfer_buffer = ucpia->sbuf[0].data;
urb->complete = cpia_usb_complete;
urb->number_of_packets = FRAMES_PER_DESC;
urb->interval = 1;
urb->transfer_buffer_length = FRAME_SIZE_PER_DESC * FRAMES_PER_DESC;
for (fx = 0; fx < FRAMES_PER_DESC; fx++) {
urb->iso_frame_desc[fx].offset = FRAME_SIZE_PER_DESC * fx;
urb->iso_frame_desc[fx].length = FRAME_SIZE_PER_DESC;
}
urb = usb_alloc_urb(FRAMES_PER_DESC, GFP_KERNEL);
if (!urb) {
printk(KERN_ERR "cpia_init_isoc: usb_alloc_urb 1\n");
retval = -ENOMEM;
goto error_urb0;
}
ucpia->sbuf[1].urb = urb;
urb->dev = ucpia->dev;
urb->context = ucpia;
urb->pipe = usb_rcvisocpipe(ucpia->dev, 1);
urb->transfer_flags = URB_ISO_ASAP;
urb->transfer_buffer = ucpia->sbuf[1].data;
urb->complete = cpia_usb_complete;
urb->number_of_packets = FRAMES_PER_DESC;
urb->interval = 1;
urb->transfer_buffer_length = FRAME_SIZE_PER_DESC * FRAMES_PER_DESC;
for (fx = 0; fx < FRAMES_PER_DESC; fx++) {
urb->iso_frame_desc[fx].offset = FRAME_SIZE_PER_DESC * fx;
urb->iso_frame_desc[fx].length = FRAME_SIZE_PER_DESC;
}
/* queue the ISO urbs, and resubmit in the completion handler */
err = usb_submit_urb(ucpia->sbuf[0].urb, GFP_KERNEL);
if (err) {
printk(KERN_ERR "cpia_init_isoc: usb_submit_urb 0 ret %d\n",
err);
goto error_urb1;
}
err = usb_submit_urb(ucpia->sbuf[1].urb, GFP_KERNEL);
if (err) {
printk(KERN_ERR "cpia_init_isoc: usb_submit_urb 1 ret %d\n",
err);
goto error_urb1;
}
ucpia->streaming = 1;
ucpia->open = 1;
return 0;
error_urb1: /* free urb 1 */
usb_free_urb(ucpia->sbuf[1].urb);
ucpia->sbuf[1].urb = NULL;
error_urb0: /* free urb 0 */
usb_free_urb(ucpia->sbuf[0].urb);
ucpia->sbuf[0].urb = NULL;
error_1:
kfree (ucpia->sbuf[1].data);
ucpia->sbuf[1].data = NULL;
error_0:
kfree (ucpia->sbuf[0].data);
ucpia->sbuf[0].data = NULL;
return retval;
}
//
// convenience functions
//
/****************************************************************************
*
* WritePacket
*
***************************************************************************/
static int WritePacket(struct usb_device *udev, const u8 *packet, u8 *buf, size_t size)
{
if (!packet)
return -EINVAL;
return usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
packet[1] + (packet[0] << 8),
USB_TYPE_VENDOR | USB_RECIP_DEVICE,
packet[2] + (packet[3] << 8),
packet[4] + (packet[5] << 8), buf, size, 1000);
}
/****************************************************************************
*
* ReadPacket
*
***************************************************************************/
static int ReadPacket(struct usb_device *udev, u8 *packet, u8 *buf, size_t size)
{
if (!packet || size <= 0)
return -EINVAL;
return usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
packet[1] + (packet[0] << 8),
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
packet[2] + (packet[3] << 8),
packet[4] + (packet[5] << 8), buf, size, 1000);
}
static int cpia_usb_transferCmd(void *privdata, u8 *command, u8 *data)
{
int err = 0;
int databytes;
struct usb_cpia *ucpia = (struct usb_cpia *)privdata;
struct usb_device *udev = ucpia->dev;
if (!udev) {
DBG("Internal driver error: udev is NULL\n");
return -EINVAL;
}
if (!command) {
DBG("Internal driver error: command is NULL\n");
return -EINVAL;
}
databytes = (((int)command[7])<<8) | command[6];
if (command[0] == DATA_IN) {
u8 buffer[8];
if (!data) {
DBG("Internal driver error: data is NULL\n");
return -EINVAL;
}
err = ReadPacket(udev, command, buffer, 8);
if (err < 0)
return err;
memcpy(data, buffer, databytes);
} else if(command[0] == DATA_OUT)
WritePacket(udev, command, data, databytes);
else {
DBG("Unexpected first byte of command: %x\n", command[0]);
err = -EINVAL;
}
return 0;
}
static int cpia_usb_registerCallback(void *privdata, void (*cb) (void *cbdata),
void *cbdata)
{
return -ENODEV;
}
static int cpia_usb_streamStart(void *privdata)
{
return -ENODEV;
}
static int cpia_usb_streamStop(void *privdata)
{
return -ENODEV;
}
static int cpia_usb_streamRead(void *privdata, u8 *frame, int noblock)
{
struct usb_cpia *ucpia = (struct usb_cpia *) privdata;
struct framebuf *mybuff;
if (!ucpia || !ucpia->present)
return -1;
if (ucpia->curbuff->status != FRAME_READY)
interruptible_sleep_on(&ucpia->wq_stream);
else
DBG("Frame already waiting!\n");
mybuff = ucpia->curbuff;
if (!mybuff)
return -1;
if (mybuff->status != FRAME_READY || mybuff->length < 4) {
DBG("Something went wrong!\n");
return -1;
}
memcpy(frame, mybuff->data, mybuff->length);
mybuff->status = FRAME_EMPTY;
/* DBG("read done, %d bytes, Header: %x/%x, Footer: %x%x%x%x\n", */
/* mybuff->length, frame[0], frame[1], */
/* frame[mybuff->length-4], frame[mybuff->length-3], */
/* frame[mybuff->length-2], frame[mybuff->length-1]); */
return mybuff->length;
}
static void cpia_usb_free_resources(struct usb_cpia *ucpia, int try)
{
if (!ucpia->streaming)
return;
ucpia->streaming = 0;
/* Set packet size to 0 */
if (try) {
int ret;
ret = usb_set_interface(ucpia->dev, ucpia->iface, 0);
if (ret < 0) {
printk(KERN_ERR "usb_set_interface error (ret = %d)\n", ret);
return;
}
}
/* Unschedule all of the iso td's */
if (ucpia->sbuf[1].urb) {
usb_kill_urb(ucpia->sbuf[1].urb);
usb_free_urb(ucpia->sbuf[1].urb);
ucpia->sbuf[1].urb = NULL;
}
kfree(ucpia->sbuf[1].data);
ucpia->sbuf[1].data = NULL;
if (ucpia->sbuf[0].urb) {
usb_kill_urb(ucpia->sbuf[0].urb);
usb_free_urb(ucpia->sbuf[0].urb);
ucpia->sbuf[0].urb = NULL;
}
kfree(ucpia->sbuf[0].data);
ucpia->sbuf[0].data = NULL;
}
static int cpia_usb_close(void *privdata)
{
struct usb_cpia *ucpia = (struct usb_cpia *) privdata;
if(!ucpia)
return -ENODEV;
ucpia->open = 0;
/* ucpia->present = 0 protects against trying to reset the
* alt setting if camera is physically disconnected while open */
cpia_usb_free_resources(ucpia, ucpia->present);
return 0;
}
/* Probing and initializing */
static int cpia_probe(struct usb_interface *intf,
const struct usb_device_id *id)
{
struct usb_device *udev = interface_to_usbdev(intf);
struct usb_host_interface *interface;
struct usb_cpia *ucpia;
struct cam_data *cam;
int ret;
/* A multi-config CPiA camera? */
if (udev->descriptor.bNumConfigurations != 1)
return -ENODEV;
interface = intf->cur_altsetting;
printk(KERN_INFO "USB CPiA camera found\n");
ucpia = kzalloc(sizeof(*ucpia), GFP_KERNEL);
if (!ucpia) {
printk(KERN_ERR "couldn't kmalloc cpia struct\n");
return -ENOMEM;
}
ucpia->dev = udev;
ucpia->iface = interface->desc.bInterfaceNumber;
init_waitqueue_head(&ucpia->wq_stream);
ucpia->buffers[0] = vmalloc(sizeof(*ucpia->buffers[0]));
if (!ucpia->buffers[0]) {
printk(KERN_ERR "couldn't vmalloc frame buffer 0\n");
goto fail_alloc_0;
}
ucpia->buffers[1] = vmalloc(sizeof(*ucpia->buffers[1]));
if (!ucpia->buffers[1]) {
printk(KERN_ERR "couldn't vmalloc frame buffer 1\n");
goto fail_alloc_1;
}
ucpia->buffers[2] = vmalloc(sizeof(*ucpia->buffers[2]));
if (!ucpia->buffers[2]) {
printk(KERN_ERR "couldn't vmalloc frame buffer 2\n");
goto fail_alloc_2;
}
ucpia->buffers[0]->next = ucpia->buffers[1];
ucpia->buffers[1]->next = ucpia->buffers[2];
ucpia->buffers[2]->next = ucpia->buffers[0];
ret = usb_set_interface(udev, ucpia->iface, 0);
if (ret < 0) {
printk(KERN_ERR "cpia_probe: usb_set_interface error (ret = %d)\n", ret);
/* goto fail_all; */
}
/* Before register_camera, important */
ucpia->present = 1;
cam = cpia_register_camera(&cpia_usb_ops, ucpia);
if (!cam) {
LOG("failed to cpia_register_camera\n");
goto fail_all;
}
spin_lock( &cam_list_lock_usb );
list_add( &cam->cam_data_list, &cam_list );
spin_unlock( &cam_list_lock_usb );
usb_set_intfdata(intf, cam);
return 0;
fail_all:
vfree(ucpia->buffers[2]);
ucpia->buffers[2] = NULL;
fail_alloc_2:
vfree(ucpia->buffers[1]);
ucpia->buffers[1] = NULL;
fail_alloc_1:
vfree(ucpia->buffers[0]);
ucpia->buffers[0] = NULL;
fail_alloc_0:
kfree(ucpia);
return -EIO;
}
static void cpia_disconnect(struct usb_interface *intf);
static struct usb_device_id cpia_id_table [] = {
{ USB_DEVICE(0x0553, 0x0002) },
{ USB_DEVICE(0x0813, 0x0001) },
{ } /* Terminating entry */
};
MODULE_DEVICE_TABLE (usb, cpia_id_table);
MODULE_LICENSE("GPL");
static struct usb_driver cpia_driver = {
.name = "cpia",
.probe = cpia_probe,
.disconnect = cpia_disconnect,
.id_table = cpia_id_table,
};
static void cpia_disconnect(struct usb_interface *intf)
{
struct cam_data *cam = usb_get_intfdata(intf);
struct usb_cpia *ucpia;
usb_set_intfdata(intf, NULL);
if (!cam)
return;
ucpia = (struct usb_cpia *) cam->lowlevel_data;
spin_lock( &cam_list_lock_usb );
list_del(&cam->cam_data_list);
spin_unlock( &cam_list_lock_usb );
ucpia->present = 0;
cpia_unregister_camera(cam);
if(ucpia->open)
cpia_usb_close(cam->lowlevel_data);
ucpia->curbuff->status = FRAME_ERROR;
if (waitqueue_active(&ucpia->wq_stream))
wake_up_interruptible(&ucpia->wq_stream);
ucpia->curbuff = ucpia->workbuff = NULL;
vfree(ucpia->buffers[2]);
ucpia->buffers[2] = NULL;
vfree(ucpia->buffers[1]);
ucpia->buffers[1] = NULL;
vfree(ucpia->buffers[0]);
ucpia->buffers[0] = NULL;
cam->lowlevel_data = NULL;
kfree(ucpia);
}
static int __init usb_cpia_init(void)
{
printk(KERN_INFO "%s v%d.%d.%d\n",ABOUT,
CPIA_USB_MAJ_VER,CPIA_USB_MIN_VER,CPIA_USB_PATCH_VER);
spin_lock_init(&cam_list_lock_usb);
return usb_register(&cpia_driver);
}
static void __exit usb_cpia_cleanup(void)
{
usb_deregister(&cpia_driver);
}
module_init (usb_cpia_init);
module_exit (usb_cpia_cleanup);
drivers/staging/stradis/Kconfig deleted 100644 → 0
View file @ 71bb2876
config VIDEO_STRADIS
tristate "Stradis 4:2:2 MPEG-2 video driver (DEPRECATED)"
depends on EXPERIMENTAL && PCI && VIDEO_V4L1 && VIRT_TO_BUS && BKL
help
Say Y here to enable support for the Stradis 4:2:2 MPEG-2 video
driver for PCI. There is a product page at
<http://www.stradis.com/>.
drivers/staging/stradis/Makefile deleted 100644 → 0
View file @ 71bb2876
obj-$(CONFIG_VIDEO_STRADIS) += stradis.o
EXTRA_CFLAGS += -Idrivers/media/video
drivers/staging/stradis/TODO deleted 100644 → 0
View file @ 71bb2876
This is an obsolete driver for ancient stradis hardware.
We couldn't find anyone with this hardware in order to port it to use V4L2.
If nobody take care on it, the driver will be removed for 2.6.38.
Please send patches to linux-media@vger.kernel.org
drivers/staging/stradis/stradis.c deleted 100644 → 0
View file @ 71bb2876
/*
* stradis.c - stradis 4:2:2 mpeg decoder driver
*
* Stradis 4:2:2 MPEG-2 Decoder Driver
* Copyright (C) 1999 Nathan Laredo <laredo@gnu.org>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#include <linux/module.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/major.h>
#include <linux/slab.h>
#include <linux/smp_lock.h>
#include <linux/mm.h>
#include <linux/init.h>
#include <linux/poll.h>
#include <linux/pci.h>
#include <linux/signal.h>
#include <asm/io.h>
#include <linux/ioport.h>
#include <asm/pgtable.h>
#include <asm/page.h>
#include <linux/sched.h>
#include <asm/types.h>
#include <linux/types.h>
#include <linux/interrupt.h>
#include <asm/uaccess.h>
#include <linux/vmalloc.h>
#include <linux/videodev.h>
#include <media/v4l2-common.h>
#include <media/v4l2-ioctl.h>
#include "saa7146.h"
#include "saa7146reg.h"
#include "ibmmpeg2.h"
#include "saa7121.h"
#include "cs8420.h"
#define DEBUG(x) /* debug driver */
#undef IDEBUG /* debug irq handler */
#undef MDEBUG /* debug memory management */
#define SAA7146_MAX 6
static struct saa7146 saa7146s[SAA7146_MAX];
static int saa_num; /* number of SAA7146s in use */
static int video_nr = -1;
module_param(video_nr, int, 0);
MODULE_LICENSE("GPL");
#define nDebNormal 0x00480000
#define nDebNoInc 0x00480000
#define nDebVideo 0xd0480000
#define nDebAudio 0xd0400000
#define nDebDMA 0x02c80000
#define oDebNormal 0x13c80000
#define oDebNoInc 0x13c80000
#define oDebVideo 0xd1080000
#define oDebAudio 0xd1080000
#define oDebDMA 0x03080000
#define NewCard (saa->boardcfg[3])
#define ChipControl (saa->boardcfg[1])
#define NTSCFirstActive (saa->boardcfg[4])
#define PALFirstActive (saa->boardcfg[5])
#define NTSCLastActive (saa->boardcfg[54])
#define PALLastActive (saa->boardcfg[55])
#define Have2MB (saa->boardcfg[18] & 0x40)
#define HaveCS8420 (saa->boardcfg[18] & 0x04)
#define IBMMPEGCD20 (saa->boardcfg[18] & 0x20)
#define HaveCS3310 (saa->boardcfg[18] & 0x01)
#define CS3310MaxLvl ((saa->boardcfg[30] << 8) | saa->boardcfg[31])
#define HaveCS4341 (saa->boardcfg[40] == 2)
#define SDIType (saa->boardcfg[27])
#define CurrentMode (saa->boardcfg[2])
#define debNormal (NewCard ? nDebNormal : oDebNormal)
#define debNoInc (NewCard ? nDebNoInc : oDebNoInc)
#define debVideo (NewCard ? nDebVideo : oDebVideo)
#define debAudio (NewCard ? nDebAudio : oDebAudio)
#define debDMA (NewCard ? nDebDMA : oDebDMA)
#ifdef USE_RESCUE_EEPROM_SDM275
static unsigned char rescue_eeprom[64] = {
0x00, 0x01, 0x04, 0x13, 0x26, 0x0f, 0x10, 0x00, 0x00, 0x00, 0x43, 0x63,
0x22, 0x01, 0x29, 0x15, 0x73, 0x00, 0x1f, 'd', 'e', 'c', 'x', 'l',
'd', 'v', 'a', 0x02, 0x00, 0x01, 0x00, 0xcc, 0xa4, 0x63, 0x09, 0xe2,
0x10, 0x00, 0x0a, 0x00, 0x02, 0x02, 'd', 'e', 'c', 'x', 'l', 'a',
0x00, 0x00, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00,
};
#endif
/* ----------------------------------------------------------------------- */
/* Hardware I2C functions */
static void I2CWipe(struct saa7146 *saa)
{
int i;
/* set i2c to ~=100kHz, abort transfer, clear busy */
saawrite(0x600 | SAA7146_I2C_ABORT, SAA7146_I2C_STATUS);
saawrite((SAA7146_MC2_UPLD_I2C << 16) |
SAA7146_MC2_UPLD_I2C, SAA7146_MC2);
/* wait for i2c registers to be programmed */
for (i = 0; i < 1000 &&
!(saaread(SAA7146_MC2) & SAA7146_MC2_UPLD_I2C); i++)
schedule();
saawrite(0x600, SAA7146_I2C_STATUS);
saawrite((SAA7146_MC2_UPLD_I2C << 16) |
SAA7146_MC2_UPLD_I2C, SAA7146_MC2);
/* wait for i2c registers to be programmed */
for (i = 0; i < 1000 &&
!(saaread(SAA7146_MC2) & SAA7146_MC2_UPLD_I2C); i++)
schedule();
saawrite(0x600, SAA7146_I2C_STATUS);
saawrite((SAA7146_MC2_UPLD_I2C << 16) |
SAA7146_MC2_UPLD_I2C, SAA7146_MC2);
/* wait for i2c registers to be programmed */
for (i = 0; i < 1000 &&
!(saaread(SAA7146_MC2) & SAA7146_MC2_UPLD_I2C); i++)
schedule();
}
/* read I2C */
static int I2CRead(struct saa7146 *saa, unsigned char addr,
unsigned char subaddr, int dosub)
{
int i;
if (saaread(SAA7146_I2C_STATUS) & 0x3c)
I2CWipe(saa);
for (i = 0;
i < 1000 && (saaread(SAA7146_I2C_STATUS) & SAA7146_I2C_BUSY);
i++)
schedule();
if (i == 1000)
I2CWipe(saa);
if (dosub)
saawrite(((addr & 0xfe) << 24) | (((addr | 1) & 0xff) << 8) |
((subaddr & 0xff) << 16) | 0xed, SAA7146_I2C_TRANSFER);
else
saawrite(((addr & 0xfe) << 24) | (((addr | 1) & 0xff) << 16) |
0xf1, SAA7146_I2C_TRANSFER);
saawrite((SAA7146_MC2_UPLD_I2C << 16) |
SAA7146_MC2_UPLD_I2C, SAA7146_MC2);
/* wait for i2c registers to be programmed */
for (i = 0; i < 1000 &&
!(saaread(SAA7146_MC2) & SAA7146_MC2_UPLD_I2C); i++)
schedule();
/* wait for valid data */
for (i = 0; i < 1000 &&
(saaread(SAA7146_I2C_STATUS) & SAA7146_I2C_BUSY); i++)
schedule();
if (saaread(SAA7146_I2C_STATUS) & SAA7146_I2C_ERR)
return -1;
if (i == 1000)
printk("i2c setup read timeout\n");
saawrite(0x41, SAA7146_I2C_TRANSFER);
saawrite((SAA7146_MC2_UPLD_I2C << 16) |
SAA7146_MC2_UPLD_I2C, SAA7146_MC2);
/* wait for i2c registers to be programmed */
for (i = 0; i < 1000 &&
!(saaread(SAA7146_MC2) & SAA7146_MC2_UPLD_I2C); i++)
schedule();
/* wait for valid data */
for (i = 0; i < 1000 &&
(saaread(SAA7146_I2C_TRANSFER) & SAA7146_I2C_BUSY); i++)
schedule();
if (saaread(SAA7146_I2C_TRANSFER) & SAA7146_I2C_ERR)
return -1;
if (i == 1000)
printk("i2c read timeout\n");
return ((saaread(SAA7146_I2C_TRANSFER) >> 24) & 0xff);
}
/* set both to write both bytes, reset it to write only b1 */
static int I2CWrite(struct saa7146 *saa, unsigned char addr, unsigned char b1,
unsigned char b2, int both)
{
int i;
u32 data;
if (saaread(SAA7146_I2C_STATUS) & 0x3c)
I2CWipe(saa);
for (i = 0; i < 1000 &&
(saaread(SAA7146_I2C_STATUS) & SAA7146_I2C_BUSY); i++)
schedule();
if (i == 1000)
I2CWipe(saa);
data = ((addr & 0xfe) << 24) | ((b1 & 0xff) << 16);
if (both)
data |= ((b2 & 0xff) << 8) | 0xe5;
else
data |= 0xd1;
saawrite(data, SAA7146_I2C_TRANSFER);
saawrite((SAA7146_MC2_UPLD_I2C << 16) | SAA7146_MC2_UPLD_I2C,
SAA7146_MC2);
return 0;
}
static void attach_inform(struct saa7146 *saa, int id)
{
int i;
DEBUG(printk(KERN_DEBUG "stradis%d: i2c: device found=%02x\n", saa->nr,
id));
if (id == 0xa0) { /* we have rev2 or later board, fill in info */
for (i = 0; i < 64; i++)
saa->boardcfg[i] = I2CRead(saa, 0xa0, i, 1);
#ifdef USE_RESCUE_EEPROM_SDM275
if (saa->boardcfg[0] != 0) {
printk("stradis%d: WARNING: EEPROM STORED VALUES HAVE "
"BEEN IGNORED\n", saa->nr);
for (i = 0; i < 64; i++)
saa->boardcfg[i] = rescue_eeprom[i];
}
#endif
printk("stradis%d: config =", saa->nr);
for (i = 0; i < 51; i++) {
printk(" %02x", saa->boardcfg[i]);
}
printk("\n");
}
}
static void I2CBusScan(struct saa7146 *saa)
{
int i;
for (i = 0; i < 0xff; i += 2)
if ((I2CRead(saa, i, 0, 0)) >= 0)
attach_inform(saa, i);
}
static int debiwait_maxwait;
static int wait_for_debi_done(struct saa7146 *saa)
{
int i;
/* wait for registers to be programmed */
for (i = 0; i < 100000 &&
!(saaread(SAA7146_MC2) & SAA7146_MC2_UPLD_DEBI); i++)
saaread(SAA7146_MC2);
/* wait for transfer to complete */
for (i = 0; i < 500000 &&
(saaread(SAA7146_PSR) & SAA7146_PSR_DEBI_S); i++)
saaread(SAA7146_MC2);
if (i > debiwait_maxwait)
printk("wait-for-debi-done maxwait: %d\n",
debiwait_maxwait = i);
if (i == 500000)
return -1;
return 0;
}
static int debiwrite(struct saa7146 *saa, u32 config, int addr,
u32 val, int count)
{
u32 cmd;
if (count <= 0 || count > 32764)
return -1;
if (wait_for_debi_done(saa) < 0)
return -1;
saawrite(config, SAA7146_DEBI_CONFIG);
if (count <= 4) /* immediate transfer */
saawrite(val, SAA7146_DEBI_AD);
else /* block transfer */
saawrite(virt_to_bus(saa->dmadebi), SAA7146_DEBI_AD);
saawrite((cmd = (count << 17) | (addr & 0xffff)), SAA7146_DEBI_COMMAND);
saawrite((SAA7146_MC2_UPLD_DEBI << 16) | SAA7146_MC2_UPLD_DEBI,
SAA7146_MC2);
return 0;
}
static u32 debiread(struct saa7146 *saa, u32 config, int addr, int count)
{
u32 result = 0;
if (count > 32764 || count <= 0)
return 0;
if (wait_for_debi_done(saa) < 0)
return 0;
saawrite(virt_to_bus(saa->dmadebi), SAA7146_DEBI_AD);
saawrite((count << 17) | 0x10000 | (addr & 0xffff),
SAA7146_DEBI_COMMAND);
saawrite(config, SAA7146_DEBI_CONFIG);
saawrite((SAA7146_MC2_UPLD_DEBI << 16) | SAA7146_MC2_UPLD_DEBI,
SAA7146_MC2);
if (count > 4) /* not an immediate transfer */
return count;
wait_for_debi_done(saa);
result = saaread(SAA7146_DEBI_AD);
if (count == 1)
result &= 0xff;
if (count == 2)
result &= 0xffff;
if (count == 3)
result &= 0xffffff;
return result;
}
static void do_irq_send_data(struct saa7146 *saa)
{
int split, audbytes, vidbytes;
saawrite(SAA7146_PSR_PIN1, SAA7146_IER);
/* if special feature mode in effect, disable audio sending */
if (saa->playmode != VID_PLAY_NORMAL)
saa->audtail = saa->audhead = 0;
if (saa->audhead <= saa->audtail)
audbytes = saa->audtail - saa->audhead;
else
audbytes = 65536 - (saa->audhead - saa->audtail);
if (saa->vidhead <= saa->vidtail)
vidbytes = saa->vidtail - saa->vidhead;
else
vidbytes = 524288 - (saa->vidhead - saa->vidtail);
if (audbytes == 0 && vidbytes == 0 && saa->osdtail == saa->osdhead) {
saawrite(0, SAA7146_IER);
return;
}
/* if at least 1 block audio waiting and audio fifo isn't full */
if (audbytes >= 2048 && (debiread(saa, debNormal, IBM_MP2_AUD_FIFO, 2)
& 0xff) < 60) {
if (saa->audhead > saa->audtail)
split = 65536 - saa->audhead;
else
split = 0;
audbytes = 2048;
if (split > 0 && split < 2048) {
memcpy(saa->dmadebi, saa->audbuf + saa->audhead, split);
saa->audhead = 0;
audbytes -= split;
} else
split = 0;
memcpy(saa->dmadebi + split, saa->audbuf + saa->audhead,
audbytes);
saa->audhead += audbytes;
saa->audhead &= 0xffff;
debiwrite(saa, debAudio, (NewCard ? IBM_MP2_AUD_FIFO :
IBM_MP2_AUD_FIFOW), 0, 2048);
wake_up_interruptible(&saa->audq);
/* if at least 1 block video waiting and video fifo isn't full */
} else if (vidbytes >= 30720 && (debiread(saa, debNormal,
IBM_MP2_FIFO, 2)) < 16384) {
if (saa->vidhead > saa->vidtail)
split = 524288 - saa->vidhead;
else
split = 0;
vidbytes = 30720;
if (split > 0 && split < 30720) {
memcpy(saa->dmadebi, saa->vidbuf + saa->vidhead, split);
saa->vidhead = 0;
vidbytes -= split;
} else
split = 0;
memcpy(saa->dmadebi + split, saa->vidbuf + saa->vidhead,
vidbytes);
saa->vidhead += vidbytes;
saa->vidhead &= 0x7ffff;
debiwrite(saa, debVideo, (NewCard ? IBM_MP2_FIFO :
IBM_MP2_FIFOW), 0, 30720);
wake_up_interruptible(&saa->vidq);
}
saawrite(SAA7146_PSR_DEBI_S | SAA7146_PSR_PIN1, SAA7146_IER);
}
static void send_osd_data(struct saa7146 *saa)
{
int size = saa->osdtail - saa->osdhead;
if (size > 30720)
size = 30720;
/* ensure some multiple of 8 bytes is transferred */
size = 8 * ((size + 8) >> 3);
if (size) {
debiwrite(saa, debNormal, IBM_MP2_OSD_ADDR,
(saa->osdhead >> 3), 2);
memcpy(saa->dmadebi, &saa->osdbuf[saa->osdhead], size);
saa->osdhead += size;
/* block transfer of next 8 bytes to ~32k bytes */
debiwrite(saa, debNormal, IBM_MP2_OSD_DATA, 0, size);
}
if (saa->osdhead >= saa->osdtail) {
saa->osdhead = saa->osdtail = 0;
debiwrite(saa, debNormal, IBM_MP2_MASK0, 0xc00c, 2);
}
}
static irqreturn_t saa7146_irq(int irq, void *dev_id)
{
struct saa7146 *saa = dev_id;
u32 stat, astat;
int count;
int handled = 0;
count = 0;
while (1) {
/* get/clear interrupt status bits */
stat = saaread(SAA7146_ISR);
astat = stat & saaread(SAA7146_IER);
if (!astat)
break;
handled = 1;
saawrite(astat, SAA7146_ISR);
if (astat & SAA7146_PSR_DEBI_S) {
do_irq_send_data(saa);
}
if (astat & SAA7146_PSR_PIN1) {
int istat;
/* the following read will trigger DEBI_S */
istat = debiread(saa, debNormal, IBM_MP2_HOST_INT, 2);
if (istat & 1) {
saawrite(0, SAA7146_IER);
send_osd_data(saa);
saawrite(SAA7146_PSR_DEBI_S |
SAA7146_PSR_PIN1, SAA7146_IER);
}
if (istat & 0x20) { /* Video Start */
saa->vidinfo.frame_count++;
}
if (istat & 0x400) { /* Picture Start */
/* update temporal reference */
}
if (istat & 0x200) { /* Picture Resolution Change */
/* read new resolution */
}
if (istat & 0x100) { /* New User Data found */
/* read new user data */
}
if (istat & 0x1000) { /* new GOP/SMPTE */
/* read new SMPTE */
}
if (istat & 0x8000) { /* Sequence Start Code */
/* reset frame counter, load sizes */
saa->vidinfo.frame_count = 0;
saa->vidinfo.h_size = 704;
saa->vidinfo.v_size = 480;
#if 0
if (saa->endmarkhead != saa->endmarktail) {
saa->audhead =
saa->endmark[saa->endmarkhead];
saa->endmarkhead++;
if (saa->endmarkhead >= MAX_MARKS)
saa->endmarkhead = 0;
}
#endif
}
if (istat & 0x4000) { /* Sequence Error Code */
if (saa->endmarkhead != saa->endmarktail) {
saa->audhead =
saa->endmark[saa->endmarkhead];
saa->endmarkhead++;
if (saa->endmarkhead >= MAX_MARKS)
saa->endmarkhead = 0;
}
}
}
#ifdef IDEBUG
if (astat & SAA7146_PSR_PPEF) {
IDEBUG(printk("stradis%d irq: PPEF\n", saa->nr));
}
if (astat & SAA7146_PSR_PABO) {
IDEBUG(printk("stradis%d irq: PABO\n", saa->nr));
}
if (astat & SAA7146_PSR_PPED) {
IDEBUG(printk("stradis%d irq: PPED\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_I1) {
IDEBUG(printk("stradis%d irq: RPS_I1\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_I0) {
IDEBUG(printk("stradis%d irq: RPS_I0\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_LATE1) {
IDEBUG(printk("stradis%d irq: RPS_LATE1\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_LATE0) {
IDEBUG(printk("stradis%d irq: RPS_LATE0\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_E1) {
IDEBUG(printk("stradis%d irq: RPS_E1\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_E0) {
IDEBUG(printk("stradis%d irq: RPS_E0\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_TO1) {
IDEBUG(printk("stradis%d irq: RPS_TO1\n", saa->nr));
}
if (astat & SAA7146_PSR_RPS_TO0) {
IDEBUG(printk("stradis%d irq: RPS_TO0\n", saa->nr));
}
if (astat & SAA7146_PSR_UPLD) {
IDEBUG(printk("stradis%d irq: UPLD\n", saa->nr));
}
if (astat & SAA7146_PSR_DEBI_E) {
IDEBUG(printk("stradis%d irq: DEBI_E\n", saa->nr));
}
if (astat & SAA7146_PSR_I2C_S) {
IDEBUG(printk("stradis%d irq: I2C_S\n", saa->nr));
}
if (astat & SAA7146_PSR_I2C_E) {
IDEBUG(printk("stradis%d irq: I2C_E\n", saa->nr));
}
if (astat & SAA7146_PSR_A2_IN) {
IDEBUG(printk("stradis%d irq: A2_IN\n", saa->nr));
}
if (astat & SAA7146_PSR_A2_OUT) {
IDEBUG(printk("stradis%d irq: A2_OUT\n", saa->nr));
}
if (astat & SAA7146_PSR_A1_IN) {
IDEBUG(printk("stradis%d irq: A1_IN\n", saa->nr));
}
if (astat & SAA7146_PSR_A1_OUT) {
IDEBUG(printk("stradis%d irq: A1_OUT\n", saa->nr));
}
if (astat & SAA7146_PSR_AFOU) {
IDEBUG(printk("stradis%d irq: AFOU\n", saa->nr));
}
if (astat & SAA7146_PSR_V_PE) {
IDEBUG(printk("stradis%d irq: V_PE\n", saa->nr));
}
if (astat & SAA7146_PSR_VFOU) {
IDEBUG(printk("stradis%d irq: VFOU\n", saa->nr));
}
if (astat & SAA7146_PSR_FIDA) {
IDEBUG(printk("stradis%d irq: FIDA\n", saa->nr));
}
if (astat & SAA7146_PSR_FIDB) {
IDEBUG(printk("stradis%d irq: FIDB\n", saa->nr));
}
if (astat & SAA7146_PSR_PIN3) {
IDEBUG(printk("stradis%d irq: PIN3\n", saa->nr));
}
if (astat & SAA7146_PSR_PIN2) {
IDEBUG(printk("stradis%d irq: PIN2\n", saa->nr));
}
if (astat & SAA7146_PSR_PIN0) {
IDEBUG(printk("stradis%d irq: PIN0\n", saa->nr));
}
if (astat & SAA7146_PSR_ECS) {
IDEBUG(printk("stradis%d irq: ECS\n", saa->nr));
}
if (astat & SAA7146_PSR_EC3S) {
IDEBUG(printk("stradis%d irq: EC3S\n", saa->nr));
}
if (astat & SAA7146_PSR_EC0S) {
IDEBUG(printk("stradis%d irq: EC0S\n", saa->nr));
}
#endif
count++;
if (count > 15)
printk(KERN_WARNING "stradis%d: irq loop %d\n",
saa->nr, count);
if (count > 20) {
saawrite(0, SAA7146_IER);
printk(KERN_ERR
"stradis%d: IRQ loop cleared\n", saa->nr);
}
}
return IRQ_RETVAL(handled);
}
static int ibm_send_command(struct saa7146 *saa,
int command, int data, int chain)
{
int i;
if (chain)
debiwrite(saa, debNormal, IBM_MP2_COMMAND, (command << 1)| 1,2);
else
debiwrite(saa, debNormal, IBM_MP2_COMMAND, command << 1, 2);
debiwrite(saa, debNormal, IBM_MP2_CMD_DATA, data, 2);
debiwrite(saa, debNormal, IBM_MP2_CMD_STAT, 1, 2);
for (i = 0; i < 100 &&
(debiread(saa, debNormal, IBM_MP2_CMD_STAT, 2) & 1); i++)
schedule();
if (i == 100)
return -1;
return 0;
}
static void cs4341_setlevel(struct saa7146 *saa, int left, int right)
{
I2CWrite(saa, 0x22, 0x03, left > 94 ? 94 : left, 2);
I2CWrite(saa, 0x22, 0x04, right > 94 ? 94 : right, 2);
}
static void initialize_cs4341(struct saa7146 *saa)
{
int i;
for (i = 0; i < 200; i++) {
/* auto mute off, power on, no de-emphasis */
/* I2S data up to 24-bit 64xFs internal SCLK */
I2CWrite(saa, 0x22, 0x01, 0x11, 2);
/* ATAPI mixer settings */
I2CWrite(saa, 0x22, 0x02, 0x49, 2);
/* attenuation left 3db */
I2CWrite(saa, 0x22, 0x03, 0x00, 2);
/* attenuation right 3db */
I2CWrite(saa, 0x22, 0x04, 0x00, 2);
I2CWrite(saa, 0x22, 0x01, 0x10, 2);
if (I2CRead(saa, 0x22, 0x02, 1) == 0x49)
break;
schedule();
}
printk("stradis%d: CS4341 initialized (%d)\n", saa->nr, i);
return;
}
static void initialize_cs8420(struct saa7146 *saa, int pro)
{
int i;
u8 *sequence;
if (pro)
sequence = mode8420pro;
else
sequence = mode8420con;
for (i = 0; i < INIT8420LEN; i++)
I2CWrite(saa, 0x20, init8420[i * 2], init8420[i * 2 + 1], 2);
for (i = 0; i < MODE8420LEN; i++)
I2CWrite(saa, 0x20, sequence[i * 2], sequence[i * 2 + 1], 2);
printk("stradis%d: CS8420 initialized\n", saa->nr);
}
static void initialize_saa7121(struct saa7146 *saa, int dopal)
{
int i, mod;
u8 *sequence;
if (dopal)
sequence = init7121pal;
else
sequence = init7121ntsc;
mod = saaread(SAA7146_PSR) & 0x08;
/* initialize PAL/NTSC video encoder */
for (i = 0; i < INIT7121LEN; i++) {
if (NewCard) { /* handle new card encoder differences */
if (sequence[i * 2] == 0x3a)
I2CWrite(saa, 0x88, 0x3a, 0x13, 2);
else if (sequence[i * 2] == 0x6b)
I2CWrite(saa, 0x88, 0x6b, 0x20, 2);
else if (sequence[i * 2] == 0x6c)
I2CWrite(saa, 0x88, 0x6c,
dopal ? 0x09 : 0xf5, 2);
else if (sequence[i * 2] == 0x6d)
I2CWrite(saa, 0x88, 0x6d,
dopal ? 0x20 : 0x00, 2);
else if (sequence[i * 2] == 0x7a)
I2CWrite(saa, 0x88, 0x7a,
dopal ? (PALFirstActive - 1) :
(NTSCFirstActive - 4), 2);
else if (sequence[i * 2] == 0x7b)
I2CWrite(saa, 0x88, 0x7b,
dopal ? PALLastActive :
NTSCLastActive, 2);
else
I2CWrite(saa, 0x88, sequence[i * 2],
sequence[i * 2 + 1], 2);
} else {
if (sequence[i * 2] == 0x6b && mod)
I2CWrite(saa, 0x88, 0x6b,
(sequence[i * 2 + 1] ^ 0x09), 2);
else if (sequence[i * 2] == 0x7a)
I2CWrite(saa, 0x88, 0x7a,
dopal ? (PALFirstActive - 1) :
(NTSCFirstActive - 4), 2);
else if (sequence[i * 2] == 0x7b)
I2CWrite(saa, 0x88, 0x7b,
dopal ? PALLastActive :
NTSCLastActive, 2);
else
I2CWrite(saa, 0x88, sequence[i * 2],
sequence[i * 2 + 1], 2);
}
}
}
static void set_genlock_offset(struct saa7146 *saa, int noffset)
{
int nCode;
int PixelsPerLine = 858;
if (CurrentMode == VIDEO_MODE_PAL)
PixelsPerLine = 864;
if (noffset > 500)
noffset = 500;
else if (noffset < -500)
noffset = -500;
nCode = noffset + 0x100;
if (nCode == 1)
nCode = 0x401;
else if (nCode < 1)
nCode = 0x400 + PixelsPerLine + nCode;
debiwrite(saa, debNormal, XILINX_GLDELAY, nCode, 2);
}
static void set_out_format(struct saa7146 *saa, int mode)
{
initialize_saa7121(saa, (mode == VIDEO_MODE_NTSC ? 0 : 1));
saa->boardcfg[2] = mode;
/* do not adjust analog video parameters here, use saa7121 init */
/* you will affect the SDI output on the new card */
if (mode == VIDEO_MODE_PAL) { /* PAL */
debiwrite(saa, debNormal, XILINX_CTL0, 0x0808, 2);
mdelay(50);
saawrite(0x012002c0, SAA7146_NUM_LINE_BYTE1);
if (NewCard) {
debiwrite(saa, debNormal, IBM_MP2_DISP_MODE, 0xe100, 2);
mdelay(50);
}
debiwrite(saa, debNormal, IBM_MP2_DISP_MODE,
NewCard ? 0xe500 : 0x6500, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_DLY,
(1 << 8) |
(NewCard ? PALFirstActive : PALFirstActive - 6), 2);
} else { /* NTSC */
debiwrite(saa, debNormal, XILINX_CTL0, 0x0800, 2);
mdelay(50);
saawrite(0x00f002c0, SAA7146_NUM_LINE_BYTE1);
debiwrite(saa, debNormal, IBM_MP2_DISP_MODE,
NewCard ? 0xe100 : 0x6100, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_DLY,
(1 << 8) |
(NewCard ? NTSCFirstActive : NTSCFirstActive - 6), 2);
}
}
/* Intialize bitmangler to map from a byte value to the mangled word that
* must be output to program the Xilinx part through the DEBI port.
* Xilinx Data Bit->DEBI Bit: 0->15 1->7 2->6 3->12 4->11 5->2 6->1 7->0
* transfer FPGA code, init IBM chip, transfer IBM microcode
* rev2 card mangles: 0->7 1->6 2->5 3->4 4->3 5->2 6->1 7->0
*/
static u16 bitmangler[256];
static int initialize_fpga(struct video_code *bitdata)
{
int i, num, startindex, failure = 0, loadtwo, loadfile = 0;
u16 *dmabuf;
u8 *newdma;
struct saa7146 *saa;
/* verify fpga code */
for (startindex = 0; startindex < bitdata->datasize; startindex++)
if (bitdata->data[startindex] == 255)
break;
if (startindex == bitdata->datasize) {
printk(KERN_INFO "stradis: bad fpga code\n");
return -1;
}
/* initialize all detected cards */
for (num = 0; num < saa_num; num++) {
saa = &saa7146s[num];
if (saa->boardcfg[0] > 20)
continue; /* card was programmed */
loadtwo = (saa->boardcfg[18] & 0x10);
if (!NewCard) /* we have an old board */
for (i = 0; i < 256; i++)
bitmangler[i] = ((i & 0x01) << 15) |
((i & 0x02) << 6) | ((i & 0x04) << 4) |
((i & 0x08) << 9) | ((i & 0x10) << 7) |
((i & 0x20) >> 3) | ((i & 0x40) >> 5) |
((i & 0x80) >> 7);
else /* else we have a new board */
for (i = 0; i < 256; i++)
bitmangler[i] = ((i & 0x01) << 7) |
((i & 0x02) << 5) | ((i & 0x04) << 3) |
((i & 0x08) << 1) | ((i & 0x10) >> 1) |
((i & 0x20) >> 3) | ((i & 0x40) >> 5) |
((i & 0x80) >> 7);
dmabuf = (u16 *) saa->dmadebi;
newdma = (u8 *) saa->dmadebi;
if (NewCard) { /* SDM2xxx */
if (!strncmp(bitdata->loadwhat, "decoder2", 8))
continue; /* fpga not for this card */
if (!strncmp(&saa->boardcfg[42], bitdata->loadwhat, 8))
loadfile = 1;
else if (loadtwo && !strncmp(&saa->boardcfg[19],
bitdata->loadwhat, 8))
loadfile = 2;
else if (!saa->boardcfg[42] && !strncmp("decxl",
bitdata->loadwhat, 8))
loadfile = 1; /* special */
else
continue; /* fpga not for this card */
if (loadfile != 1 && loadfile != 2)
continue; /* skip to next card */
if (saa->boardcfg[0] && loadfile == 1)
continue; /* skip to next card */
if (saa->boardcfg[0] != 1 && loadfile == 2)
continue; /* skip to next card */
saa->boardcfg[0]++; /* mark fpga handled */
printk("stradis%d: loading %s\n", saa->nr,
bitdata->loadwhat);
if (loadtwo && loadfile == 2)
goto send_fpga_stuff;
/* turn on the Audio interface to set PROG low */
saawrite(0x00400040, SAA7146_GPIO_CTRL);
saaread(SAA7146_PSR); /* ensure posted write */
/* wait for everyone to reset */
mdelay(10);
saawrite(0x00400000, SAA7146_GPIO_CTRL);
} else { /* original card */
if (strncmp(bitdata->loadwhat, "decoder2", 8))
continue; /* fpga not for this card */
/* Pull the Xilinx PROG signal WS3 low */
saawrite(0x02000200, SAA7146_MC1);
/* Turn on the Audio interface so can set PROG low */
saawrite(0x000000c0, SAA7146_ACON1);
/* Pull the Xilinx INIT signal (GPIO2) low */
saawrite(0x00400000, SAA7146_GPIO_CTRL);
/* Make sure everybody resets */
saaread(SAA7146_PSR); /* ensure posted write */
mdelay(10);
/* Release the Xilinx PROG signal */
saawrite(0x00000000, SAA7146_ACON1);
/* Turn off the Audio interface */
saawrite(0x02000000, SAA7146_MC1);
}
/* Release Xilinx INIT signal (WS2) */
saawrite(0x00000000, SAA7146_GPIO_CTRL);
/* Wait for the INIT to go High */
for (i = 0;
i < 10000 && !(saaread(SAA7146_PSR) & SAA7146_PSR_PIN2);
i++)
schedule();
if (i == 1000) {
printk(KERN_INFO "stradis%d: no fpga INIT\n", saa->nr);
return -1;
}
send_fpga_stuff:
if (NewCard) {
for (i = startindex; i < bitdata->datasize; i++)
newdma[i - startindex] =
bitmangler[bitdata->data[i]];
debiwrite(saa, 0x01420000, 0, 0,
((bitdata->datasize - startindex) + 5));
if (loadtwo && loadfile == 1) {
printk("stradis%d: awaiting 2nd FPGA bitfile\n",
saa->nr);
continue; /* skip to next card */
}
} else {
for (i = startindex; i < bitdata->datasize; i++)
dmabuf[i - startindex] =
bitmangler[bitdata->data[i]];
debiwrite(saa, 0x014a0000, 0, 0,
((bitdata->datasize - startindex) + 5) * 2);
}
for (i = 0;
i < 1000 && !(saaread(SAA7146_PSR) & SAA7146_PSR_PIN2);
i++)
schedule();
if (i == 1000) {
printk(KERN_INFO "stradis%d: FPGA load failed\n",
saa->nr);
failure++;
continue;
}
if (!NewCard) {
/* Pull the Xilinx INIT signal (GPIO2) low */
saawrite(0x00400000, SAA7146_GPIO_CTRL);
saaread(SAA7146_PSR); /* ensure posted write */
mdelay(2);
saawrite(0x00000000, SAA7146_GPIO_CTRL);
mdelay(2);
}
printk(KERN_INFO "stradis%d: FPGA Loaded\n", saa->nr);
saa->boardcfg[0] = 26; /* mark fpga programmed */
/* set VXCO to its lowest frequency */
debiwrite(saa, debNormal, XILINX_PWM, 0, 2);
if (NewCard) {
/* mute CS3310 */
if (HaveCS3310)
debiwrite(saa, debNormal, XILINX_CS3310_CMPLT,
0, 2);
/* set VXCO to PWM mode, release reset, blank on */
debiwrite(saa, debNormal, XILINX_CTL0, 0xffc4, 2);
mdelay(10);
/* unmute CS3310 */
if (HaveCS3310)
debiwrite(saa, debNormal, XILINX_CTL0,
0x2020, 2);
}
/* set source Black */
debiwrite(saa, debNormal, XILINX_CTL0, 0x1707, 2);
saa->boardcfg[4] = 22; /* set NTSC First Active Line */
saa->boardcfg[5] = 23; /* set PAL First Active Line */
saa->boardcfg[54] = 2; /* set NTSC Last Active Line - 256 */
saa->boardcfg[55] = 54; /* set PAL Last Active Line - 256 */
set_out_format(saa, VIDEO_MODE_NTSC);
mdelay(50);
/* begin IBM chip init */
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, 4, 2);
saaread(SAA7146_PSR); /* wait for reset */
mdelay(5);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, 0, 2);
debiread(saa, debNormal, IBM_MP2_CHIP_CONTROL, 2);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, 0x10, 2);
debiwrite(saa, debNormal, IBM_MP2_CMD_ADDR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_CHIP_MODE, 0x2e, 2);
if (NewCard) {
mdelay(5);
/* set i2s rate converter to 48KHz */
debiwrite(saa, debNormal, 0x80c0, 6, 2);
/* we must init CS8420 first since rev b pulls i2s */
/* master clock low and CS4341 needs i2s master to */
/* run the i2c port. */
if (HaveCS8420)
/* 0=consumer, 1=pro */
initialize_cs8420(saa, 0);
mdelay(5);
if (HaveCS4341)
initialize_cs4341(saa);
}
debiwrite(saa, debNormal, IBM_MP2_INFC_CTL, 0x48, 2);
debiwrite(saa, debNormal, IBM_MP2_BEEP_CTL, 0xa000, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_LBOR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_TBOR, 0, 2);
if (NewCard)
set_genlock_offset(saa, 0);
debiwrite(saa, debNormal, IBM_MP2_FRNT_ATTEN, 0, 2);
#if 0
/* enable genlock */
debiwrite(saa, debNormal, XILINX_CTL0, 0x8000, 2);
#else
/* disable genlock */
debiwrite(saa, debNormal, XILINX_CTL0, 0x8080, 2);
#endif
}
return failure;
}
static int do_ibm_reset(struct saa7146 *saa)
{
/* failure if decoder not previously programmed */
if (saa->boardcfg[0] < 37)
return -EIO;
/* mute CS3310 */
if (HaveCS3310)
debiwrite(saa, debNormal, XILINX_CS3310_CMPLT, 0, 2);
/* disable interrupts */
saawrite(0, SAA7146_IER);
saa->audhead = saa->audtail = 0;
saa->vidhead = saa->vidtail = 0;
/* tristate debi bus, disable debi transfers */
saawrite(0x00880000, SAA7146_MC1);
/* ensure posted write */
saaread(SAA7146_MC1);
mdelay(50);
/* re-enable debi transfers */
saawrite(0x00880088, SAA7146_MC1);
/* set source Black */
debiwrite(saa, debNormal, XILINX_CTL0, 0x1707, 2);
/* begin IBM chip init */
set_out_format(saa, CurrentMode);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, 4, 2);
saaread(SAA7146_PSR); /* wait for reset */
mdelay(5);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, 0, 2);
debiread(saa, debNormal, IBM_MP2_CHIP_CONTROL, 2);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, ChipControl, 2);
debiwrite(saa, debNormal, IBM_MP2_CHIP_MODE, 0x2e, 2);
if (NewCard) {
mdelay(5);
/* set i2s rate converter to 48KHz */
debiwrite(saa, debNormal, 0x80c0, 6, 2);
/* we must init CS8420 first since rev b pulls i2s */
/* master clock low and CS4341 needs i2s master to */
/* run the i2c port. */
if (HaveCS8420)
/* 0=consumer, 1=pro */
initialize_cs8420(saa, 1);
mdelay(5);
if (HaveCS4341)
initialize_cs4341(saa);
}
debiwrite(saa, debNormal, IBM_MP2_INFC_CTL, 0x48, 2);
debiwrite(saa, debNormal, IBM_MP2_BEEP_CTL, 0xa000, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_LBOR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_TBOR, 0, 2);
if (NewCard)
set_genlock_offset(saa, 0);
debiwrite(saa, debNormal, IBM_MP2_FRNT_ATTEN, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_OSD_SIZE, 0x2000, 2);
debiwrite(saa, debNormal, IBM_MP2_AUD_CTL, 0x4552, 2);
if (ibm_send_command(saa, IBM_MP2_CONFIG_DECODER,
(ChipControl == 0x43 ? 0xe800 : 0xe000), 1)) {
printk(KERN_ERR "stradis%d: IBM config failed\n", saa->nr);
}
if (HaveCS3310) {
int i = CS3310MaxLvl;
debiwrite(saa, debNormal, XILINX_CS3310_CMPLT, ((i << 8)| i),2);
}
/* start video decoder */
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL, ChipControl, 2);
/* 256k vid, 3520 bytes aud */
debiwrite(saa, debNormal, IBM_MP2_RB_THRESHOLD, 0x4037, 2);
debiwrite(saa, debNormal, IBM_MP2_AUD_CTL, 0x4573, 2);
ibm_send_command(saa, IBM_MP2_PLAY, 0, 0);
/* enable buffer threshold irq */
debiwrite(saa, debNormal, IBM_MP2_MASK0, 0xc00c, 2);
/* clear pending interrupts */
debiread(saa, debNormal, IBM_MP2_HOST_INT, 2);
debiwrite(saa, debNormal, XILINX_CTL0, 0x1711, 2);
return 0;
}
/* load the decoder microcode */
static int initialize_ibmmpeg2(struct video_code *microcode)
{
int i, num;
struct saa7146 *saa;
for (num = 0; num < saa_num; num++) {
saa = &saa7146s[num];
/* check that FPGA is loaded */
debiwrite(saa, debNormal, IBM_MP2_OSD_SIZE, 0xa55a, 2);
i = debiread(saa, debNormal, IBM_MP2_OSD_SIZE, 2);
if (i != 0xa55a) {
printk(KERN_INFO "stradis%d: %04x != 0xa55a\n",
saa->nr, i);
#if 0
return -1;
#endif
}
if (!strncmp(microcode->loadwhat, "decoder.vid", 11)) {
if (saa->boardcfg[0] > 27)
continue; /* skip to next card */
/* load video control store */
saa->boardcfg[1] = 0x13; /* no-sync default */
debiwrite(saa, debNormal, IBM_MP2_WR_PROT, 1, 2);
debiwrite(saa, debNormal, IBM_MP2_PROC_IADDR, 0, 2);
for (i = 0; i < microcode->datasize / 2; i++)
debiwrite(saa, debNormal, IBM_MP2_PROC_IDATA,
(microcode->data[i * 2] << 8) |
microcode->data[i * 2 + 1], 2);
debiwrite(saa, debNormal, IBM_MP2_PROC_IADDR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_WR_PROT, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL,
ChipControl, 2);
saa->boardcfg[0] = 28;
}
if (!strncmp(microcode->loadwhat, "decoder.aud", 11)) {
if (saa->boardcfg[0] > 35)
continue; /* skip to next card */
/* load audio control store */
debiwrite(saa, debNormal, IBM_MP2_WR_PROT, 1, 2);
debiwrite(saa, debNormal, IBM_MP2_AUD_IADDR, 0, 2);
for (i = 0; i < microcode->datasize; i++)
debiwrite(saa, debNormal, IBM_MP2_AUD_IDATA,
microcode->data[i], 1);
debiwrite(saa, debNormal, IBM_MP2_AUD_IADDR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_WR_PROT, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_OSD_SIZE, 0x2000, 2);
debiwrite(saa, debNormal, IBM_MP2_AUD_CTL, 0x4552, 2);
if (ibm_send_command(saa, IBM_MP2_CONFIG_DECODER,
0xe000, 1)) {
printk(KERN_ERR "stradis%d: IBM config "
"failed\n", saa->nr);
return -1;
}
/* set PWM to center value */
if (NewCard) {
debiwrite(saa, debNormal, XILINX_PWM,
saa->boardcfg[14] +
(saa->boardcfg[13] << 8), 2);
} else
debiwrite(saa, debNormal, XILINX_PWM, 0x46, 2);
if (HaveCS3310) {
i = CS3310MaxLvl;
debiwrite(saa, debNormal, XILINX_CS3310_CMPLT,
(i << 8) | i, 2);
}
printk(KERN_INFO "stradis%d: IBM MPEGCD%d Inited\n",
saa->nr, 18 + (debiread(saa, debNormal,
IBM_MP2_CHIP_CONTROL, 2) >> 12));
/* start video decoder */
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL,
ChipControl, 2);
debiwrite(saa, debNormal, IBM_MP2_RB_THRESHOLD, 0x4037,
2); /* 256k vid, 3520 bytes aud */
debiwrite(saa, debNormal, IBM_MP2_AUD_CTL, 0x4573, 2);
ibm_send_command(saa, IBM_MP2_PLAY, 0, 0);
/* enable buffer threshold irq */
debiwrite(saa, debNormal, IBM_MP2_MASK0, 0xc00c, 2);
debiread(saa, debNormal, IBM_MP2_HOST_INT, 2);
/* enable gpio irq */
saawrite(0x00002000, SAA7146_GPIO_CTRL);
/* enable decoder output to HPS */
debiwrite(saa, debNormal, XILINX_CTL0, 0x1711, 2);
saa->boardcfg[0] = 37;
}
}
return 0;
}
static u32 palette2fmt[] = { /* some of these YUV translations are wrong */
0xffffffff, 0x86000000, 0x87000000, 0x80000000, 0x8100000, 0x82000000,
0x83000000, 0x00000000, 0x03000000, 0x03000000, 0x0a00000, 0x03000000,
0x06000000, 0x00000000, 0x03000000, 0x0a000000, 0x0300000
};
static int bpp2fmt[4] = {
VIDEO_PALETTE_HI240, VIDEO_PALETTE_RGB565, VIDEO_PALETTE_RGB24,
VIDEO_PALETTE_RGB32
};
/* I wish I could find a formula to calculate these... */
static u32 h_prescale[64] = {
0x10000000, 0x18040202, 0x18080000, 0x380c0606, 0x38100204, 0x38140808,
0x38180000, 0x381c0000, 0x3820161c, 0x38242a3b, 0x38281230, 0x382c4460,
0x38301040, 0x38340080, 0x38380000, 0x383c0000, 0x3840fefe, 0x3844ee9f,
0x3848ee9f, 0x384cee9f, 0x3850ee9f, 0x38542a3b, 0x38581230, 0x385c0000,
0x38600000, 0x38640000, 0x38680000, 0x386c0000, 0x38700000, 0x38740000,
0x38780000, 0x387c0000, 0x30800000, 0x38840000, 0x38880000, 0x388c0000,
0x38900000, 0x38940000, 0x38980000, 0x389c0000, 0x38a00000, 0x38a40000,
0x38a80000, 0x38ac0000, 0x38b00000, 0x38b40000, 0x38b80000, 0x38bc0000,
0x38c00000, 0x38c40000, 0x38c80000, 0x38cc0000, 0x38d00000, 0x38d40000,
0x38d80000, 0x38dc0000, 0x38e00000, 0x38e40000, 0x38e80000, 0x38ec0000,
0x38f00000, 0x38f40000, 0x38f80000, 0x38fc0000,
};
static u32 v_gain[64] = {
0x016000ff, 0x016100ff, 0x016100ff, 0x016200ff, 0x016200ff, 0x016200ff,
0x016200ff, 0x016300ff, 0x016300ff, 0x016300ff, 0x016300ff, 0x016300ff,
0x016300ff, 0x016300ff, 0x016300ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
0x016400ff, 0x016400ff, 0x016400ff, 0x016400ff,
};
static void saa7146_set_winsize(struct saa7146 *saa)
{
u32 format;
int offset, yacl, ysci;
saa->win.color_fmt = format =
(saa->win.depth == 15) ? palette2fmt[VIDEO_PALETTE_RGB555] :
palette2fmt[bpp2fmt[(saa->win.bpp - 1) & 3]];
offset = saa->win.x * saa->win.bpp + saa->win.y * saa->win.bpl;
saawrite(saa->win.vidadr + offset, SAA7146_BASE_EVEN1);
saawrite(saa->win.vidadr + offset + saa->win.bpl, SAA7146_BASE_ODD1);
saawrite(saa->win.bpl * 2, SAA7146_PITCH1);
saawrite(saa->win.vidadr + saa->win.bpl * saa->win.sheight,
SAA7146_PROT_ADDR1);
saawrite(0, SAA7146_PAGE1);
saawrite(format | 0x60, SAA7146_CLIP_FORMAT_CTRL);
offset = (704 / (saa->win.width - 1)) & 0x3f;
saawrite(h_prescale[offset], SAA7146_HPS_H_PRESCALE);
offset = (720896 / saa->win.width) / (offset + 1);
saawrite((offset << 12) | 0x0c, SAA7146_HPS_H_SCALE);
if (CurrentMode == VIDEO_MODE_NTSC) {
yacl = /*(480 / saa->win.height - 1) & 0x3f */ 0;
ysci = 1024 - (saa->win.height * 1024 / 480);
} else {
yacl = /*(576 / saa->win.height - 1) & 0x3f */ 0;
ysci = 1024 - (saa->win.height * 1024 / 576);
}
saawrite((1 << 31) | (ysci << 21) | (yacl << 15), SAA7146_HPS_V_SCALE);
saawrite(v_gain[yacl], SAA7146_HPS_V_GAIN);
saawrite(((SAA7146_MC2_UPLD_DMA1 | SAA7146_MC2_UPLD_HPS_V |
SAA7146_MC2_UPLD_HPS_H) << 16) | (SAA7146_MC2_UPLD_DMA1 |
SAA7146_MC2_UPLD_HPS_V | SAA7146_MC2_UPLD_HPS_H), SAA7146_MC2);
}
/* clip_draw_rectangle(cm,x,y,w,h) -- handle clipping an area
* bitmap is fixed width, 128 bytes (1024 pixels represented)
* arranged most-sigificant-bit-left in 32-bit words
* based on saa7146 clipping hardware, it swaps bytes if LE
* much of this makes up for egcs brain damage -- so if you
* are wondering "why did he do this?" it is because the C
* was adjusted to generate the optimal asm output without
* writing non-portable __asm__ directives.
*/
static void clip_draw_rectangle(u32 *clipmap, int x, int y, int w, int h)
{
register int startword, endword;
register u32 bitsleft, bitsright;
u32 *temp;
if (x < 0) {
w += x;
x = 0;
}
if (y < 0) {
h += y;
y = 0;
}
if (w <= 0 || h <= 0 || x > 1023 || y > 639)
return; /* throw away bad clips */
if (x + w > 1024)
w = 1024 - x;
if (y + h > 640)
h = 640 - y;
startword = (x >> 5);
endword = ((x + w) >> 5);
bitsleft = (0xffffffff >> (x & 31));
bitsright = (0xffffffff << (~((x + w) - (endword << 5))));
temp = &clipmap[(y << 5) + startword];
w = endword - startword;
if (!w) {
bitsleft |= bitsright;
for (y = 0; y < h; y++) {
*temp |= bitsleft;
temp += 32;
}
} else {
for (y = 0; y < h; y++) {
*temp++ |= bitsleft;
for (x = 1; x < w; x++)
*temp++ = 0xffffffff;
*temp |= bitsright;
temp += (32 - w);
}
}
}
static void make_clip_tab(struct saa7146 *saa, struct video_clip *cr, int ncr)
{
int i, width, height;
u32 *clipmap;
clipmap = saa->dmavid2;
if ((width = saa->win.width) > 1023)
width = 1023; /* sanity check */
if ((height = saa->win.height) > 640)
height = 639; /* sanity check */
if (ncr > 0) { /* rectangles pased */
/* convert rectangular clips to a bitmap */
memset(clipmap, 0, VIDEO_CLIPMAP_SIZE); /* clear map */
for (i = 0; i < ncr; i++)
clip_draw_rectangle(clipmap, cr[i].x, cr[i].y,
cr[i].width, cr[i].height);
}
/* clip against viewing window AND screen
so we do not have to rely on the user program
*/
clip_draw_rectangle(clipmap, (saa->win.x + width > saa->win.swidth) ?
(saa->win.swidth - saa->win.x) : width, 0, 1024, 768);
clip_draw_rectangle(clipmap, 0,
(saa->win.y + height > saa->win.sheight) ?
(saa->win.sheight - saa->win.y) : height, 1024, 768);
if (saa->win.x < 0)
clip_draw_rectangle(clipmap, 0, 0, -saa->win.x, 768);
if (saa->win.y < 0)
clip_draw_rectangle(clipmap, 0, 0, 1024, -saa->win.y);
}
static long saa_ioctl(struct file *file,
unsigned int cmd, unsigned long argl)
{
struct saa7146 *saa = file->private_data;
void __user *arg = (void __user *)argl;
switch (cmd) {
case VIDIOCGCAP:
{
struct video_capability b;
memset(&b, 0, sizeof(b));
strcpy(b.name, saa->video_dev.name);
b.type = VID_TYPE_CAPTURE | VID_TYPE_OVERLAY |
VID_TYPE_CLIPPING | VID_TYPE_FRAMERAM |
VID_TYPE_SCALES;
b.channels = 1;
b.audios = 1;
b.maxwidth = 768;
b.maxheight = 576;
b.minwidth = 32;
b.minheight = 32;
if (copy_to_user(arg, &b, sizeof(b)))
return -EFAULT;
return 0;
}
case VIDIOCGPICT:
{
struct video_picture p = saa->picture;
if (saa->win.depth == 8)
p.palette = VIDEO_PALETTE_HI240;
if (saa->win.depth == 15)
p.palette = VIDEO_PALETTE_RGB555;
if (saa->win.depth == 16)
p.palette = VIDEO_PALETTE_RGB565;
if (saa->win.depth == 24)
p.palette = VIDEO_PALETTE_RGB24;
if (saa->win.depth == 32)
p.palette = VIDEO_PALETTE_RGB32;
if (copy_to_user(arg, &p, sizeof(p)))
return -EFAULT;
return 0;
}
case VIDIOCSPICT:
{
struct video_picture p;
u32 format;
if (copy_from_user(&p, arg, sizeof(p)))
return -EFAULT;
if (p.palette < ARRAY_SIZE(palette2fmt)) {
format = palette2fmt[p.palette];
saa->win.color_fmt = format;
saawrite(format | 0x60,
SAA7146_CLIP_FORMAT_CTRL);
}
saawrite(((p.brightness & 0xff00) << 16) |
((p.contrast & 0xfe00) << 7) |
((p.colour & 0xfe00) >> 9), SAA7146_BCS_CTRL);
saa->picture = p;
/* upload changed registers */
saawrite(((SAA7146_MC2_UPLD_HPS_H |
SAA7146_MC2_UPLD_HPS_V) << 16) |
SAA7146_MC2_UPLD_HPS_H |
SAA7146_MC2_UPLD_HPS_V, SAA7146_MC2);
return 0;
}
case VIDIOCSWIN:
{
struct video_window vw;
struct video_clip *vcp = NULL;
if (copy_from_user(&vw, arg, sizeof(vw)))
return -EFAULT;
/* stop capture */
if (vw.flags || vw.width < 16 || vw.height < 16) {
saawrite((SAA7146_MC1_TR_E_1 << 16),
SAA7146_MC1);
return -EINVAL;
}
/* 32-bit align start and adjust width */
if (saa->win.bpp < 4) {
int i = vw.x;
vw.x = (vw.x + 3) & ~3;
i = vw.x - i;
vw.width -= i;
}
saa->win.x = vw.x;
saa->win.y = vw.y;
saa->win.width = vw.width;
if (saa->win.width > 768)
saa->win.width = 768;
saa->win.height = vw.height;
if (CurrentMode == VIDEO_MODE_NTSC) {
if (saa->win.height > 480)
saa->win.height = 480;
} else {
if (saa->win.height > 576)
saa->win.height = 576;
}
/* stop capture */
saawrite((SAA7146_MC1_TR_E_1 << 16), SAA7146_MC1);
saa7146_set_winsize(saa);
/*
* Do any clips.
*/
if (vw.clipcount < 0) {
if (copy_from_user(saa->dmavid2, vw.clips,
VIDEO_CLIPMAP_SIZE))
return -EFAULT;
} else if (vw.clipcount > 16384) {
return -EINVAL;
} else if (vw.clipcount > 0) {
vcp = vmalloc(sizeof(struct video_clip) *
vw.clipcount);
if (vcp == NULL)
return -ENOMEM;
if (copy_from_user(vcp, vw.clips,
sizeof(struct video_clip) *
vw.clipcount)) {
vfree(vcp);
return -EFAULT;
}
} else /* nothing clipped */
memset(saa->dmavid2, 0, VIDEO_CLIPMAP_SIZE);
make_clip_tab(saa, vcp, vw.clipcount);
if (vw.clipcount > 0)
vfree(vcp);
/* start capture & clip dma if we have an address */
if ((saa->cap & 3) && saa->win.vidadr != 0)
saawrite(((SAA7146_MC1_TR_E_1 |
SAA7146_MC1_TR_E_2) << 16) | 0xffff,
SAA7146_MC1);
return 0;
}
case VIDIOCGWIN:
{
struct video_window vw;
memset(&vw, 0, sizeof(vw));
vw.x = saa->win.x;
vw.y = saa->win.y;
vw.width = saa->win.width;
vw.height = saa->win.height;
vw.chromakey = 0;
vw.flags = 0;
if (copy_to_user(arg, &vw, sizeof(vw)))
return -EFAULT;
return 0;
}
case VIDIOCCAPTURE:
{
int v;
if (copy_from_user(&v, arg, sizeof(v)))
return -EFAULT;
if (v == 0) {
saa->cap &= ~1;
saawrite((SAA7146_MC1_TR_E_1 << 16),
SAA7146_MC1);
} else {
if (saa->win.vidadr == 0 || saa->win.width == 0
|| saa->win.height == 0)
return -EINVAL;
saa->cap |= 1;
saawrite((SAA7146_MC1_TR_E_1 << 16) | 0xffff,
SAA7146_MC1);
}
return 0;
}
case VIDIOCGFBUF:
{
struct video_buffer v;
memset(&v, 0, sizeof(v));
v.base = (void *)saa->win.vidadr;
v.height = saa->win.sheight;
v.width = saa->win.swidth;
v.depth = saa->win.depth;
v.bytesperline = saa->win.bpl;
if (copy_to_user(arg, &v, sizeof(v)))
return -EFAULT;
return 0;
}
case VIDIOCSFBUF:
{
struct video_buffer v;
if (!capable(CAP_SYS_ADMIN))
return -EPERM;
if (copy_from_user(&v, arg, sizeof(v)))
return -EFAULT;
if (v.depth != 8 && v.depth != 15 && v.depth != 16 &&
v.depth != 24 && v.depth != 32 && v.width > 16 &&
v.height > 16 && v.bytesperline > 16)
return -EINVAL;
if (v.base)
saa->win.vidadr = (unsigned long)v.base;
saa->win.sheight = v.height;
saa->win.swidth = v.width;
saa->win.bpp = ((v.depth + 7) & 0x38) / 8;
saa->win.depth = v.depth;
saa->win.bpl = v.bytesperline;
DEBUG(printk("Display at %p is %d by %d, bytedepth %d, "
"bpl %d\n", v.base, v.width, v.height,
saa->win.bpp, saa->win.bpl));
saa7146_set_winsize(saa);
return 0;
}
case VIDIOCKEY:
{
/* Will be handled higher up .. */
return 0;
}
case VIDIOCGAUDIO:
{
struct video_audio v;
memset(&v, 0, sizeof(v));
v = saa->audio_dev;
v.flags &= ~(VIDEO_AUDIO_MUTE | VIDEO_AUDIO_MUTABLE);
v.flags |= VIDEO_AUDIO_MUTABLE | VIDEO_AUDIO_VOLUME;
strcpy(v.name, "MPEG");
v.mode = VIDEO_SOUND_STEREO;
if (copy_to_user(arg, &v, sizeof(v)))
return -EFAULT;
return 0;
}
case VIDIOCSAUDIO:
{
struct video_audio v;
int i;
if (copy_from_user(&v, arg, sizeof(v)))
return -EFAULT;
i = (~(v.volume >> 8)) & 0xff;
if (!HaveCS4341) {
if (v.flags & VIDEO_AUDIO_MUTE)
debiwrite(saa, debNormal,
IBM_MP2_FRNT_ATTEN, 0xffff, 2);
if (!(v.flags & VIDEO_AUDIO_MUTE))
debiwrite(saa, debNormal,
IBM_MP2_FRNT_ATTEN, 0x0000, 2);
if (v.flags & VIDEO_AUDIO_VOLUME)
debiwrite(saa, debNormal,
IBM_MP2_FRNT_ATTEN,
(i << 8) | i, 2);
} else {
if (v.flags & VIDEO_AUDIO_MUTE)
cs4341_setlevel(saa, 0xff, 0xff);
if (!(v.flags & VIDEO_AUDIO_MUTE))
cs4341_setlevel(saa, 0, 0);
if (v.flags & VIDEO_AUDIO_VOLUME)
cs4341_setlevel(saa, i, i);
}
saa->audio_dev = v;
return 0;
}
case VIDIOCGUNIT:
{
struct video_unit vu;
memset(&vu, 0, sizeof(vu));
vu.video = saa->video_dev.minor;
vu.vbi = VIDEO_NO_UNIT;
vu.radio = VIDEO_NO_UNIT;
vu.audio = VIDEO_NO_UNIT;
vu.teletext = VIDEO_NO_UNIT;
if (copy_to_user(arg, &vu, sizeof(vu)))
return -EFAULT;
return 0;
}
case VIDIOCSPLAYMODE:
{
struct video_play_mode pmode;
if (copy_from_user((void *)&pmode, arg,
sizeof(struct video_play_mode)))
return -EFAULT;
switch (pmode.mode) {
case VID_PLAY_VID_OUT_MODE:
if (pmode.p1 != VIDEO_MODE_NTSC &&
pmode.p1 != VIDEO_MODE_PAL)
return -EINVAL;
set_out_format(saa, pmode.p1);
return 0;
case VID_PLAY_GENLOCK:
debiwrite(saa, debNormal, XILINX_CTL0,
pmode.p1 ? 0x8000 : 0x8080, 2);
if (NewCard)
set_genlock_offset(saa, pmode.p2);
return 0;
case VID_PLAY_NORMAL:
debiwrite(saa, debNormal,
IBM_MP2_CHIP_CONTROL, ChipControl, 2);
ibm_send_command(saa, IBM_MP2_PLAY, 0, 0);
saa->playmode = pmode.mode;
return 0;
case VID_PLAY_PAUSE:
/* IBM removed the PAUSE command */
/* they say use SINGLE_FRAME now */
case VID_PLAY_SINGLE_FRAME:
ibm_send_command(saa, IBM_MP2_SINGLE_FRAME,0,0);
if (saa->playmode == pmode.mode) {
debiwrite(saa, debNormal,
IBM_MP2_CHIP_CONTROL,
ChipControl, 2);
}
saa->playmode = pmode.mode;
return 0;
case VID_PLAY_FAST_FORWARD:
ibm_send_command(saa, IBM_MP2_FAST_FORWARD,0,0);
saa->playmode = pmode.mode;
return 0;
case VID_PLAY_SLOW_MOTION:
ibm_send_command(saa, IBM_MP2_SLOW_MOTION,
pmode.p1, 0);
saa->playmode = pmode.mode;
return 0;
case VID_PLAY_IMMEDIATE_NORMAL:
/* ensure transfers resume */
debiwrite(saa, debNormal,
IBM_MP2_CHIP_CONTROL, ChipControl, 2);
ibm_send_command(saa, IBM_MP2_IMED_NORM_PLAY,
0, 0);
saa->playmode = VID_PLAY_NORMAL;
return 0;
case VID_PLAY_SWITCH_CHANNELS:
saa->audhead = saa->audtail = 0;
saa->vidhead = saa->vidtail = 0;
ibm_send_command(saa, IBM_MP2_FREEZE_FRAME,0,1);
ibm_send_command(saa, IBM_MP2_RESET_AUD_RATE,
0, 1);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL,
0, 2);
ibm_send_command(saa, IBM_MP2_CHANNEL_SWITCH,
0, 1);
debiwrite(saa, debNormal, IBM_MP2_CHIP_CONTROL,
ChipControl, 2);
ibm_send_command(saa, IBM_MP2_PLAY, 0, 0);
saa->playmode = VID_PLAY_NORMAL;
return 0;
case VID_PLAY_FREEZE_FRAME:
ibm_send_command(saa, IBM_MP2_FREEZE_FRAME,0,0);
saa->playmode = pmode.mode;
return 0;
case VID_PLAY_STILL_MODE:
ibm_send_command(saa, IBM_MP2_SET_STILL_MODE,
0, 0);
saa->playmode = pmode.mode;
return 0;
case VID_PLAY_MASTER_MODE:
if (pmode.p1 == VID_PLAY_MASTER_NONE)
saa->boardcfg[1] = 0x13;
else if (pmode.p1 == VID_PLAY_MASTER_VIDEO)
saa->boardcfg[1] = 0x23;
else if (pmode.p1 == VID_PLAY_MASTER_AUDIO)
saa->boardcfg[1] = 0x43;
else
return -EINVAL;
debiwrite(saa, debNormal,
IBM_MP2_CHIP_CONTROL, ChipControl, 2);
return 0;
case VID_PLAY_ACTIVE_SCANLINES:
if (CurrentMode == VIDEO_MODE_PAL) {
if (pmode.p1 < 1 || pmode.p2 > 625)
return -EINVAL;
saa->boardcfg[5] = pmode.p1;
saa->boardcfg[55] = (pmode.p1 +
(pmode.p2 / 2) - 1) & 0xff;
} else {
if (pmode.p1 < 4 || pmode.p2 > 525)
return -EINVAL;
saa->boardcfg[4] = pmode.p1;
saa->boardcfg[54] = (pmode.p1 +
(pmode.p2 / 2) - 4) & 0xff;
}
set_out_format(saa, CurrentMode);
case VID_PLAY_RESET:
return do_ibm_reset(saa);
case VID_PLAY_END_MARK:
if (saa->endmarktail < saa->endmarkhead) {
if (saa->endmarkhead -
saa->endmarktail < 2)
return -ENOSPC;
} else if (saa->endmarkhead <=saa->endmarktail){
if (saa->endmarktail - saa->endmarkhead
> (MAX_MARKS - 2))
return -ENOSPC;
} else
return -ENOSPC;
saa->endmark[saa->endmarktail] = saa->audtail;
saa->endmarktail++;
if (saa->endmarktail >= MAX_MARKS)
saa->endmarktail = 0;
}
return -EINVAL;
}
case VIDIOCSWRITEMODE:
{
int mode;
if (copy_from_user((void *)&mode, arg, sizeof(int)))
return -EFAULT;
if (mode == VID_WRITE_MPEG_AUD ||
mode == VID_WRITE_MPEG_VID ||
mode == VID_WRITE_CC ||
mode == VID_WRITE_TTX ||
mode == VID_WRITE_OSD) {
saa->writemode = mode;
return 0;
}
return -EINVAL;
}
case VIDIOCSMICROCODE:
{
struct video_code ucode;
__u8 *udata;
int i;
if (copy_from_user(&ucode, arg, sizeof(ucode)))
return -EFAULT;
if (ucode.datasize > 65536 || ucode.datasize < 1024 ||
strncmp(ucode.loadwhat, "dec", 3))
return -EINVAL;
if ((udata = vmalloc(ucode.datasize)) == NULL)
return -ENOMEM;
if (copy_from_user(udata, ucode.data, ucode.datasize)) {
vfree(udata);
return -EFAULT;
}
ucode.data = udata;
if (!strncmp(ucode.loadwhat, "decoder.aud", 11) ||
!strncmp(ucode.loadwhat, "decoder.vid", 11))
i = initialize_ibmmpeg2(&ucode);
else
i = initialize_fpga(&ucode);
vfree(udata);
if (i)
return -EINVAL;
return 0;
}
case VIDIOCGCHAN: /* this makes xawtv happy */
{
struct video_channel v;
if (copy_from_user(&v, arg, sizeof(v)))
return -EFAULT;
v.flags = VIDEO_VC_AUDIO;
v.tuners = 0;
v.type = VID_TYPE_MPEG_DECODER;
v.norm = CurrentMode;
strcpy(v.name, "MPEG2");
if (copy_to_user(arg, &v, sizeof(v)))
return -EFAULT;
return 0;
}
case VIDIOCSCHAN: /* this makes xawtv happy */
{
struct video_channel v;
if (copy_from_user(&v, arg, sizeof(v)))
return -EFAULT;
/* do nothing */
return 0;
}
default:
return -ENOIOCTLCMD;
}
return 0;
}
static int saa_mmap(struct file *file, struct vm_area_struct *vma)
{
struct saa7146 *saa = file->private_data;
printk(KERN_DEBUG "stradis%d: saa_mmap called\n", saa->nr);
return -EINVAL;
}
static ssize_t saa_read(struct file *file, char __user * buf,
size_t count, loff_t * ppos)
{
return -EINVAL;
}
static ssize_t saa_write(struct file *file, const char __user * buf,
size_t count, loff_t * ppos)
{
struct saa7146 *saa = file->private_data;
unsigned long todo = count;
int blocksize, split;
unsigned long flags;
while (todo > 0) {
if (saa->writemode == VID_WRITE_MPEG_AUD) {
spin_lock_irqsave(&saa->lock, flags);
if (saa->audhead <= saa->audtail)
blocksize = 65536 -
(saa->audtail - saa->audhead);
else
blocksize = saa->audhead - saa->audtail;
spin_unlock_irqrestore(&saa->lock, flags);
if (blocksize < 16384) {
saawrite(SAA7146_PSR_DEBI_S |
SAA7146_PSR_PIN1, SAA7146_IER);
saawrite(SAA7146_PSR_PIN1, SAA7146_PSR);
/* wait for buffer space to open */
interruptible_sleep_on(&saa->audq);
}
spin_lock_irqsave(&saa->lock, flags);
if (saa->audhead <= saa->audtail) {
blocksize = 65536 -
(saa->audtail - saa->audhead);
split = 65536 - saa->audtail;
} else {
blocksize = saa->audhead - saa->audtail;
split = 65536;
}
spin_unlock_irqrestore(&saa->lock, flags);
blocksize--;
if (blocksize > todo)
blocksize = todo;
/* double check that we really have space */
if (!blocksize)
return -ENOSPC;
if (split < blocksize) {
if (copy_from_user(saa->audbuf +
saa->audtail, buf, split))
return -EFAULT;
buf += split;
todo -= split;
blocksize -= split;
saa->audtail = 0;
}
if (copy_from_user(saa->audbuf + saa->audtail, buf,
blocksize))
return -EFAULT;
saa->audtail += blocksize;
todo -= blocksize;
buf += blocksize;
saa->audtail &= 0xffff;
} else if (saa->writemode == VID_WRITE_MPEG_VID) {
spin_lock_irqsave(&saa->lock, flags);
if (saa->vidhead <= saa->vidtail)
blocksize = 524288 -
(saa->vidtail - saa->vidhead);
else
blocksize = saa->vidhead - saa->vidtail;
spin_unlock_irqrestore(&saa->lock, flags);
if (blocksize < 65536) {
saawrite(SAA7146_PSR_DEBI_S |
SAA7146_PSR_PIN1, SAA7146_IER);
saawrite(SAA7146_PSR_PIN1, SAA7146_PSR);
/* wait for buffer space to open */
interruptible_sleep_on(&saa->vidq);
}
spin_lock_irqsave(&saa->lock, flags);
if (saa->vidhead <= saa->vidtail) {
blocksize = 524288 -
(saa->vidtail - saa->vidhead);
split = 524288 - saa->vidtail;
} else {
blocksize = saa->vidhead - saa->vidtail;
split = 524288;
}
spin_unlock_irqrestore(&saa->lock, flags);
blocksize--;
if (blocksize > todo)
blocksize = todo;
/* double check that we really have space */
if (!blocksize)
return -ENOSPC;
if (split < blocksize) {
if (copy_from_user(saa->vidbuf +
saa->vidtail, buf, split))
return -EFAULT;
buf += split;
todo -= split;
blocksize -= split;
saa->vidtail = 0;
}
if (copy_from_user(saa->vidbuf + saa->vidtail, buf,
blocksize))
return -EFAULT;
saa->vidtail += blocksize;
todo -= blocksize;
buf += blocksize;
saa->vidtail &= 0x7ffff;
} else if (saa->writemode == VID_WRITE_OSD) {
if (count > 131072)
return -ENOSPC;
if (copy_from_user(saa->osdbuf, buf, count))
return -EFAULT;
buf += count;
saa->osdhead = 0;
saa->osdtail = count;
debiwrite(saa, debNormal, IBM_MP2_OSD_ADDR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_OSD_LINK_ADDR, 0, 2);
debiwrite(saa, debNormal, IBM_MP2_MASK0, 0xc00d, 2);
debiwrite(saa, debNormal, IBM_MP2_DISP_MODE,
debiread(saa, debNormal,
IBM_MP2_DISP_MODE, 2) | 1, 2);
/* trigger osd data transfer */
saawrite(SAA7146_PSR_DEBI_S |
SAA7146_PSR_PIN1, SAA7146_IER);
saawrite(SAA7146_PSR_PIN1, SAA7146_PSR);
}
}
return count;
}
static int saa_open(struct file *file)
{
struct video_device *vdev = video_devdata(file);
struct saa7146 *saa = container_of(vdev, struct saa7146, video_dev);
lock_kernel();
file->private_data = saa;
saa->user++;
if (saa->user > 1) {
saa->user--;
unlock_kernel();
return 0; /* device open already, don't reset */
}
saa->writemode = VID_WRITE_MPEG_VID; /* default to video */
unlock_kernel();
return 0;
}
static int saa_release(struct file *file)
{
struct saa7146 *saa = file->private_data;
saa->user--;
if (saa->user > 0) /* still someone using device */
return 0;
saawrite(0x007f0000, SAA7146_MC1); /* stop all overlay dma */
return 0;
}
static const struct v4l2_file_operations saa_fops = {
.owner = THIS_MODULE,
.open = saa_open,
.release = saa_release,
.ioctl = saa_ioctl,
.read = saa_read,
.write = saa_write,
.mmap = saa_mmap,
};
/* template for video_device-structure */
static struct video_device saa_template = {
.name = "SAA7146A",
.fops = &saa_fops,
.release = video_device_release_empty,
};
static int __devinit configure_saa7146(struct pci_dev *pdev, int num)
{
int retval;
struct saa7146 *saa = pci_get_drvdata(pdev);
saa->endmarkhead = saa->endmarktail = 0;
saa->win.x = saa->win.y = 0;
saa->win.width = saa->win.cropwidth = 720;
saa->win.height = saa->win.cropheight = 480;
saa->win.cropx = saa->win.cropy = 0;
saa->win.bpp = 2;
saa->win.depth = 16;
saa->win.color_fmt = palette2fmt[VIDEO_PALETTE_RGB565];
saa->win.bpl = 1024 * saa->win.bpp;
saa->win.swidth = 1024;
saa->win.sheight = 768;
saa->picture.brightness = 32768;
saa->picture.contrast = 38768;
saa->picture.colour = 32768;
saa->cap = 0;
saa->nr = num;
saa->playmode = VID_PLAY_NORMAL;
memset(saa->boardcfg, 0, 64); /* clear board config area */
saa->saa7146_mem = NULL;
saa->dmavid1 = saa->dmavid2 = saa->dmavid3 = saa->dmaa1in =
saa->dmaa1out = saa->dmaa2in = saa->dmaa2out =
saa->pagevid1 = saa->pagevid2 = saa->pagevid3 = saa->pagea1in =
saa->pagea1out = saa->pagea2in = saa->pagea2out =
saa->pagedebi = saa->dmaRPS1 = saa->dmaRPS2 = saa->pageRPS1 =
saa->pageRPS2 = NULL;
saa->audbuf = saa->vidbuf = saa->osdbuf = saa->dmadebi = NULL;
saa->audhead = saa->vidtail = 0;
init_waitqueue_head(&saa->i2cq);
init_waitqueue_head(&saa->audq);
init_waitqueue_head(&saa->debiq);
init_waitqueue_head(&saa->vidq);
spin_lock_init(&saa->lock);
retval = pci_enable_device(pdev);
if (retval) {
dev_err(&pdev->dev, "%d: pci_enable_device failed!\n", num);
goto err;
}
saa->id = pdev->device;
saa->irq = pdev->irq;
saa->saa7146_adr = pci_resource_start(pdev, 0);
pci_read_config_byte(pdev, PCI_CLASS_REVISION, &saa->revision);
saa->saa7146_mem = ioremap(saa->saa7146_adr, 0x200);
if (saa->saa7146_mem == NULL) {
dev_err(&pdev->dev, "%d: ioremap failed!\n", num);
retval = -EIO;
goto err;
}
memcpy(&saa->video_dev, &saa_template, sizeof(saa_template));
saawrite(0, SAA7146_IER); /* turn off all interrupts */
retval = request_irq(saa->irq, saa7146_irq, IRQF_SHARED | IRQF_DISABLED,
"stradis", saa);
if (retval == -EINVAL)
dev_err(&pdev->dev, "%d: Bad irq number or handler\n", num);
else if (retval == -EBUSY)
dev_err(&pdev->dev, "%d: IRQ %ld busy, change your PnP config "
"in BIOS\n", num, saa->irq);
if (retval < 0)
goto errio;
pci_set_master(pdev);
retval = video_register_device(&saa->video_dev, VFL_TYPE_GRABBER,
video_nr);
if (retval < 0) {
dev_err(&pdev->dev, "%d: error in registering video device!\n",
num);
goto errirq;
}
return 0;
errirq:
free_irq(saa->irq, saa);
errio:
iounmap(saa->saa7146_mem);
err:
return retval;
}
static int __devinit init_saa7146(struct pci_dev *pdev)
{
struct saa7146 *saa = pci_get_drvdata(pdev);
saa->user = 0;
/* reset the saa7146 */
saawrite(0xffff0000, SAA7146_MC1);
mdelay(5);
/* enable debi and i2c transfers and pins */
saawrite(((SAA7146_MC1_EDP | SAA7146_MC1_EI2C |
SAA7146_MC1_TR_E_DEBI) << 16) | 0xffff, SAA7146_MC1);
/* ensure proper state of chip */
saawrite(0x00000000, SAA7146_PAGE1);
saawrite(0x00f302c0, SAA7146_NUM_LINE_BYTE1);
saawrite(0x00000000, SAA7146_PAGE2);
saawrite(0x01400080, SAA7146_NUM_LINE_BYTE2);
saawrite(0x00000000, SAA7146_DD1_INIT);
saawrite(0x00000000, SAA7146_DD1_STREAM_B);
saawrite(0x00000000, SAA7146_DD1_STREAM_A);
saawrite(0x00000000, SAA7146_BRS_CTRL);
saawrite(0x80400040, SAA7146_BCS_CTRL);
saawrite(0x0000e000 /*| (1<<29) */ , SAA7146_HPS_CTRL);
saawrite(0x00000060, SAA7146_CLIP_FORMAT_CTRL);
saawrite(0x00000000, SAA7146_ACON1);
saawrite(0x00000000, SAA7146_ACON2);
saawrite(0x00000600, SAA7146_I2C_STATUS);
saawrite(((SAA7146_MC2_UPLD_D1_B | SAA7146_MC2_UPLD_D1_A |
SAA7146_MC2_UPLD_BRS | SAA7146_MC2_UPLD_HPS_H |
SAA7146_MC2_UPLD_HPS_V | SAA7146_MC2_UPLD_DMA2 |
SAA7146_MC2_UPLD_DMA1 | SAA7146_MC2_UPLD_I2C) << 16) | 0xffff,
SAA7146_MC2);
/* setup arbitration control registers */
saawrite(0x1412121a, SAA7146_PCI_BT_V1);
/* allocate 32k dma buffer + 4k for page table */
if ((saa->dmadebi = kmalloc(32768 + 4096, GFP_KERNEL)) == NULL) {
dev_err(&pdev->dev, "%d: debi kmalloc failed\n", saa->nr);
goto err;
}
#if 0
saa->pagedebi = saa->dmadebi + 32768; /* top 4k is for mmu */
saawrite(virt_to_bus(saa->pagedebi) /*|0x800 */ , SAA7146_DEBI_PAGE);
for (i = 0; i < 12; i++) /* setup mmu page table */
saa->pagedebi[i] = virt_to_bus((saa->dmadebi + i * 4096));
#endif
saa->audhead = saa->vidhead = saa->osdhead = 0;
saa->audtail = saa->vidtail = saa->osdtail = 0;
if (saa->vidbuf == NULL && (saa->vidbuf = vmalloc(524288)) == NULL) {
dev_err(&pdev->dev, "%d: malloc failed\n", saa->nr);
goto err;
}
if (saa->audbuf == NULL && (saa->audbuf = vmalloc(65536)) == NULL) {
dev_err(&pdev->dev, "%d: malloc failed\n", saa->nr);
goto errfree;
}
if (saa->osdbuf == NULL && (saa->osdbuf = vmalloc(131072)) == NULL) {
dev_err(&pdev->dev, "%d: malloc failed\n", saa->nr);
goto errfree;
}
/* allocate 81920 byte buffer for clipping */
if ((saa->dmavid2 = kzalloc(VIDEO_CLIPMAP_SIZE, GFP_KERNEL)) == NULL) {
dev_err(&pdev->dev, "%d: clip kmalloc failed\n", saa->nr);
goto errfree;
}
/* setup clipping registers */
saawrite(virt_to_bus(saa->dmavid2), SAA7146_BASE_EVEN2);
saawrite(virt_to_bus(saa->dmavid2) + 128, SAA7146_BASE_ODD2);
saawrite(virt_to_bus(saa->dmavid2) + VIDEO_CLIPMAP_SIZE,
SAA7146_PROT_ADDR2);
saawrite(256, SAA7146_PITCH2);
saawrite(4, SAA7146_PAGE2); /* dma direction: read, no byteswap */
saawrite(((SAA7146_MC2_UPLD_DMA2) << 16) | SAA7146_MC2_UPLD_DMA2,
SAA7146_MC2);
I2CBusScan(saa);
return 0;
errfree:
vfree(saa->osdbuf);
vfree(saa->audbuf);
vfree(saa->vidbuf);
saa->audbuf = saa->osdbuf = saa->vidbuf = NULL;
err:
return -ENOMEM;
}
static void stradis_release_saa(struct pci_dev *pdev)
{
u8 command;
struct saa7146 *saa = pci_get_drvdata(pdev);
/* turn off all capturing, DMA and IRQs */
saawrite(0xffff0000, SAA7146_MC1); /* reset chip */
saawrite(0, SAA7146_MC2);
saawrite(0, SAA7146_IER);
saawrite(0xffffffffUL, SAA7146_ISR);
/* disable PCI bus-mastering */
pci_read_config_byte(pdev, PCI_COMMAND, &command);
command &= ~PCI_COMMAND_MASTER;
pci_write_config_byte(pdev, PCI_COMMAND, command);
/* unmap and free memory */
saa->audhead = saa->audtail = saa->osdhead = 0;
saa->vidhead = saa->vidtail = saa->osdtail = 0;
vfree(saa->vidbuf);
vfree(saa->audbuf);
vfree(saa->osdbuf);
kfree(saa->dmavid2);
saa->audbuf = saa->vidbuf = saa->osdbuf = NULL;
saa->dmavid2 = NULL;
kfree(saa->dmadebi);
kfree(saa->dmavid1);
kfree(saa->dmavid3);
kfree(saa->dmaa1in);
kfree(saa->dmaa1out);
kfree(saa->dmaa2in);
kfree(saa->dmaa2out);
kfree(saa->dmaRPS1);
kfree(saa->dmaRPS2);
free_irq(saa->irq, saa);
if (saa->saa7146_mem)
iounmap(saa->saa7146_mem);
if (video_is_registered(&saa->video_dev))
video_unregister_device(&saa->video_dev);
}
static int __devinit stradis_probe(struct pci_dev *pdev,
const struct pci_device_id *ent)
{
int retval = -EINVAL;
if (saa_num >= SAA7146_MAX)
goto err;
if (!pdev->subsystem_vendor)
dev_info(&pdev->dev, "%d: rev1 decoder\n", saa_num);
else
dev_info(&pdev->dev, "%d: SDM2xx found\n", saa_num);
pci_set_drvdata(pdev, &saa7146s[saa_num]);
retval = configure_saa7146(pdev, saa_num);
if (retval) {
dev_err(&pdev->dev, "%d: error in configuring\n", saa_num);
goto err;
}
if (init_saa7146(pdev) < 0) {
dev_err(&pdev->dev, "%d: error in initialization\n", saa_num);
retval = -EIO;
goto errrel;
}
saa_num++;
return 0;
errrel:
stradis_release_saa(pdev);
err:
return retval;
}
static void __devexit stradis_remove(struct pci_dev *pdev)
{
stradis_release_saa(pdev);
}
static struct pci_device_id stradis_pci_tbl[] = {
{ PCI_DEVICE(PCI_VENDOR_ID_PHILIPS, PCI_DEVICE_ID_PHILIPS_SAA7146) },
{ 0 }
};
static struct pci_driver stradis_driver = {
.name = "stradis",
.id_table = stradis_pci_tbl,
.probe = stradis_probe,
.remove = __devexit_p(stradis_remove)
};
static int __init stradis_init(void)
{
int retval;
saa_num = 0;
retval = pci_register_driver(&stradis_driver);
if (retval)
printk(KERN_ERR "stradis: Unable to register pci driver.\n");
return retval;
}
static void __exit stradis_exit(void)
{
pci_unregister_driver(&stradis_driver);
printk(KERN_INFO "stradis: module cleanup complete\n");
}
module_init(stradis_init);
module_exit(stradis_exit);
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7