diff options
-rw-r--r-- | series | 1 | ||||
-rw-r--r-- | staging/staging-remove-go7007-driver.patch | 10924 | ||||
-rw-r--r-- | version | 2 |
3 files changed, 1 insertions, 10926 deletions
@@ -900,7 +900,6 @@ staging/staging-remove-me4000-driver.patch staging/staging-meilhaus-remove-the-drivers.patch staging/staging-rspiusb-remove-the-driver.patch staging/staging-remove-at76_usb-wireless-driver.patch -staging/staging-remove-go7007-driver.patch led_classdev.sysfs-name.patch diff --git a/staging/staging-remove-go7007-driver.patch b/staging/staging-remove-go7007-driver.patch deleted file mode 100644 index 1c96729da15d93..00000000000000 --- a/staging/staging-remove-go7007-driver.patch +++ /dev/null @@ -1,10924 +0,0 @@ -From foo@baz Tue Sep 8 12:23:02 PDT 2009 -Date: Tue, 08 Sep 2009 12:23:02 -0700 -To: Greg KH <greg@kroah.com> -From: Greg Kroah-Hartman <gregkh@suse.de> -Subject: Staging: remove go7007 driver - -No one has stepped up to fix it up, and there is no documentation for -the chipset anywhere in existance. The chip is also no longer being -built by any company. So just put it out of its misery. - -Cc: Ross Cohen <rcohen@snurgle.org> -Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de> ---- - drivers/staging/Kconfig | 2 - drivers/staging/Makefile | 1 - drivers/staging/go7007/Kconfig | 37 - drivers/staging/go7007/Makefile | 27 - drivers/staging/go7007/README | 11 - drivers/staging/go7007/go7007-driver.c | 682 ----------- - drivers/staging/go7007/go7007-fw.c | 1638 --------------------------- - drivers/staging/go7007/go7007-i2c.c | 225 --- - drivers/staging/go7007/go7007-priv.h | 282 ---- - drivers/staging/go7007/go7007-usb.c | 1287 --------------------- - drivers/staging/go7007/go7007-v4l2.c | 1876 -------------------------------- - drivers/staging/go7007/go7007.h | 114 - - drivers/staging/go7007/go7007.txt | 481 -------- - drivers/staging/go7007/s2250-board.c | 622 ---------- - drivers/staging/go7007/s2250-loader.c | 189 --- - drivers/staging/go7007/saa7134-go7007.c | 532 --------- - drivers/staging/go7007/snd-go7007.c | 305 ----- - drivers/staging/go7007/wis-i2c.h | 47 - drivers/staging/go7007/wis-ov7640.c | 107 - - drivers/staging/go7007/wis-saa7113.c | 335 ----- - drivers/staging/go7007/wis-saa7115.c | 468 ------- - drivers/staging/go7007/wis-sony-tuner.c | 719 ------------ - drivers/staging/go7007/wis-tw2804.c | 358 ------ - drivers/staging/go7007/wis-tw9903.c | 339 ----- - drivers/staging/go7007/wis-uda1342.c | 113 - - 25 files changed, 10797 deletions(-) - ---- a/drivers/staging/go7007/go7007-driver.c -+++ /dev/null -@@ -1,682 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/delay.h> --#include <linux/sched.h> --#include <linux/spinlock.h> --#include <linux/unistd.h> --#include <linux/time.h> --#include <linux/mm.h> --#include <linux/vmalloc.h> --#include <linux/device.h> --#include <linux/i2c.h> --#include <linux/firmware.h> --#include <linux/semaphore.h> --#include <linux/uaccess.h> --#include <asm/system.h> --#include <linux/videodev2.h> --#include <media/tuner.h> --#include <media/v4l2-common.h> -- --#include "go7007-priv.h" --#include "wis-i2c.h" -- --/* -- * Wait for an interrupt to be delivered from the GO7007SB and return -- * the associated value and data. -- * -- * Must be called with the hw_lock held. -- */ --int go7007_read_interrupt(struct go7007 *go, u16 *value, u16 *data) --{ -- go->interrupt_available = 0; -- go->hpi_ops->read_interrupt(go); -- if (wait_event_timeout(go->interrupt_waitq, -- go->interrupt_available, 5*HZ) < 0) { -- printk(KERN_ERR "go7007: timeout waiting for read interrupt\n"); -- return -1; -- } -- if (!go->interrupt_available) -- return -1; -- go->interrupt_available = 0; -- *value = go->interrupt_value & 0xfffe; -- *data = go->interrupt_data; -- return 0; --} --EXPORT_SYMBOL(go7007_read_interrupt); -- --/* -- * Read a register/address on the GO7007SB. -- * -- * Must be called with the hw_lock held. -- */ --int go7007_read_addr(struct go7007 *go, u16 addr, u16 *data) --{ -- int count = 100; -- u16 value; -- -- if (go7007_write_interrupt(go, 0x0010, addr) < 0) -- return -EIO; -- while (count-- > 0) { -- if (go7007_read_interrupt(go, &value, data) == 0 && -- value == 0xa000) -- return 0; -- } -- return -EIO; --} --EXPORT_SYMBOL(go7007_read_addr); -- --/* -- * Send the boot firmware to the encoder, which just wakes it up and lets -- * us talk to the GPIO pins and on-board I2C adapter. -- * -- * Must be called with the hw_lock held. -- */ --static int go7007_load_encoder(struct go7007 *go) --{ -- const struct firmware *fw_entry; -- char fw_name[] = "go7007fw.bin"; -- void *bounce; -- int fw_len, rv = 0; -- u16 intr_val, intr_data; -- -- if (request_firmware(&fw_entry, fw_name, go->dev)) { -- printk(KERN_ERR -- "go7007: unable to load firmware from file \"%s\"\n", -- fw_name); -- return -1; -- } -- if (fw_entry->size < 16 || memcmp(fw_entry->data, "WISGO7007FW", 11)) { -- printk(KERN_ERR "go7007: file \"%s\" does not appear to be " -- "go7007 firmware\n", fw_name); -- release_firmware(fw_entry); -- return -1; -- } -- fw_len = fw_entry->size - 16; -- bounce = kmalloc(fw_len, GFP_KERNEL); -- if (bounce == NULL) { -- printk(KERN_ERR "go7007: unable to allocate %d bytes for " -- "firmware transfer\n", fw_len); -- release_firmware(fw_entry); -- return -1; -- } -- memcpy(bounce, fw_entry->data + 16, fw_len); -- release_firmware(fw_entry); -- if (go7007_interface_reset(go) < 0 || -- go7007_send_firmware(go, bounce, fw_len) < 0 || -- go7007_read_interrupt(go, &intr_val, &intr_data) < 0 || -- (intr_val & ~0x1) != 0x5a5a) { -- printk(KERN_ERR "go7007: error transferring firmware\n"); -- rv = -1; -- } -- kfree(bounce); -- return rv; --} -- --/* -- * Boot the encoder and register the I2C adapter if requested. Do the -- * minimum initialization necessary, since the board-specific code may -- * still need to probe the board ID. -- * -- * Must NOT be called with the hw_lock held. -- */ --int go7007_boot_encoder(struct go7007 *go, int init_i2c) --{ -- int ret; -- -- down(&go->hw_lock); -- ret = go7007_load_encoder(go); -- up(&go->hw_lock); -- if (ret < 0) -- return -1; -- if (!init_i2c) -- return 0; -- if (go7007_i2c_init(go) < 0) -- return -1; -- go->i2c_adapter_online = 1; -- return 0; --} --EXPORT_SYMBOL(go7007_boot_encoder); -- --/* -- * Configure any hardware-related registers in the GO7007, such as GPIO -- * pins and bus parameters, which are board-specific. This assumes -- * the boot firmware has already been downloaded. -- * -- * Must be called with the hw_lock held. -- */ --static int go7007_init_encoder(struct go7007 *go) --{ -- if (go->board_info->audio_flags & GO7007_AUDIO_I2S_MASTER) { -- go7007_write_addr(go, 0x1000, 0x0811); -- go7007_write_addr(go, 0x1000, 0x0c11); -- } -- if (go->board_id == GO7007_BOARDID_MATRIX_REV) { -- /* Set GPIO pin 0 to be an output (audio clock control) */ -- go7007_write_addr(go, 0x3c82, 0x0001); -- go7007_write_addr(go, 0x3c80, 0x00fe); -- } -- return 0; --} -- --/* -- * Send the boot firmware to the GO7007 and configure the registers. This -- * is the only way to stop the encoder once it has started streaming video. -- * -- * Must be called with the hw_lock held. -- */ --int go7007_reset_encoder(struct go7007 *go) --{ -- if (go7007_load_encoder(go) < 0) -- return -1; -- return go7007_init_encoder(go); --} -- --/* -- * Attempt to instantiate an I2C client by ID, probably loading a module. -- */ --static int init_i2c_module(struct i2c_adapter *adapter, const char *type, -- int id, int addr) --{ -- struct i2c_board_info info; -- char *modname; -- -- switch (id) { -- case I2C_DRIVERID_WIS_SAA7115: -- modname = "wis-saa7115"; -- break; -- case I2C_DRIVERID_WIS_SAA7113: -- modname = "wis-saa7113"; -- break; -- case I2C_DRIVERID_WIS_UDA1342: -- modname = "wis-uda1342"; -- break; -- case I2C_DRIVERID_WIS_SONY_TUNER: -- modname = "wis-sony-tuner"; -- break; -- case I2C_DRIVERID_WIS_TW9903: -- modname = "wis-tw9903"; -- break; -- case I2C_DRIVERID_WIS_TW2804: -- modname = "wis-tw2804"; -- break; -- case I2C_DRIVERID_WIS_OV7640: -- modname = "wis-ov7640"; -- break; -- case I2C_DRIVERID_S2250: -- modname = "s2250-board"; -- break; -- default: -- modname = NULL; -- break; -- } -- if (modname != NULL) -- request_module(modname); -- -- memset(&info, 0, sizeof(struct i2c_board_info)); -- info.addr = addr; -- strlcpy(info.type, type, I2C_NAME_SIZE); -- if (!i2c_new_device(adapter, &info)) -- return 0; -- if (modname != NULL) -- printk(KERN_INFO -- "go7007: probing for module %s failed\n", modname); -- else -- printk(KERN_INFO -- "go7007: sensor %u seems to be unsupported!\n", id); -- return -1; --} -- --/* -- * Finalize the GO7007 hardware setup, register the on-board I2C adapter -- * (if used on this board), load the I2C client driver for the sensor -- * (SAA7115 or whatever) and other devices, and register the ALSA and V4L2 -- * interfaces. -- * -- * Must NOT be called with the hw_lock held. -- */ --int go7007_register_encoder(struct go7007 *go) --{ -- int i, ret; -- -- printk(KERN_INFO "go7007: registering new %s\n", go->name); -- -- down(&go->hw_lock); -- ret = go7007_init_encoder(go); -- up(&go->hw_lock); -- if (ret < 0) -- return -1; -- -- if (!go->i2c_adapter_online && -- go->board_info->flags & GO7007_BOARD_USE_ONBOARD_I2C) { -- if (go7007_i2c_init(go) < 0) -- return -1; -- go->i2c_adapter_online = 1; -- } -- if (go->i2c_adapter_online) { -- for (i = 0; i < go->board_info->num_i2c_devs; ++i) -- init_i2c_module(&go->i2c_adapter, -- go->board_info->i2c_devs[i].type, -- go->board_info->i2c_devs[i].id, -- go->board_info->i2c_devs[i].addr); -- if (go->board_id == GO7007_BOARDID_ADLINK_MPG24) -- i2c_clients_command(&go->i2c_adapter, -- DECODER_SET_CHANNEL, &go->channel_number); -- } -- if (go->board_info->flags & GO7007_BOARD_HAS_AUDIO) { -- go->audio_enabled = 1; -- go7007_snd_init(go); -- } -- return go7007_v4l2_init(go); --} --EXPORT_SYMBOL(go7007_register_encoder); -- --/* -- * Send the encode firmware to the encoder, which will cause it -- * to immediately start delivering the video and audio streams. -- * -- * Must be called with the hw_lock held. -- */ --int go7007_start_encoder(struct go7007 *go) --{ -- u8 *fw; -- int fw_len, rv = 0, i; -- u16 intr_val, intr_data; -- -- go->modet_enable = 0; -- if (!go->dvd_mode) -- for (i = 0; i < 4; ++i) { -- if (go->modet[i].enable) { -- go->modet_enable = 1; -- continue; -- } -- go->modet[i].pixel_threshold = 32767; -- go->modet[i].motion_threshold = 32767; -- go->modet[i].mb_threshold = 32767; -- } -- -- if (go7007_construct_fw_image(go, &fw, &fw_len) < 0) -- return -1; -- -- if (go7007_send_firmware(go, fw, fw_len) < 0 || -- go7007_read_interrupt(go, &intr_val, &intr_data) < 0) { -- printk(KERN_ERR "go7007: error transferring firmware\n"); -- rv = -1; -- goto start_error; -- } -- -- go->state = STATE_DATA; -- go->parse_length = 0; -- go->seen_frame = 0; -- if (go7007_stream_start(go) < 0) { -- printk(KERN_ERR "go7007: error starting stream transfer\n"); -- rv = -1; -- goto start_error; -- } -- --start_error: -- kfree(fw); -- return rv; --} -- --/* -- * Store a byte in the current video buffer, if there is one. -- */ --static inline void store_byte(struct go7007_buffer *gobuf, u8 byte) --{ -- if (gobuf != NULL && gobuf->bytesused < GO7007_BUF_SIZE) { -- unsigned int pgidx = gobuf->offset >> PAGE_SHIFT; -- unsigned int pgoff = gobuf->offset & ~PAGE_MASK; -- -- *((u8 *)page_address(gobuf->pages[pgidx]) + pgoff) = byte; -- ++gobuf->offset; -- ++gobuf->bytesused; -- } --} -- --/* -- * Deliver the last video buffer and get a new one to start writing to. -- */ --static void frame_boundary(struct go7007 *go) --{ -- struct go7007_buffer *gobuf; -- int i; -- -- if (go->active_buf) { -- if (go->active_buf->modet_active) { -- if (go->active_buf->bytesused + 216 < GO7007_BUF_SIZE) { -- for (i = 0; i < 216; ++i) -- store_byte(go->active_buf, -- go->active_map[i]); -- go->active_buf->bytesused -= 216; -- } else -- go->active_buf->modet_active = 0; -- } -- go->active_buf->state = BUF_STATE_DONE; -- wake_up_interruptible(&go->frame_waitq); -- go->active_buf = NULL; -- } -- list_for_each_entry(gobuf, &go->stream, stream) -- if (gobuf->state == BUF_STATE_QUEUED) { -- gobuf->seq = go->next_seq; -- do_gettimeofday(&gobuf->timestamp); -- go->active_buf = gobuf; -- break; -- } -- ++go->next_seq; --} -- --static void write_bitmap_word(struct go7007 *go) --{ -- int x, y, i, stride = ((go->width >> 4) + 7) >> 3; -- -- for (i = 0; i < 16; ++i) { -- y = (((go->parse_length - 1) << 3) + i) / (go->width >> 4); -- x = (((go->parse_length - 1) << 3) + i) % (go->width >> 4); -- go->active_map[stride * y + (x >> 3)] |= -- (go->modet_word & 1) << (x & 0x7); -- go->modet_word >>= 1; -- } --} -- --/* -- * Parse a chunk of the video stream into frames. The frames are not -- * delimited by the hardware, so we have to parse the frame boundaries -- * based on the type of video stream we're receiving. -- */ --void go7007_parse_video_stream(struct go7007 *go, u8 *buf, int length) --{ -- int i, seq_start_code = -1, frame_start_code = -1; -- -- spin_lock(&go->spinlock); -- -- switch (go->format) { -- case GO7007_FORMAT_MPEG4: -- seq_start_code = 0xB0; -- frame_start_code = 0xB6; -- break; -- case GO7007_FORMAT_MPEG1: -- case GO7007_FORMAT_MPEG2: -- seq_start_code = 0xB3; -- frame_start_code = 0x00; -- break; -- } -- -- for (i = 0; i < length; ++i) { -- if (go->active_buf != NULL && -- go->active_buf->bytesused >= GO7007_BUF_SIZE - 3) { -- printk(KERN_DEBUG "go7007: dropping oversized frame\n"); -- go->active_buf->offset -= go->active_buf->bytesused; -- go->active_buf->bytesused = 0; -- go->active_buf->modet_active = 0; -- go->active_buf = NULL; -- } -- -- switch (go->state) { -- case STATE_DATA: -- switch (buf[i]) { -- case 0x00: -- go->state = STATE_00; -- break; -- case 0xFF: -- go->state = STATE_FF; -- break; -- default: -- store_byte(go->active_buf, buf[i]); -- break; -- } -- break; -- case STATE_00: -- switch (buf[i]) { -- case 0x00: -- go->state = STATE_00_00; -- break; -- case 0xFF: -- store_byte(go->active_buf, 0x00); -- go->state = STATE_FF; -- break; -- default: -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, buf[i]); -- go->state = STATE_DATA; -- break; -- } -- break; -- case STATE_00_00: -- switch (buf[i]) { -- case 0x00: -- store_byte(go->active_buf, 0x00); -- /* go->state remains STATE_00_00 */ -- break; -- case 0x01: -- go->state = STATE_00_00_01; -- break; -- case 0xFF: -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, 0x00); -- go->state = STATE_FF; -- break; -- default: -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, buf[i]); -- go->state = STATE_DATA; -- break; -- } -- break; -- case STATE_00_00_01: -- /* If this is the start of a new MPEG frame, -- * get a new buffer */ -- if ((go->format == GO7007_FORMAT_MPEG1 || -- go->format == GO7007_FORMAT_MPEG2 || -- go->format == GO7007_FORMAT_MPEG4) && -- (buf[i] == seq_start_code || -- buf[i] == 0xB8 || /* GOP code */ -- buf[i] == frame_start_code)) { -- if (go->active_buf == NULL || go->seen_frame) -- frame_boundary(go); -- if (buf[i] == frame_start_code) { -- if (go->active_buf != NULL) -- go->active_buf->frame_offset = -- go->active_buf->offset; -- go->seen_frame = 1; -- } else { -- go->seen_frame = 0; -- } -- } -- /* Handle any special chunk types, or just write the -- * start code to the (potentially new) buffer */ -- switch (buf[i]) { -- case 0xF5: /* timestamp */ -- go->parse_length = 12; -- go->state = STATE_UNPARSED; -- break; -- case 0xF6: /* vbi */ -- go->state = STATE_VBI_LEN_A; -- break; -- case 0xF8: /* MD map */ -- go->parse_length = 0; -- memset(go->active_map, 0, -- sizeof(go->active_map)); -- go->state = STATE_MODET_MAP; -- break; -- case 0xFF: /* Potential JPEG start code */ -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, 0x01); -- go->state = STATE_FF; -- break; -- default: -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, 0x00); -- store_byte(go->active_buf, 0x01); -- store_byte(go->active_buf, buf[i]); -- go->state = STATE_DATA; -- break; -- } -- break; -- case STATE_FF: -- switch (buf[i]) { -- case 0x00: -- store_byte(go->active_buf, 0xFF); -- go->state = STATE_00; -- break; -- case 0xFF: -- store_byte(go->active_buf, 0xFF); -- /* go->state remains STATE_FF */ -- break; -- case 0xD8: -- if (go->format == GO7007_FORMAT_MJPEG) -- frame_boundary(go); -- /* fall through */ -- default: -- store_byte(go->active_buf, 0xFF); -- store_byte(go->active_buf, buf[i]); -- go->state = STATE_DATA; -- break; -- } -- break; -- case STATE_VBI_LEN_A: -- go->parse_length = buf[i] << 8; -- go->state = STATE_VBI_LEN_B; -- break; -- case STATE_VBI_LEN_B: -- go->parse_length |= buf[i]; -- if (go->parse_length > 0) -- go->state = STATE_UNPARSED; -- else -- go->state = STATE_DATA; -- break; -- case STATE_MODET_MAP: -- if (go->parse_length < 204) { -- if (go->parse_length & 1) { -- go->modet_word |= buf[i]; -- write_bitmap_word(go); -- } else -- go->modet_word = buf[i] << 8; -- } else if (go->parse_length == 207 && go->active_buf) { -- go->active_buf->modet_active = buf[i]; -- } -- if (++go->parse_length == 208) -- go->state = STATE_DATA; -- break; -- case STATE_UNPARSED: -- if (--go->parse_length == 0) -- go->state = STATE_DATA; -- break; -- } -- } -- -- spin_unlock(&go->spinlock); --} --EXPORT_SYMBOL(go7007_parse_video_stream); -- --/* -- * Allocate a new go7007 struct. Used by the hardware-specific probe. -- */ --struct go7007 *go7007_alloc(struct go7007_board_info *board, struct device *dev) --{ -- struct go7007 *go; -- int i; -- -- go = kmalloc(sizeof(struct go7007), GFP_KERNEL); -- if (go == NULL) -- return NULL; -- go->dev = dev; -- go->board_info = board; -- go->board_id = 0; -- go->tuner_type = -1; -- go->channel_number = 0; -- go->name[0] = 0; -- init_MUTEX(&go->hw_lock); -- init_waitqueue_head(&go->frame_waitq); -- spin_lock_init(&go->spinlock); -- go->video_dev = NULL; -- go->ref_count = 0; -- go->status = STATUS_INIT; -- memset(&go->i2c_adapter, 0, sizeof(go->i2c_adapter)); -- go->i2c_adapter_online = 0; -- go->interrupt_available = 0; -- init_waitqueue_head(&go->interrupt_waitq); -- go->in_use = 0; -- go->input = 0; -- if (board->sensor_flags & GO7007_SENSOR_TV) { -- go->standard = GO7007_STD_NTSC; -- go->width = 720; -- go->height = 480; -- go->sensor_framerate = 30000; -- } else { -- go->standard = GO7007_STD_OTHER; -- go->width = board->sensor_width; -- go->height = board->sensor_height; -- go->sensor_framerate = board->sensor_framerate; -- } -- go->encoder_v_offset = board->sensor_v_offset; -- go->encoder_h_offset = board->sensor_h_offset; -- go->encoder_h_halve = 0; -- go->encoder_v_halve = 0; -- go->encoder_subsample = 0; -- go->streaming = 0; -- go->format = GO7007_FORMAT_MJPEG; -- go->bitrate = 1500000; -- go->fps_scale = 1; -- go->pali = 0; -- go->aspect_ratio = GO7007_RATIO_1_1; -- go->gop_size = 0; -- go->ipb = 0; -- go->closed_gop = 0; -- go->repeat_seqhead = 0; -- go->seq_header_enable = 0; -- go->gop_header_enable = 0; -- go->dvd_mode = 0; -- go->interlace_coding = 0; -- for (i = 0; i < 4; ++i) -- go->modet[i].enable = 0;; -- for (i = 0; i < 1624; ++i) -- go->modet_map[i] = 0; -- go->audio_deliver = NULL; -- go->audio_enabled = 0; -- INIT_LIST_HEAD(&go->stream); -- -- return go; --} --EXPORT_SYMBOL(go7007_alloc); -- --/* -- * Detach and unregister the encoder. The go7007 struct won't be freed -- * until v4l2 finishes releasing its resources and all associated fds are -- * closed by applications. -- */ --void go7007_remove(struct go7007 *go) --{ -- if (go->i2c_adapter_online) { -- if (i2c_del_adapter(&go->i2c_adapter) == 0) -- go->i2c_adapter_online = 0; -- else -- printk(KERN_ERR -- "go7007: error removing I2C adapter!\n"); -- } -- -- if (go->audio_enabled) -- go7007_snd_remove(go); -- go7007_v4l2_remove(go); --} --EXPORT_SYMBOL(go7007_remove); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/go7007-fw.c -+++ /dev/null -@@ -1,1638 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --/* -- * This file contains code to generate a firmware image for the GO7007SB -- * encoder. Much of the firmware is read verbatim from a file, but some of -- * it concerning bitrate control and other things that can be configured at -- * run-time are generated dynamically. Note that the format headers -- * generated here do not affect the functioning of the encoder; they are -- * merely parroted back to the host at the start of each frame. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/time.h> --#include <linux/mm.h> --#include <linux/device.h> --#include <linux/i2c.h> --#include <linux/firmware.h> --#include <asm/byteorder.h> -- --#include "go7007-priv.h" -- --/* Constants used in the source firmware image to describe code segments */ -- --#define FLAG_MODE_MJPEG (1) --#define FLAG_MODE_MPEG1 (1<<1) --#define FLAG_MODE_MPEG2 (1<<2) --#define FLAG_MODE_MPEG4 (1<<3) --#define FLAG_MODE_H263 (1<<4) --#define FLAG_MODE_ALL (FLAG_MODE_MJPEG | FLAG_MODE_MPEG1 | \ -- FLAG_MODE_MPEG2 | FLAG_MODE_MPEG4 | \ -- FLAG_MODE_H263) --#define FLAG_SPECIAL (1<<8) -- --#define SPECIAL_FRM_HEAD 0 --#define SPECIAL_BRC_CTRL 1 --#define SPECIAL_CONFIG 2 --#define SPECIAL_SEQHEAD 3 --#define SPECIAL_AV_SYNC 4 --#define SPECIAL_FINAL 5 --#define SPECIAL_AUDIO 6 --#define SPECIAL_MODET 7 -- --/* Little data class for creating MPEG headers bit-by-bit */ -- --struct code_gen { -- unsigned char *p; /* destination */ -- u32 a; /* collects bits at the top of the variable */ -- int b; /* bit position of most recently-written bit */ -- int len; /* written out so far */ --}; -- --#define CODE_GEN(name, dest) struct code_gen name = { dest, 0, 32, 0 } -- --#define CODE_ADD(name, val, length) do { \ -- name.b -= (length); \ -- name.a |= (val) << name.b; \ -- while (name.b <= 24) { \ -- *name.p = name.a >> 24; \ -- ++name.p; \ -- name.a <<= 8; \ -- name.b += 8; \ -- name.len += 8; \ -- } \ --} while (0) -- --#define CODE_LENGTH(name) (name.len + (32 - name.b)) -- --/* Tables for creating the bitrate control data */ -- --static const s16 converge_speed_ip[101] = { -- 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, -- 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, -- 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, -- 1, 1, 1, 1, 1, 1, 1, 1, 1, 2, -- 2, 2, 2, 2, 2, 2, 2, 2, 2, 3, -- 3, 3, 3, 3, 3, 4, 4, 4, 4, 4, -- 5, 5, 5, 6, 6, 6, 7, 7, 8, 8, -- 9, 10, 10, 11, 12, 13, 14, 15, 16, 17, -- 19, 20, 22, 23, 25, 27, 30, 32, 35, 38, -- 41, 45, 49, 53, 58, 63, 69, 76, 83, 91, -- 100 --}; -- --static const s16 converge_speed_ipb[101] = { -- 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, -- 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, -- 3, 3, 3, 3, 3, 4, 4, 4, 4, 4, -- 4, 4, 4, 4, 5, 5, 5, 5, 5, 6, -- 6, 6, 6, 7, 7, 7, 7, 8, 8, 9, -- 9, 9, 10, 10, 11, 12, 12, 13, 14, 14, -- 15, 16, 17, 18, 19, 20, 22, 23, 25, 26, -- 28, 30, 32, 34, 37, 40, 42, 46, 49, 53, -- 57, 61, 66, 71, 77, 83, 90, 97, 106, 115, -- 125, 135, 147, 161, 175, 191, 209, 228, 249, 273, -- 300 --}; -- --static const s16 LAMBDA_table[4][101] = { -- { 16, 16, 16, 16, 17, 17, 17, 18, 18, 18, -- 19, 19, 19, 20, 20, 20, 21, 21, 22, 22, -- 22, 23, 23, 24, 24, 25, 25, 25, 26, 26, -- 27, 27, 28, 28, 29, 29, 30, 31, 31, 32, -- 32, 33, 33, 34, 35, 35, 36, 37, 37, 38, -- 39, 39, 40, 41, 42, 42, 43, 44, 45, 46, -- 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, -- 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, -- 67, 68, 69, 70, 72, 73, 74, 76, 77, 78, -- 80, 81, 83, 84, 86, 87, 89, 90, 92, 94, -- 96 -- }, -- { -- 20, 20, 20, 21, 21, 21, 22, 22, 23, 23, -- 23, 24, 24, 25, 25, 26, 26, 27, 27, 28, -- 28, 29, 29, 30, 30, 31, 31, 32, 33, 33, -- 34, 34, 35, 36, 36, 37, 38, 38, 39, 40, -- 40, 41, 42, 43, 43, 44, 45, 46, 47, 48, -- 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, -- 58, 59, 60, 61, 62, 64, 65, 66, 67, 68, -- 70, 71, 72, 73, 75, 76, 78, 79, 80, 82, -- 83, 85, 86, 88, 90, 91, 93, 95, 96, 98, -- 100, 102, 103, 105, 107, 109, 111, 113, 115, 117, -- 120 -- }, -- { -- 24, 24, 24, 25, 25, 26, 26, 27, 27, 28, -- 28, 29, 29, 30, 30, 31, 31, 32, 33, 33, -- 34, 34, 35, 36, 36, 37, 38, 38, 39, 40, -- 41, 41, 42, 43, 44, 44, 45, 46, 47, 48, -- 49, 50, 50, 51, 52, 53, 54, 55, 56, 57, -- 58, 59, 60, 62, 63, 64, 65, 66, 67, 69, -- 70, 71, 72, 74, 75, 76, 78, 79, 81, 82, -- 84, 85, 87, 88, 90, 92, 93, 95, 97, 98, -- 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, -- 120, 122, 124, 127, 129, 131, 134, 136, 138, 141, -- 144 -- }, -- { -- 32, 32, 33, 33, 34, 34, 35, 36, 36, 37, -- 38, 38, 39, 40, 41, 41, 42, 43, 44, 44, -- 45, 46, 47, 48, 49, 50, 50, 51, 52, 53, -- 54, 55, 56, 57, 58, 59, 60, 62, 63, 64, -- 65, 66, 67, 69, 70, 71, 72, 74, 75, 76, -- 78, 79, 81, 82, 84, 85, 87, 88, 90, 92, -- 93, 95, 97, 98, 100, 102, 104, 106, 108, 110, -- 112, 114, 116, 118, 120, 122, 124, 127, 129, 131, -- 134, 136, 139, 141, 144, 146, 149, 152, 154, 157, -- 160, 163, 166, 169, 172, 175, 178, 181, 185, 188, -- 192 -- } --}; -- --/* MPEG blank frame generation tables */ -- --enum mpeg_frame_type { -- PFRAME, -- BFRAME_PRE, -- BFRAME_POST, -- BFRAME_BIDIR, -- BFRAME_EMPTY --}; -- --static const u32 addrinctab[33][2] = { -- { 0x01, 1 }, { 0x03, 3 }, { 0x02, 3 }, { 0x03, 4 }, -- { 0x02, 4 }, { 0x03, 5 }, { 0x02, 5 }, { 0x07, 7 }, -- { 0x06, 7 }, { 0x0b, 8 }, { 0x0a, 8 }, { 0x09, 8 }, -- { 0x08, 8 }, { 0x07, 8 }, { 0x06, 8 }, { 0x17, 10 }, -- { 0x16, 10 }, { 0x15, 10 }, { 0x14, 10 }, { 0x13, 10 }, -- { 0x12, 10 }, { 0x23, 11 }, { 0x22, 11 }, { 0x21, 11 }, -- { 0x20, 11 }, { 0x1f, 11 }, { 0x1e, 11 }, { 0x1d, 11 }, -- { 0x1c, 11 }, { 0x1b, 11 }, { 0x1a, 11 }, { 0x19, 11 }, -- { 0x18, 11 } --}; -- --/* Standard JPEG tables */ -- --static const u8 default_intra_quant_table[] = { -- 8, 16, 19, 22, 26, 27, 29, 34, -- 16, 16, 22, 24, 27, 29, 34, 37, -- 19, 22, 26, 27, 29, 34, 34, 38, -- 22, 22, 26, 27, 29, 34, 37, 40, -- 22, 26, 27, 29, 32, 35, 40, 48, -- 26, 27, 29, 32, 35, 40, 48, 58, -- 26, 27, 29, 34, 38, 46, 56, 69, -- 27, 29, 35, 38, 46, 56, 69, 83 --}; -- --static const u8 bits_dc_luminance[] = { -- 0, 0, 1, 5, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0 --}; -- --static const u8 val_dc_luminance[] = { -- 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11 --}; -- --static const u8 bits_dc_chrominance[] = { -- 0, 0, 3, 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0 --}; -- --static const u8 val_dc_chrominance[] = { -- 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11 --}; -- --static const u8 bits_ac_luminance[] = { -- 0, 0, 2, 1, 3, 3, 2, 4, 3, 5, 5, 4, 4, 0, 0, 1, 0x7d --}; -- --static const u8 val_ac_luminance[] = { -- 0x01, 0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12, -- 0x21, 0x31, 0x41, 0x06, 0x13, 0x51, 0x61, 0x07, -- 0x22, 0x71, 0x14, 0x32, 0x81, 0x91, 0xa1, 0x08, -- 0x23, 0x42, 0xb1, 0xc1, 0x15, 0x52, 0xd1, 0xf0, -- 0x24, 0x33, 0x62, 0x72, 0x82, 0x09, 0x0a, 0x16, -- 0x17, 0x18, 0x19, 0x1a, 0x25, 0x26, 0x27, 0x28, -- 0x29, 0x2a, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, -- 0x3a, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, -- 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59, -- 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, -- 0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, -- 0x7a, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89, -- 0x8a, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98, -- 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7, -- 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6, -- 0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, 0xc4, 0xc5, -- 0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2, 0xd3, 0xd4, -- 0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda, 0xe1, 0xe2, -- 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9, 0xea, -- 0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8, -- 0xf9, 0xfa --}; -- --static const u8 bits_ac_chrominance[] = { -- 0, 0, 2, 1, 2, 4, 4, 3, 4, 7, 5, 4, 4, 0, 1, 2, 0x77 --}; -- --static const u8 val_ac_chrominance[] = { -- 0x00, 0x01, 0x02, 0x03, 0x11, 0x04, 0x05, 0x21, -- 0x31, 0x06, 0x12, 0x41, 0x51, 0x07, 0x61, 0x71, -- 0x13, 0x22, 0x32, 0x81, 0x08, 0x14, 0x42, 0x91, -- 0xa1, 0xb1, 0xc1, 0x09, 0x23, 0x33, 0x52, 0xf0, -- 0x15, 0x62, 0x72, 0xd1, 0x0a, 0x16, 0x24, 0x34, -- 0xe1, 0x25, 0xf1, 0x17, 0x18, 0x19, 0x1a, 0x26, -- 0x27, 0x28, 0x29, 0x2a, 0x35, 0x36, 0x37, 0x38, -- 0x39, 0x3a, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, -- 0x49, 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, -- 0x59, 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, -- 0x69, 0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, -- 0x79, 0x7a, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, -- 0x88, 0x89, 0x8a, 0x92, 0x93, 0x94, 0x95, 0x96, -- 0x97, 0x98, 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5, -- 0xa6, 0xa7, 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, -- 0xb5, 0xb6, 0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, -- 0xc4, 0xc5, 0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2, -- 0xd3, 0xd4, 0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda, -- 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9, -- 0xea, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8, -- 0xf9, 0xfa --}; -- --/* Zig-zag mapping for quant table -- * -- * OK, let's do this mapping on the actual table above so it doesn't have -- * to be done on the fly. -- */ --static const int zz[64] = { -- 0, 1, 8, 16, 9, 2, 3, 10, 17, 24, 32, 25, 18, 11, 4, 5, -- 12, 19, 26, 33, 40, 48, 41, 34, 27, 20, 13, 6, 7, 14, 21, 28, -- 35, 42, 49, 56, 57, 50, 43, 36, 29, 22, 15, 23, 30, 37, 44, 51, -- 58, 59, 52, 45, 38, 31, 39, 46, 53, 60, 61, 54, 47, 55, 62, 63 --}; -- --static int copy_packages(__le16 *dest, u16 *src, int pkg_cnt, int space) --{ -- int i, cnt = pkg_cnt * 32; -- -- if (space < cnt) -- return -1; -- -- for (i = 0; i < cnt; ++i) -- dest[i] = cpu_to_le16p(src + i); -- -- return cnt; --} -- --static int mjpeg_frame_header(struct go7007 *go, unsigned char *buf, int q) --{ -- int i, p = 0; -- -- buf[p++] = 0xff; -- buf[p++] = 0xd8; -- buf[p++] = 0xff; -- buf[p++] = 0xdb; -- buf[p++] = 0; -- buf[p++] = 2 + 65; -- buf[p++] = 0; -- buf[p++] = default_intra_quant_table[0]; -- for (i = 1; i < 64; ++i) -- /* buf[p++] = (default_intra_quant_table[i] * q) >> 3; */ -- buf[p++] = (default_intra_quant_table[zz[i]] * q) >> 3; -- buf[p++] = 0xff; -- buf[p++] = 0xc0; -- buf[p++] = 0; -- buf[p++] = 17; -- buf[p++] = 8; -- buf[p++] = go->height >> 8; -- buf[p++] = go->height & 0xff; -- buf[p++] = go->width >> 8; -- buf[p++] = go->width & 0xff; -- buf[p++] = 3; -- buf[p++] = 1; -- buf[p++] = 0x22; -- buf[p++] = 0; -- buf[p++] = 2; -- buf[p++] = 0x11; -- buf[p++] = 0; -- buf[p++] = 3; -- buf[p++] = 0x11; -- buf[p++] = 0; -- buf[p++] = 0xff; -- buf[p++] = 0xc4; -- buf[p++] = 418 >> 8; -- buf[p++] = 418 & 0xff; -- buf[p++] = 0x00; -- memcpy(buf + p, bits_dc_luminance + 1, 16); -- p += 16; -- memcpy(buf + p, val_dc_luminance, sizeof(val_dc_luminance)); -- p += sizeof(val_dc_luminance); -- buf[p++] = 0x01; -- memcpy(buf + p, bits_dc_chrominance + 1, 16); -- p += 16; -- memcpy(buf + p, val_dc_chrominance, sizeof(val_dc_chrominance)); -- p += sizeof(val_dc_chrominance); -- buf[p++] = 0x10; -- memcpy(buf + p, bits_ac_luminance + 1, 16); -- p += 16; -- memcpy(buf + p, val_ac_luminance, sizeof(val_ac_luminance)); -- p += sizeof(val_ac_luminance); -- buf[p++] = 0x11; -- memcpy(buf + p, bits_ac_chrominance + 1, 16); -- p += 16; -- memcpy(buf + p, val_ac_chrominance, sizeof(val_ac_chrominance)); -- p += sizeof(val_ac_chrominance); -- buf[p++] = 0xff; -- buf[p++] = 0xda; -- buf[p++] = 0; -- buf[p++] = 12; -- buf[p++] = 3; -- buf[p++] = 1; -- buf[p++] = 0x00; -- buf[p++] = 2; -- buf[p++] = 0x11; -- buf[p++] = 3; -- buf[p++] = 0x11; -- buf[p++] = 0; -- buf[p++] = 63; -- buf[p++] = 0; -- return p; --} -- --static int gen_mjpeghdr_to_package(struct go7007 *go, __le16 *code, int space) --{ -- u8 *buf; -- u16 mem = 0x3e00; -- unsigned int addr = 0x19; -- int size = 0, i, off = 0, chunk; -- -- buf = kmalloc(4096, GFP_KERNEL); -- if (buf == NULL) { -- printk(KERN_ERR "go7007: unable to allocate 4096 bytes for " -- "firmware construction\n"); -- return -1; -- } -- memset(buf, 0, 4096); -- -- for (i = 1; i < 32; ++i) { -- mjpeg_frame_header(go, buf + size, i); -- size += 80; -- } -- chunk = mjpeg_frame_header(go, buf + size, 1); -- memmove(buf + size, buf + size + 80, chunk - 80); -- size += chunk - 80; -- -- for (i = 0; i < size; i += chunk * 2) { -- if (space - off < 32) { -- off = -1; -- goto done; -- } -- -- code[off + 1] = __cpu_to_le16(0x8000 | mem); -- -- chunk = 28; -- if (mem + chunk > 0x4000) -- chunk = 0x4000 - mem; -- if (i + 2 * chunk > size) -- chunk = (size - i) / 2; -- -- if (chunk < 28) { -- code[off] = __cpu_to_le16(0x4000 | chunk); -- code[off + 31] = __cpu_to_le16(addr++); -- mem = 0x3e00; -- } else { -- code[off] = __cpu_to_le16(0x1000 | 28); -- code[off + 31] = 0; -- mem += 28; -- } -- -- memcpy(&code[off + 2], buf + i, chunk * 2); -- off += 32; -- } --done: -- kfree(buf); -- return off; --} -- --static int mpeg1_frame_header(struct go7007 *go, unsigned char *buf, -- int modulo, int pict_struct, enum mpeg_frame_type frame) --{ -- int i, j, mb_code, mb_len; -- int rows = go->interlace_coding ? go->height / 32 : go->height / 16; -- CODE_GEN(c, buf + 6); -- -- switch (frame) { -- case PFRAME: -- mb_code = 0x1; -- mb_len = 3; -- break; -- case BFRAME_PRE: -- mb_code = 0x2; -- mb_len = 4; -- break; -- case BFRAME_POST: -- mb_code = 0x2; -- mb_len = 3; -- break; -- case BFRAME_BIDIR: -- mb_code = 0x2; -- mb_len = 2; -- break; -- default: /* keep the compiler happy */ -- mb_code = mb_len = 0; -- break; -- } -- -- CODE_ADD(c, frame == PFRAME ? 0x2 : 0x3, 13); -- CODE_ADD(c, 0xffff, 16); -- CODE_ADD(c, go->format == GO7007_FORMAT_MPEG2 ? 0x7 : 0x4, 4); -- if (frame != PFRAME) -- CODE_ADD(c, go->format == GO7007_FORMAT_MPEG2 ? 0x7 : 0x4, 4); -- else -- CODE_ADD(c, 0, 4); /* Is this supposed to be here?? */ -- CODE_ADD(c, 0, 3); /* What is this?? */ -- /* Byte-align with zeros */ -- j = 8 - (CODE_LENGTH(c) % 8); -- if (j != 8) -- CODE_ADD(c, 0, j); -- -- if (go->format == GO7007_FORMAT_MPEG2) { -- CODE_ADD(c, 0x1, 24); -- CODE_ADD(c, 0xb5, 8); -- CODE_ADD(c, 0x844, 12); -- CODE_ADD(c, frame == PFRAME ? 0xff : 0x44, 8); -- if (go->interlace_coding) { -- CODE_ADD(c, pict_struct, 4); -- if (go->dvd_mode) -- CODE_ADD(c, 0x000, 11); -- else -- CODE_ADD(c, 0x200, 11); -- } else { -- CODE_ADD(c, 0x3, 4); -- CODE_ADD(c, 0x20c, 11); -- } -- /* Byte-align with zeros */ -- j = 8 - (CODE_LENGTH(c) % 8); -- if (j != 8) -- CODE_ADD(c, 0, j); -- } -- -- for (i = 0; i < rows; ++i) { -- CODE_ADD(c, 1, 24); -- CODE_ADD(c, i + 1, 8); -- CODE_ADD(c, 0x2, 6); -- CODE_ADD(c, 0x1, 1); -- CODE_ADD(c, mb_code, mb_len); -- if (go->interlace_coding) { -- CODE_ADD(c, 0x1, 2); -- CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1); -- } -- if (frame == BFRAME_BIDIR) { -- CODE_ADD(c, 0x3, 2); -- if (go->interlace_coding) -- CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1); -- } -- CODE_ADD(c, 0x3, 2); -- for (j = (go->width >> 4) - 2; j >= 33; j -= 33) -- CODE_ADD(c, 0x8, 11); -- CODE_ADD(c, addrinctab[j][0], addrinctab[j][1]); -- CODE_ADD(c, mb_code, mb_len); -- if (go->interlace_coding) { -- CODE_ADD(c, 0x1, 2); -- CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1); -- } -- if (frame == BFRAME_BIDIR) { -- CODE_ADD(c, 0x3, 2); -- if (go->interlace_coding) -- CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1); -- } -- CODE_ADD(c, 0x3, 2); -- -- /* Byte-align with zeros */ -- j = 8 - (CODE_LENGTH(c) % 8); -- if (j != 8) -- CODE_ADD(c, 0, j); -- } -- -- i = CODE_LENGTH(c) + 4 * 8; -- buf[2] = 0x00; -- buf[3] = 0x00; -- buf[4] = 0x01; -- buf[5] = 0x00; -- return i; --} -- --static int mpeg1_sequence_header(struct go7007 *go, unsigned char *buf, int ext) --{ -- int i, aspect_ratio, picture_rate; -- CODE_GEN(c, buf + 6); -- -- if (go->format == GO7007_FORMAT_MPEG1) { -- switch (go->aspect_ratio) { -- case GO7007_RATIO_4_3: -- aspect_ratio = go->standard == GO7007_STD_NTSC ? 3 : 2; -- break; -- case GO7007_RATIO_16_9: -- aspect_ratio = go->standard == GO7007_STD_NTSC ? 5 : 4; -- break; -- default: -- aspect_ratio = 1; -- break; -- } -- } else { -- switch (go->aspect_ratio) { -- case GO7007_RATIO_4_3: -- aspect_ratio = 2; -- break; -- case GO7007_RATIO_16_9: -- aspect_ratio = 3; -- break; -- default: -- aspect_ratio = 1; -- break; -- } -- } -- switch (go->sensor_framerate) { -- case 24000: -- picture_rate = 1; -- break; -- case 24024: -- picture_rate = 2; -- break; -- case 25025: -- picture_rate = go->interlace_coding ? 6 : 3; -- break; -- case 30000: -- picture_rate = go->interlace_coding ? 7 : 4; -- break; -- case 30030: -- picture_rate = go->interlace_coding ? 8 : 5; -- break; -- default: -- picture_rate = 5; /* 30 fps seems like a reasonable default */ -- break; -- } -- -- CODE_ADD(c, go->width, 12); -- CODE_ADD(c, go->height, 12); -- CODE_ADD(c, aspect_ratio, 4); -- CODE_ADD(c, picture_rate, 4); -- CODE_ADD(c, go->format == GO7007_FORMAT_MPEG2 ? 20000 : 0x3ffff, 18); -- CODE_ADD(c, 1, 1); -- CODE_ADD(c, go->format == GO7007_FORMAT_MPEG2 ? 112 : 20, 10); -- CODE_ADD(c, 0, 3); -- -- /* Byte-align with zeros */ -- i = 8 - (CODE_LENGTH(c) % 8); -- if (i != 8) -- CODE_ADD(c, 0, i); -- -- if (go->format == GO7007_FORMAT_MPEG2) { -- CODE_ADD(c, 0x1, 24); -- CODE_ADD(c, 0xb5, 8); -- CODE_ADD(c, 0x148, 12); -- if (go->interlace_coding) -- CODE_ADD(c, 0x20001, 20); -- else -- CODE_ADD(c, 0xa0001, 20); -- CODE_ADD(c, 0, 16); -- -- /* Byte-align with zeros */ -- i = 8 - (CODE_LENGTH(c) % 8); -- if (i != 8) -- CODE_ADD(c, 0, i); -- -- if (ext) { -- CODE_ADD(c, 0x1, 24); -- CODE_ADD(c, 0xb52, 12); -- CODE_ADD(c, go->standard == GO7007_STD_NTSC ? 2 : 1, 3); -- CODE_ADD(c, 0x105, 9); -- CODE_ADD(c, 0x505, 16); -- CODE_ADD(c, go->width, 14); -- CODE_ADD(c, 1, 1); -- CODE_ADD(c, go->height, 14); -- -- /* Byte-align with zeros */ -- i = 8 - (CODE_LENGTH(c) % 8); -- if (i != 8) -- CODE_ADD(c, 0, i); -- } -- } -- -- i = CODE_LENGTH(c) + 4 * 8; -- buf[0] = i & 0xff; -- buf[1] = i >> 8; -- buf[2] = 0x00; -- buf[3] = 0x00; -- buf[4] = 0x01; -- buf[5] = 0xb3; -- return i; --} -- --static int gen_mpeg1hdr_to_package(struct go7007 *go, -- __le16 *code, int space, int *framelen) --{ -- u8 *buf; -- u16 mem = 0x3e00; -- unsigned int addr = 0x19; -- int i, off = 0, chunk; -- -- buf = kmalloc(5120, GFP_KERNEL); -- if (buf == NULL) { -- printk(KERN_ERR "go7007: unable to allocate 5120 bytes for " -- "firmware construction\n"); -- return -1; -- } -- memset(buf, 0, 5120); -- framelen[0] = mpeg1_frame_header(go, buf, 0, 1, PFRAME); -- if (go->interlace_coding) -- framelen[0] += mpeg1_frame_header(go, buf + framelen[0] / 8, -- 0, 2, PFRAME); -- buf[0] = framelen[0] & 0xff; -- buf[1] = framelen[0] >> 8; -- i = 368; -- framelen[1] = mpeg1_frame_header(go, buf + i, 0, 1, BFRAME_PRE); -- if (go->interlace_coding) -- framelen[1] += mpeg1_frame_header(go, buf + i + framelen[1] / 8, -- 0, 2, BFRAME_PRE); -- buf[i] = framelen[1] & 0xff; -- buf[i + 1] = framelen[1] >> 8; -- i += 1632; -- framelen[2] = mpeg1_frame_header(go, buf + i, 0, 1, BFRAME_POST); -- if (go->interlace_coding) -- framelen[2] += mpeg1_frame_header(go, buf + i + framelen[2] / 8, -- 0, 2, BFRAME_POST); -- buf[i] = framelen[2] & 0xff; -- buf[i + 1] = framelen[2] >> 8; -- i += 1432; -- framelen[3] = mpeg1_frame_header(go, buf + i, 0, 1, BFRAME_BIDIR); -- if (go->interlace_coding) -- framelen[3] += mpeg1_frame_header(go, buf + i + framelen[3] / 8, -- 0, 2, BFRAME_BIDIR); -- buf[i] = framelen[3] & 0xff; -- buf[i + 1] = framelen[3] >> 8; -- i += 1632 + 16; -- mpeg1_sequence_header(go, buf + i, 0); -- i += 40; -- for (i = 0; i < 5120; i += chunk * 2) { -- if (space - off < 32) { -- off = -1; -- goto done; -- } -- -- code[off + 1] = __cpu_to_le16(0x8000 | mem); -- -- chunk = 28; -- if (mem + chunk > 0x4000) -- chunk = 0x4000 - mem; -- if (i + 2 * chunk > 5120) -- chunk = (5120 - i) / 2; -- -- if (chunk < 28) { -- code[off] = __cpu_to_le16(0x4000 | chunk); -- code[off + 31] = __cpu_to_le16(addr); -- if (mem + chunk == 0x4000) { -- mem = 0x3e00; -- ++addr; -- } -- } else { -- code[off] = __cpu_to_le16(0x1000 | 28); -- code[off + 31] = 0; -- mem += 28; -- } -- -- memcpy(&code[off + 2], buf + i, chunk * 2); -- off += 32; -- } --done: -- kfree(buf); -- return off; --} -- --static int vti_bitlen(struct go7007 *go) --{ -- unsigned int i, max_time_incr = go->sensor_framerate / go->fps_scale; -- -- for (i = 31; (max_time_incr & ((1 << i) - 1)) == max_time_incr; --i); -- return i + 1; --} -- --static int mpeg4_frame_header(struct go7007 *go, unsigned char *buf, -- int modulo, enum mpeg_frame_type frame) --{ -- int i; -- CODE_GEN(c, buf + 6); -- int mb_count = (go->width >> 4) * (go->height >> 4); -- -- CODE_ADD(c, frame == PFRAME ? 0x1 : 0x2, 2); -- if (modulo) -- CODE_ADD(c, 0x1, 1); -- CODE_ADD(c, 0x1, 2); -- CODE_ADD(c, 0, vti_bitlen(go)); -- CODE_ADD(c, 0x3, 2); -- if (frame == PFRAME) -- CODE_ADD(c, 0, 1); -- CODE_ADD(c, 0xc, 11); -- if (frame != PFRAME) -- CODE_ADD(c, 0x4, 3); -- if (frame != BFRAME_EMPTY) { -- for (i = 0; i < mb_count; ++i) { -- switch (frame) { -- case PFRAME: -- CODE_ADD(c, 0x1, 1); -- break; -- case BFRAME_PRE: -- CODE_ADD(c, 0x47, 8); -- break; -- case BFRAME_POST: -- CODE_ADD(c, 0x27, 7); -- break; -- case BFRAME_BIDIR: -- CODE_ADD(c, 0x5f, 8); -- break; -- case BFRAME_EMPTY: /* keep compiler quiet */ -- break; -- } -- } -- } -- -- /* Byte-align with a zero followed by ones */ -- i = 8 - (CODE_LENGTH(c) % 8); -- CODE_ADD(c, 0, 1); -- CODE_ADD(c, (1 << (i - 1)) - 1, i - 1); -- -- i = CODE_LENGTH(c) + 4 * 8; -- buf[0] = i & 0xff; -- buf[1] = i >> 8; -- buf[2] = 0x00; -- buf[3] = 0x00; -- buf[4] = 0x01; -- buf[5] = 0xb6; -- return i; --} -- --static int mpeg4_sequence_header(struct go7007 *go, unsigned char *buf, int ext) --{ -- const unsigned char head[] = { 0x00, 0x00, 0x01, 0xb0, go->pali, -- 0x00, 0x00, 0x01, 0xb5, 0x09, -- 0x00, 0x00, 0x01, 0x00, -- 0x00, 0x00, 0x01, 0x20, }; -- int i, aspect_ratio; -- int fps = go->sensor_framerate / go->fps_scale; -- CODE_GEN(c, buf + 2 + sizeof(head)); -- -- switch (go->aspect_ratio) { -- case GO7007_RATIO_4_3: -- aspect_ratio = go->standard == GO7007_STD_NTSC ? 3 : 2; -- break; -- case GO7007_RATIO_16_9: -- aspect_ratio = go->standard == GO7007_STD_NTSC ? 5 : 4; -- break; -- default: -- aspect_ratio = 1; -- break; -- } -- -- memcpy(buf + 2, head, sizeof(head)); -- CODE_ADD(c, 0x191, 17); -- CODE_ADD(c, aspect_ratio, 4); -- CODE_ADD(c, 0x1, 4); -- CODE_ADD(c, fps, 16); -- CODE_ADD(c, 0x3, 2); -- CODE_ADD(c, 1001, vti_bitlen(go)); -- CODE_ADD(c, 1, 1); -- CODE_ADD(c, go->width, 13); -- CODE_ADD(c, 1, 1); -- CODE_ADD(c, go->height, 13); -- CODE_ADD(c, 0x2830, 14); -- -- /* Byte-align */ -- i = 8 - (CODE_LENGTH(c) % 8); -- CODE_ADD(c, 0, 1); -- CODE_ADD(c, (1 << (i - 1)) - 1, i - 1); -- -- i = CODE_LENGTH(c) + sizeof(head) * 8; -- buf[0] = i & 0xff; -- buf[1] = i >> 8; -- return i; --} -- --static int gen_mpeg4hdr_to_package(struct go7007 *go, -- __le16 *code, int space, int *framelen) --{ -- u8 *buf; -- u16 mem = 0x3e00; -- unsigned int addr = 0x19; -- int i, off = 0, chunk; -- -- buf = kmalloc(5120, GFP_KERNEL); -- if (buf == NULL) { -- printk(KERN_ERR "go7007: unable to allocate 5120 bytes for " -- "firmware construction\n"); -- return -1; -- } -- memset(buf, 0, 5120); -- framelen[0] = mpeg4_frame_header(go, buf, 0, PFRAME); -- i = 368; -- framelen[1] = mpeg4_frame_header(go, buf + i, 0, BFRAME_PRE); -- i += 1632; -- framelen[2] = mpeg4_frame_header(go, buf + i, 0, BFRAME_POST); -- i += 1432; -- framelen[3] = mpeg4_frame_header(go, buf + i, 0, BFRAME_BIDIR); -- i += 1632; -- mpeg4_frame_header(go, buf + i, 0, BFRAME_EMPTY); -- i += 16; -- mpeg4_sequence_header(go, buf + i, 0); -- i += 40; -- for (i = 0; i < 5120; i += chunk * 2) { -- if (space - off < 32) { -- off = -1; -- goto done; -- } -- -- code[off + 1] = __cpu_to_le16(0x8000 | mem); -- -- chunk = 28; -- if (mem + chunk > 0x4000) -- chunk = 0x4000 - mem; -- if (i + 2 * chunk > 5120) -- chunk = (5120 - i) / 2; -- -- if (chunk < 28) { -- code[off] = __cpu_to_le16(0x4000 | chunk); -- code[off + 31] = __cpu_to_le16(addr); -- if (mem + chunk == 0x4000) { -- mem = 0x3e00; -- ++addr; -- } -- } else { -- code[off] = __cpu_to_le16(0x1000 | 28); -- code[off + 31] = 0; -- mem += 28; -- } -- -- memcpy(&code[off + 2], buf + i, chunk * 2); -- off += 32; -- } -- mem = 0x3e00; -- addr = go->ipb ? 0x14f9 : 0x0af9; -- memset(buf, 0, 5120); -- framelen[4] = mpeg4_frame_header(go, buf, 1, PFRAME); -- i = 368; -- framelen[5] = mpeg4_frame_header(go, buf + i, 1, BFRAME_PRE); -- i += 1632; -- framelen[6] = mpeg4_frame_header(go, buf + i, 1, BFRAME_POST); -- i += 1432; -- framelen[7] = mpeg4_frame_header(go, buf + i, 1, BFRAME_BIDIR); -- i += 1632; -- mpeg4_frame_header(go, buf + i, 1, BFRAME_EMPTY); -- i += 16; -- for (i = 0; i < 5120; i += chunk * 2) { -- if (space - off < 32) { -- off = -1; -- goto done; -- } -- -- code[off + 1] = __cpu_to_le16(0x8000 | mem); -- -- chunk = 28; -- if (mem + chunk > 0x4000) -- chunk = 0x4000 - mem; -- if (i + 2 * chunk > 5120) -- chunk = (5120 - i) / 2; -- -- if (chunk < 28) { -- code[off] = __cpu_to_le16(0x4000 | chunk); -- code[off + 31] = __cpu_to_le16(addr); -- if (mem + chunk == 0x4000) { -- mem = 0x3e00; -- ++addr; -- } -- } else { -- code[off] = __cpu_to_le16(0x1000 | 28); -- code[off + 31] = 0; -- mem += 28; -- } -- -- memcpy(&code[off + 2], buf + i, chunk * 2); -- off += 32; -- } --done: -- kfree(buf); -- return off; --} -- --static int brctrl_to_package(struct go7007 *go, -- __le16 *code, int space, int *framelen) --{ -- int converge_speed = 0; -- int lambda = (go->format == GO7007_FORMAT_MJPEG || go->dvd_mode) ? -- 100 : 0; -- int peak_rate = 6 * go->bitrate / 5; -- int vbv_buffer = go->format == GO7007_FORMAT_MJPEG ? -- go->bitrate : -- (go->dvd_mode ? 900000 : peak_rate); -- int fps = go->sensor_framerate / go->fps_scale; -- int q = 0; -- /* Bizarre math below depends on rounding errors in division */ -- u32 sgop_expt_addr = go->bitrate / 32 * (go->ipb ? 3 : 1) * 1001 / fps; -- u32 sgop_peak_addr = peak_rate / 32 * 1001 / fps; -- u32 total_expt_addr = go->bitrate / 32 * 1000 / fps * (fps / 1000); -- u32 vbv_alert_addr = vbv_buffer * 3 / (4 * 32); -- u32 cplx[] = { -- q > 0 ? sgop_expt_addr * q : -- 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32, -- q > 0 ? sgop_expt_addr * q : -- 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32, -- q > 0 ? sgop_expt_addr * q : -- 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32, -- q > 0 ? sgop_expt_addr * q : -- 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32, -- }; -- u32 calc_q = q > 0 ? q : cplx[0] / sgop_expt_addr; -- u16 pack[] = { -- 0x200e, 0x0000, -- 0xBF20, go->ipb ? converge_speed_ipb[converge_speed] -- : converge_speed_ip[converge_speed], -- 0xBF21, go->ipb ? 2 : 0, -- 0xBF22, go->ipb ? LAMBDA_table[0][lambda / 2 + 50] -- : 32767, -- 0xBF23, go->ipb ? LAMBDA_table[1][lambda] : 32767, -- 0xBF24, 32767, -- 0xBF25, lambda > 99 ? 32767 : LAMBDA_table[3][lambda], -- 0xBF26, sgop_expt_addr & 0x0000FFFF, -- 0xBF27, sgop_expt_addr >> 16, -- 0xBF28, sgop_peak_addr & 0x0000FFFF, -- 0xBF29, sgop_peak_addr >> 16, -- 0xBF2A, vbv_alert_addr & 0x0000FFFF, -- 0xBF2B, vbv_alert_addr >> 16, -- 0xBF2C, 0, -- 0xBF2D, 0, -- 0, 0, -- -- 0x200e, 0x0000, -- 0xBF2E, vbv_alert_addr & 0x0000FFFF, -- 0xBF2F, vbv_alert_addr >> 16, -- 0xBF30, cplx[0] & 0x0000FFFF, -- 0xBF31, cplx[0] >> 16, -- 0xBF32, cplx[1] & 0x0000FFFF, -- 0xBF33, cplx[1] >> 16, -- 0xBF34, cplx[2] & 0x0000FFFF, -- 0xBF35, cplx[2] >> 16, -- 0xBF36, cplx[3] & 0x0000FFFF, -- 0xBF37, cplx[3] >> 16, -- 0xBF38, 0, -- 0xBF39, 0, -- 0xBF3A, total_expt_addr & 0x0000FFFF, -- 0xBF3B, total_expt_addr >> 16, -- 0, 0, -- -- 0x200e, 0x0000, -- 0xBF3C, total_expt_addr & 0x0000FFFF, -- 0xBF3D, total_expt_addr >> 16, -- 0xBF3E, 0, -- 0xBF3F, 0, -- 0xBF48, 0, -- 0xBF49, 0, -- 0xBF4A, calc_q < 4 ? 4 : (calc_q > 124 ? 124 : calc_q), -- 0xBF4B, 4, -- 0xBF4C, 0, -- 0xBF4D, 0, -- 0xBF4E, 0, -- 0xBF4F, 0, -- 0xBF50, 0, -- 0xBF51, 0, -- 0, 0, -- -- 0x200e, 0x0000, -- 0xBF40, sgop_expt_addr & 0x0000FFFF, -- 0xBF41, sgop_expt_addr >> 16, -- 0xBF42, 0, -- 0xBF43, 0, -- 0xBF44, 0, -- 0xBF45, 0, -- 0xBF46, (go->width >> 4) * (go->height >> 4), -- 0xBF47, 0, -- 0xBF64, 0, -- 0xBF65, 0, -- 0xBF18, framelen[4], -- 0xBF19, framelen[5], -- 0xBF1A, framelen[6], -- 0xBF1B, framelen[7], -- 0, 0, -- --#if 0 /* Remove once we don't care about matching */ -- 0x200e, 0x0000, -- 0xBF56, 4, -- 0xBF57, 0, -- 0xBF58, 5, -- 0xBF59, 0, -- 0xBF5A, 6, -- 0xBF5B, 0, -- 0xBF5C, 8, -- 0xBF5D, 0, -- 0xBF5E, 1, -- 0xBF5F, 0, -- 0xBF60, 1, -- 0xBF61, 0, -- 0xBF62, 0, -- 0xBF63, 0, -- 0, 0, --#else -- 0x2008, 0x0000, -- 0xBF56, 4, -- 0xBF57, 0, -- 0xBF58, 5, -- 0xBF59, 0, -- 0xBF5A, 6, -- 0xBF5B, 0, -- 0xBF5C, 8, -- 0xBF5D, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, --#endif -- -- 0x200e, 0x0000, -- 0xBF10, 0, -- 0xBF11, 0, -- 0xBF12, 0, -- 0xBF13, 0, -- 0xBF14, 0, -- 0xBF15, 0, -- 0xBF16, 0, -- 0xBF17, 0, -- 0xBF7E, 0, -- 0xBF7F, 1, -- 0xBF52, framelen[0], -- 0xBF53, framelen[1], -- 0xBF54, framelen[2], -- 0xBF55, framelen[3], -- 0, 0, -- }; -- -- return copy_packages(code, pack, 6, space); --} -- --static int config_package(struct go7007 *go, __le16 *code, int space) --{ -- int fps = go->sensor_framerate / go->fps_scale / 1000; -- int rows = go->interlace_coding ? go->height / 32 : go->height / 16; -- int brc_window_size = fps; -- int q_min = 2, q_max = 31; -- int THACCoeffSet0 = 0; -- u16 pack[] = { -- 0x200e, 0x0000, -- 0xc002, 0x14b4, -- 0xc003, 0x28b4, -- 0xc004, 0x3c5a, -- 0xdc05, 0x2a77, -- 0xc6c3, go->format == GO7007_FORMAT_MPEG4 ? 0 : -- (go->format == GO7007_FORMAT_H263 ? 0 : 1), -- 0xc680, go->format == GO7007_FORMAT_MPEG4 ? 0xf1 : -- (go->format == GO7007_FORMAT_H263 ? 0x61 : -- 0xd3), -- 0xc780, 0x0140, -- 0xe009, 0x0001, -- 0xc60f, 0x0008, -- 0xd4ff, 0x0002, -- 0xe403, 2340, -- 0xe406, 75, -- 0xd411, 0x0001, -- 0xd410, 0xa1d6, -- 0x0001, 0x2801, -- -- 0x200d, 0x0000, -- 0xe402, 0x018b, -- 0xe401, 0x8b01, -- 0xd472, (go->board_info->sensor_flags & -- GO7007_SENSOR_TV) && -- (!go->interlace_coding) ? -- 0x01b0 : 0x0170, -- 0xd475, (go->board_info->sensor_flags & -- GO7007_SENSOR_TV) && -- (!go->interlace_coding) ? -- 0x0008 : 0x0009, -- 0xc404, go->interlace_coding ? 0x44 : -- (go->format == GO7007_FORMAT_MPEG4 ? 0x11 : -- (go->format == GO7007_FORMAT_MPEG1 ? 0x02 : -- (go->format == GO7007_FORMAT_MPEG2 ? 0x04 : -- (go->format == GO7007_FORMAT_H263 ? 0x08 : -- 0x20)))), -- 0xbf0a, (go->format == GO7007_FORMAT_MPEG4 ? 8 : -- (go->format == GO7007_FORMAT_MPEG1 ? 1 : -- (go->format == GO7007_FORMAT_MPEG2 ? 2 : -- (go->format == GO7007_FORMAT_H263 ? 4 : 16)))) | -- ((go->repeat_seqhead ? 1 : 0) << 6) | -- ((go->dvd_mode ? 1 : 0) << 9) | -- ((go->gop_header_enable ? 1 : 0) << 10), -- 0xbf0b, 0, -- 0xdd5a, go->ipb ? 0x14 : 0x0a, -- 0xbf0c, 0, -- 0xbf0d, 0, -- 0xc683, THACCoeffSet0, -- 0xc40a, (go->width << 4) | rows, -- 0xe01a, go->board_info->hpi_buffer_cap, -- 0, 0, -- 0, 0, -- -- 0x2008, 0, -- 0xe402, 0x88, -- 0xe401, 0x8f01, -- 0xbf6a, 0, -- 0xbf6b, 0, -- 0xbf6c, 0, -- 0xbf6d, 0, -- 0xbf6e, 0, -- 0xbf6f, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- -- 0x200e, 0, -- 0xbf66, brc_window_size, -- 0xbf67, 0, -- 0xbf68, q_min, -- 0xbf69, q_max, -- 0xbfe0, 0, -- 0xbfe1, 0, -- 0xbfe2, 0, -- 0xbfe3, go->ipb ? 3 : 1, -- 0xc031, go->board_info->sensor_flags & -- GO7007_SENSOR_VBI ? 1 : 0, -- 0xc01c, 0x1f, -- 0xdd8c, 0x15, -- 0xdd94, 0x15, -- 0xdd88, go->ipb ? 0x1401 : 0x0a01, -- 0xdd90, go->ipb ? 0x1401 : 0x0a01, -- 0, 0, -- -- 0x200e, 0, -- 0xbfe4, 0, -- 0xbfe5, 0, -- 0xbfe6, 0, -- 0xbfe7, fps << 8, -- 0xbfe8, 0x3a00, -- 0xbfe9, 0, -- 0xbfea, 0, -- 0xbfeb, 0, -- 0xbfec, (go->interlace_coding ? 1 << 15 : 0) | -- (go->modet_enable ? 0xa : 0) | -- (go->board_info->sensor_flags & -- GO7007_SENSOR_VBI ? 1 : 0), -- 0xbfed, 0, -- 0xbfee, 0, -- 0xbfef, 0, -- 0xbff0, go->board_info->sensor_flags & -- GO7007_SENSOR_TV ? 0xf060 : 0xb060, -- 0xbff1, 0, -- 0, 0, -- }; -- -- return copy_packages(code, pack, 5, space); --} -- --static int seqhead_to_package(struct go7007 *go, __le16 *code, int space, -- int (*sequence_header_func)(struct go7007 *go, -- unsigned char *buf, int ext)) --{ -- int vop_time_increment_bitlength = vti_bitlen(go); -- int fps = go->sensor_framerate / go->fps_scale * -- (go->interlace_coding ? 2 : 1); -- unsigned char buf[40] = { }; -- int len = sequence_header_func(go, buf, 1); -- u16 pack[] = { -- 0x2006, 0, -- 0xbf08, fps, -- 0xbf09, 0, -- 0xbff2, vop_time_increment_bitlength, -- 0xbff3, (1 << vop_time_increment_bitlength) - 1, -- 0xbfe6, 0, -- 0xbfe7, (fps / 1000) << 8, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- -- 0x2007, 0, -- 0xc800, buf[2] << 8 | buf[3], -- 0xc801, buf[4] << 8 | buf[5], -- 0xc802, buf[6] << 8 | buf[7], -- 0xc803, buf[8] << 8 | buf[9], -- 0xc406, 64, -- 0xc407, len - 64, -- 0xc61b, 1, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- -- 0x200e, 0, -- 0xc808, buf[10] << 8 | buf[11], -- 0xc809, buf[12] << 8 | buf[13], -- 0xc80a, buf[14] << 8 | buf[15], -- 0xc80b, buf[16] << 8 | buf[17], -- 0xc80c, buf[18] << 8 | buf[19], -- 0xc80d, buf[20] << 8 | buf[21], -- 0xc80e, buf[22] << 8 | buf[23], -- 0xc80f, buf[24] << 8 | buf[25], -- 0xc810, buf[26] << 8 | buf[27], -- 0xc811, buf[28] << 8 | buf[29], -- 0xc812, buf[30] << 8 | buf[31], -- 0xc813, buf[32] << 8 | buf[33], -- 0xc814, buf[34] << 8 | buf[35], -- 0xc815, buf[36] << 8 | buf[37], -- 0, 0, -- 0, 0, -- 0, 0, -- }; -- -- return copy_packages(code, pack, 3, space); --} -- --static int relative_prime(int big, int little) --{ -- int remainder; -- -- while (little != 0) { -- remainder = big % little; -- big = little; -- little = remainder; -- } -- return big; --} -- --static int avsync_to_package(struct go7007 *go, __le16 *code, int space) --{ -- int arate = go->board_info->audio_rate * 1001 * go->fps_scale; -- int ratio = arate / go->sensor_framerate; -- int adjratio = ratio * 215 / 100; -- int rprime = relative_prime(go->sensor_framerate, -- arate % go->sensor_framerate); -- int f1 = (arate % go->sensor_framerate) / rprime; -- int f2 = (go->sensor_framerate - arate % go->sensor_framerate) / rprime; -- u16 pack[] = { -- 0x200e, 0, -- 0xbf98, (u16)((-adjratio) & 0xffff), -- 0xbf99, (u16)((-adjratio) >> 16), -- 0xbf92, 0, -- 0xbf93, 0, -- 0xbff4, f1 > f2 ? f1 : f2, -- 0xbff5, f1 < f2 ? f1 : f2, -- 0xbff6, f1 < f2 ? ratio : ratio + 1, -- 0xbff7, f1 > f2 ? ratio : ratio + 1, -- 0xbff8, 0, -- 0xbff9, 0, -- 0xbffa, adjratio & 0xffff, -- 0xbffb, adjratio >> 16, -- 0xbf94, 0, -- 0xbf95, 0, -- 0, 0, -- }; -- -- return copy_packages(code, pack, 1, space); --} -- --static int final_package(struct go7007 *go, __le16 *code, int space) --{ -- int rows = go->interlace_coding ? go->height / 32 : go->height / 16; -- u16 pack[] = { -- 0x8000, -- 0, -- 0, -- 0, -- 0, -- 0, -- 0, -- 2, -- ((go->board_info->sensor_flags & GO7007_SENSOR_TV) && -- (!go->interlace_coding) ? -- (1 << 14) | (1 << 9) : 0) | -- ((go->encoder_subsample ? 1 : 0) << 8) | -- (go->board_info->sensor_flags & -- GO7007_SENSOR_CONFIG_MASK), -- ((go->encoder_v_halve ? 1 : 0) << 14) | -- (go->encoder_v_halve ? rows << 9 : rows << 8) | -- (go->encoder_h_halve ? 1 << 6 : 0) | -- (go->encoder_h_halve ? go->width >> 3 : go->width >> 4), -- (1 << 15) | (go->encoder_v_offset << 6) | -- (1 << 7) | (go->encoder_h_offset >> 2), -- (1 << 6), -- 0, -- 0, -- ((go->fps_scale - 1) << 8) | -- (go->board_info->sensor_flags & GO7007_SENSOR_TV ? -- (1 << 7) : 0) | -- 0x41, -- go->ipb ? 0xd4c : 0x36b, -- (rows << 8) | (go->width >> 4), -- go->format == GO7007_FORMAT_MPEG4 ? 0x0404 : 0, -- (1 << 15) | ((go->interlace_coding ? 1 : 0) << 13) | -- ((go->closed_gop ? 1 : 0) << 12) | -- ((go->format == GO7007_FORMAT_MPEG4 ? 1 : 0) << 11) | -- /* (1 << 9) | */ -- ((go->ipb ? 3 : 0) << 7) | -- ((go->modet_enable ? 1 : 0) << 2) | -- ((go->dvd_mode ? 1 : 0) << 1) | 1, -- (go->format == GO7007_FORMAT_MPEG1 ? 0x89a0 : -- (go->format == GO7007_FORMAT_MPEG2 ? 0x89a0 : -- (go->format == GO7007_FORMAT_MJPEG ? 0x89a0 : -- (go->format == GO7007_FORMAT_MPEG4 ? 0x8920 : -- (go->format == GO7007_FORMAT_H263 ? 0x8920 : 0))))), -- go->ipb ? 0x1f15 : 0x1f0b, -- go->ipb ? 0x0015 : 0x000b, -- go->ipb ? 0xa800 : 0x5800, -- 0xffff, -- 0x0020 + 0x034b * 0, -- 0x0020 + 0x034b * 1, -- 0x0020 + 0x034b * 2, -- 0x0020 + 0x034b * 3, -- 0x0020 + 0x034b * 4, -- 0x0020 + 0x034b * 5, -- go->ipb ? (go->gop_size / 3) : go->gop_size, -- (go->height >> 4) * (go->width >> 4) * 110 / 100, -- }; -- -- return copy_packages(code, pack, 1, space); --} -- --static int audio_to_package(struct go7007 *go, __le16 *code, int space) --{ -- int clock_config = ((go->board_info->audio_flags & -- GO7007_AUDIO_I2S_MASTER ? 1 : 0) << 11) | -- ((go->board_info->audio_flags & -- GO7007_AUDIO_OKI_MODE ? 1 : 0) << 8) | -- (((go->board_info->audio_bclk_div / 4) - 1) << 4) | -- (go->board_info->audio_main_div - 1); -- u16 pack[] = { -- 0x200d, 0, -- 0x9002, 0, -- 0x9002, 0, -- 0x9031, 0, -- 0x9032, 0, -- 0x9033, 0, -- 0x9034, 0, -- 0x9035, 0, -- 0x9036, 0, -- 0x9037, 0, -- 0x9040, 0, -- 0x9000, clock_config, -- 0x9001, (go->board_info->audio_flags & 0xffff) | -- (1 << 9), -- 0x9000, ((go->board_info->audio_flags & -- GO7007_AUDIO_I2S_MASTER ? -- 1 : 0) << 10) | -- clock_config, -- 0, 0, -- 0, 0, -- 0x2005, 0, -- 0x9041, 0, -- 0x9042, 256, -- 0x9043, 0, -- 0x9044, 16, -- 0x9045, 16, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- 0, 0, -- }; -- -- return copy_packages(code, pack, 2, space); --} -- --static int modet_to_package(struct go7007 *go, __le16 *code, int space) --{ -- int ret, mb, i, addr, cnt = 0; -- u16 pack[32]; -- u16 thresholds[] = { -- 0x200e, 0, -- 0xbf82, go->modet[0].pixel_threshold, -- 0xbf83, go->modet[1].pixel_threshold, -- 0xbf84, go->modet[2].pixel_threshold, -- 0xbf85, go->modet[3].pixel_threshold, -- 0xbf86, go->modet[0].motion_threshold, -- 0xbf87, go->modet[1].motion_threshold, -- 0xbf88, go->modet[2].motion_threshold, -- 0xbf89, go->modet[3].motion_threshold, -- 0xbf8a, go->modet[0].mb_threshold, -- 0xbf8b, go->modet[1].mb_threshold, -- 0xbf8c, go->modet[2].mb_threshold, -- 0xbf8d, go->modet[3].mb_threshold, -- 0xbf8e, 0, -- 0xbf8f, 0, -- 0, 0, -- }; -- -- ret = copy_packages(code, thresholds, 1, space); -- if (ret < 0) -- return -1; -- cnt += ret; -- -- addr = 0xbac0; -- memset(pack, 0, 64); -- i = 0; -- for (mb = 0; mb < 1624; ++mb) { -- pack[i * 2 + 3] <<= 2; -- pack[i * 2 + 3] |= go->modet_map[mb]; -- if (mb % 8 != 7) -- continue; -- pack[i * 2 + 2] = addr++; -- ++i; -- if (i == 10 || mb == 1623) { -- pack[0] = 0x2000 | i; -- ret = copy_packages(code + cnt, pack, 1, space - cnt); -- if (ret < 0) -- return -1; -- cnt += ret; -- i = 0; -- memset(pack, 0, 64); -- } -- pack[i * 2 + 3] = 0; -- } -- -- memset(pack, 0, 64); -- i = 0; -- for (addr = 0xbb90; addr < 0xbbfa; ++addr) { -- pack[i * 2 + 2] = addr; -- pack[i * 2 + 3] = 0; -- ++i; -- if (i == 10 || addr == 0xbbf9) { -- pack[0] = 0x2000 | i; -- ret = copy_packages(code + cnt, pack, 1, space - cnt); -- if (ret < 0) -- return -1; -- cnt += ret; -- i = 0; -- memset(pack, 0, 64); -- } -- } -- return cnt; --} -- --static int do_special(struct go7007 *go, u16 type, __le16 *code, int space, -- int *framelen) --{ -- switch (type) { -- case SPECIAL_FRM_HEAD: -- switch (go->format) { -- case GO7007_FORMAT_MJPEG: -- return gen_mjpeghdr_to_package(go, code, space); -- case GO7007_FORMAT_MPEG1: -- case GO7007_FORMAT_MPEG2: -- return gen_mpeg1hdr_to_package(go, code, space, -- framelen); -- case GO7007_FORMAT_MPEG4: -- return gen_mpeg4hdr_to_package(go, code, space, -- framelen); -- } -- case SPECIAL_BRC_CTRL: -- return brctrl_to_package(go, code, space, framelen); -- case SPECIAL_CONFIG: -- return config_package(go, code, space); -- case SPECIAL_SEQHEAD: -- switch (go->format) { -- case GO7007_FORMAT_MPEG1: -- case GO7007_FORMAT_MPEG2: -- return seqhead_to_package(go, code, space, -- mpeg1_sequence_header); -- case GO7007_FORMAT_MPEG4: -- return seqhead_to_package(go, code, space, -- mpeg4_sequence_header); -- default: -- return 0; -- } -- case SPECIAL_AV_SYNC: -- return avsync_to_package(go, code, space); -- case SPECIAL_FINAL: -- return final_package(go, code, space); -- case SPECIAL_AUDIO: -- return audio_to_package(go, code, space); -- case SPECIAL_MODET: -- return modet_to_package(go, code, space); -- } -- printk(KERN_ERR -- "go7007: firmware file contains unsupported feature %04x\n", -- type); -- return -1; --} -- --int go7007_construct_fw_image(struct go7007 *go, u8 **fw, int *fwlen) --{ -- const struct firmware *fw_entry; -- __le16 *code, *src; -- int framelen[8] = { }; /* holds the lengths of empty frame templates */ -- int codespace = 64 * 1024, i = 0, srclen, chunk_len, chunk_flags; -- int mode_flag; -- int ret; -- -- switch (go->format) { -- case GO7007_FORMAT_MJPEG: -- mode_flag = FLAG_MODE_MJPEG; -- break; -- case GO7007_FORMAT_MPEG1: -- mode_flag = FLAG_MODE_MPEG1; -- break; -- case GO7007_FORMAT_MPEG2: -- mode_flag = FLAG_MODE_MPEG2; -- break; -- case GO7007_FORMAT_MPEG4: -- mode_flag = FLAG_MODE_MPEG4; -- break; -- default: -- return -1; -- } -- if (request_firmware(&fw_entry, go->board_info->firmware, go->dev)) { -- printk(KERN_ERR -- "go7007: unable to load firmware from file \"%s\"\n", -- go->board_info->firmware); -- return -1; -- } -- code = kmalloc(codespace * 2, GFP_KERNEL); -- if (code == NULL) { -- printk(KERN_ERR "go7007: unable to allocate %d bytes for " -- "firmware construction\n", codespace * 2); -- goto fw_failed; -- } -- memset(code, 0, codespace * 2); -- src = (__le16 *)fw_entry->data; -- srclen = fw_entry->size / 2; -- while (srclen >= 2) { -- chunk_flags = __le16_to_cpu(src[0]); -- chunk_len = __le16_to_cpu(src[1]); -- if (chunk_len + 2 > srclen) { -- printk(KERN_ERR "go7007: firmware file \"%s\" " -- "appears to be corrupted\n", -- go->board_info->firmware); -- goto fw_failed; -- } -- if (chunk_flags & mode_flag) { -- if (chunk_flags & FLAG_SPECIAL) { -- ret = do_special(go, __le16_to_cpu(src[2]), -- &code[i], codespace - i, framelen); -- if (ret < 0) { -- printk(KERN_ERR "go7007: insufficient " -- "memory for firmware " -- "construction\n"); -- goto fw_failed; -- } -- i += ret; -- } else { -- if (codespace - i < chunk_len) { -- printk(KERN_ERR "go7007: insufficient " -- "memory for firmware " -- "construction\n"); -- goto fw_failed; -- } -- memcpy(&code[i], &src[2], chunk_len * 2); -- i += chunk_len; -- } -- } -- srclen -= chunk_len + 2; -- src += chunk_len + 2; -- } -- release_firmware(fw_entry); -- *fw = (u8 *)code; -- *fwlen = i * 2; -- return 0; -- --fw_failed: -- kfree(code); -- release_firmware(fw_entry); -- return -1; --} ---- a/drivers/staging/go7007/go7007.h -+++ /dev/null -@@ -1,114 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * Permission is hereby granted, free of charge, to any person obtaining a -- * copy of this software and the associated README documentation file (the -- * "Software"), to deal in the Software without restriction, including -- * without limitation the rights to use, copy, modify, merge, publish, -- * distribute, sublicense, and/or sell copies of the Software, and to -- * permit persons to whom the Software is furnished to do so. -- * -- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS -- * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF -- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. -- * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY -- * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, -- * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE -- * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. -- */ -- --/* DEPRECATED -- use V4L2_PIX_FMT_MPEG and then call GO7007IOC_S_MPEG_PARAMS -- * to select between MPEG1, MPEG2, and MPEG4 */ --#define V4L2_PIX_FMT_MPEG4 v4l2_fourcc('M', 'P', 'G', '4') /* MPEG4 */ -- --/* These will be replaced with a better interface -- * soon, so don't get too attached to them */ --#define GO7007IOC_S_BITRATE _IOW('V', BASE_VIDIOC_PRIVATE + 0, int) --#define GO7007IOC_G_BITRATE _IOR('V', BASE_VIDIOC_PRIVATE + 1, int) -- --enum go7007_aspect_ratio { -- GO7007_ASPECT_RATIO_1_1 = 0, -- GO7007_ASPECT_RATIO_4_3_NTSC = 1, -- GO7007_ASPECT_RATIO_4_3_PAL = 2, -- GO7007_ASPECT_RATIO_16_9_NTSC = 3, -- GO7007_ASPECT_RATIO_16_9_PAL = 4, --}; -- --/* Used to set generic compression parameters */ --struct go7007_comp_params { -- __u32 gop_size; -- __u32 max_b_frames; -- enum go7007_aspect_ratio aspect_ratio; -- __u32 flags; -- __u32 reserved[8]; --}; -- --#define GO7007_COMP_CLOSED_GOP 0x00000001 --#define GO7007_COMP_OMIT_SEQ_HEADER 0x00000002 -- --enum go7007_mpeg_video_standard { -- GO7007_MPEG_VIDEO_MPEG1 = 0, -- GO7007_MPEG_VIDEO_MPEG2 = 1, -- GO7007_MPEG_VIDEO_MPEG4 = 2, --}; -- --/* Used to set parameters for V4L2_PIX_FMT_MPEG format */ --struct go7007_mpeg_params { -- enum go7007_mpeg_video_standard mpeg_video_standard; -- __u32 flags; -- __u32 pali; -- __u32 reserved[8]; --}; -- --#define GO7007_MPEG_FORCE_DVD_MODE 0x00000001 --#define GO7007_MPEG_OMIT_GOP_HEADER 0x00000002 --#define GO7007_MPEG_REPEAT_SEQHEADER 0x00000004 -- --#define GO7007_MPEG_PROFILE(format, pali) (((format)<<24)|(pali)) -- --#define GO7007_MPEG2_PROFILE_MAIN_MAIN GO7007_MPEG_PROFILE(2, 0x48) -- --#define GO7007_MPEG4_PROFILE_S_L0 GO7007_MPEG_PROFILE(4, 0x08) --#define GO7007_MPEG4_PROFILE_S_L1 GO7007_MPEG_PROFILE(4, 0x01) --#define GO7007_MPEG4_PROFILE_S_L2 GO7007_MPEG_PROFILE(4, 0x02) --#define GO7007_MPEG4_PROFILE_S_L3 GO7007_MPEG_PROFILE(4, 0x03) --#define GO7007_MPEG4_PROFILE_ARTS_L1 GO7007_MPEG_PROFILE(4, 0x91) --#define GO7007_MPEG4_PROFILE_ARTS_L2 GO7007_MPEG_PROFILE(4, 0x92) --#define GO7007_MPEG4_PROFILE_ARTS_L3 GO7007_MPEG_PROFILE(4, 0x93) --#define GO7007_MPEG4_PROFILE_ARTS_L4 GO7007_MPEG_PROFILE(4, 0x94) --#define GO7007_MPEG4_PROFILE_AS_L0 GO7007_MPEG_PROFILE(4, 0xf0) --#define GO7007_MPEG4_PROFILE_AS_L1 GO7007_MPEG_PROFILE(4, 0xf1) --#define GO7007_MPEG4_PROFILE_AS_L2 GO7007_MPEG_PROFILE(4, 0xf2) --#define GO7007_MPEG4_PROFILE_AS_L3 GO7007_MPEG_PROFILE(4, 0xf3) --#define GO7007_MPEG4_PROFILE_AS_L4 GO7007_MPEG_PROFILE(4, 0xf4) --#define GO7007_MPEG4_PROFILE_AS_L5 GO7007_MPEG_PROFILE(4, 0xf5) -- --struct go7007_md_params { -- __u16 region; -- __u16 trigger; -- __u16 pixel_threshold; -- __u16 motion_threshold; -- __u32 reserved[8]; --}; -- --struct go7007_md_region { -- __u16 region; -- __u16 flags; -- struct v4l2_clip *clips; -- __u32 reserved[8]; --}; -- --#define GO7007IOC_S_MPEG_PARAMS _IOWR('V', BASE_VIDIOC_PRIVATE + 2, \ -- struct go7007_mpeg_params) --#define GO7007IOC_G_MPEG_PARAMS _IOR('V', BASE_VIDIOC_PRIVATE + 3, \ -- struct go7007_mpeg_params) --#define GO7007IOC_S_COMP_PARAMS _IOWR('V', BASE_VIDIOC_PRIVATE + 4, \ -- struct go7007_comp_params) --#define GO7007IOC_G_COMP_PARAMS _IOR('V', BASE_VIDIOC_PRIVATE + 5, \ -- struct go7007_comp_params) --#define GO7007IOC_S_MD_PARAMS _IOWR('V', BASE_VIDIOC_PRIVATE + 6, \ -- struct go7007_md_params) --#define GO7007IOC_G_MD_PARAMS _IOR('V', BASE_VIDIOC_PRIVATE + 7, \ -- struct go7007_md_params) --#define GO7007IOC_S_MD_REGION _IOW('V', BASE_VIDIOC_PRIVATE + 8, \ -- struct go7007_md_region) ---- a/drivers/staging/go7007/go7007-i2c.c -+++ /dev/null -@@ -1,225 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/delay.h> --#include <linux/sched.h> --#include <linux/list.h> --#include <linux/unistd.h> --#include <linux/time.h> --#include <linux/device.h> --#include <linux/i2c.h> --#include <linux/semaphore.h> --#include <linux/uaccess.h> --#include <asm/system.h> -- --#include "go7007-priv.h" --#include "wis-i2c.h" -- --/********************* Driver for on-board I2C adapter *********************/ -- --/* #define GO7007_I2C_DEBUG */ -- --#define SPI_I2C_ADDR_BASE 0x1400 --#define STATUS_REG_ADDR (SPI_I2C_ADDR_BASE + 0x2) --#define I2C_CTRL_REG_ADDR (SPI_I2C_ADDR_BASE + 0x6) --#define I2C_DEV_UP_ADDR_REG_ADDR (SPI_I2C_ADDR_BASE + 0x7) --#define I2C_LO_ADDR_REG_ADDR (SPI_I2C_ADDR_BASE + 0x8) --#define I2C_DATA_REG_ADDR (SPI_I2C_ADDR_BASE + 0x9) --#define I2C_CLKFREQ_REG_ADDR (SPI_I2C_ADDR_BASE + 0xa) -- --#define I2C_STATE_MASK 0x0007 --#define I2C_READ_READY_MASK 0x0008 -- --/* There is only one I2C port on the TW2804 that feeds all four GO7007 VIPs -- * on the Adlink PCI-MPG24, so access is shared between all of them. */ --static DECLARE_MUTEX(adlink_mpg24_i2c_lock); -- --static int go7007_i2c_xfer(struct go7007 *go, u16 addr, int read, -- u16 command, int flags, u8 *data) --{ -- int i, ret = -1; -- u16 val; -- -- if (go->status == STATUS_SHUTDOWN) -- return -1; -- --#ifdef GO7007_I2C_DEBUG -- if (read) -- printk(KERN_DEBUG "go7007-i2c: reading 0x%02x on 0x%02x\n", -- command, addr); -- else -- printk(KERN_DEBUG -- "go7007-i2c: writing 0x%02x to 0x%02x on 0x%02x\n", -- *data, command, addr); --#endif -- -- down(&go->hw_lock); -- -- if (go->board_id == GO7007_BOARDID_ADLINK_MPG24) { -- /* Bridge the I2C port on this GO7007 to the shared bus */ -- down(&adlink_mpg24_i2c_lock); -- go7007_write_addr(go, 0x3c82, 0x0020); -- } -- -- /* Wait for I2C adapter to be ready */ -- for (i = 0; i < 10; ++i) { -- if (go7007_read_addr(go, STATUS_REG_ADDR, &val) < 0) -- goto i2c_done; -- if (!(val & I2C_STATE_MASK)) -- break; -- msleep(100); -- } -- if (i == 10) { -- printk(KERN_ERR "go7007-i2c: I2C adapter is hung\n"); -- goto i2c_done; -- } -- -- /* Set target register (command) */ -- go7007_write_addr(go, I2C_CTRL_REG_ADDR, flags); -- go7007_write_addr(go, I2C_LO_ADDR_REG_ADDR, command); -- -- /* If we're writing, send the data and target address and we're done */ -- if (!read) { -- go7007_write_addr(go, I2C_DATA_REG_ADDR, *data); -- go7007_write_addr(go, I2C_DEV_UP_ADDR_REG_ADDR, -- (addr << 9) | (command >> 8)); -- ret = 0; -- goto i2c_done; -- } -- -- /* Otherwise, we're reading. First clear i2c_rx_data_rdy. */ -- if (go7007_read_addr(go, I2C_DATA_REG_ADDR, &val) < 0) -- goto i2c_done; -- -- /* Send the target address plus read flag */ -- go7007_write_addr(go, I2C_DEV_UP_ADDR_REG_ADDR, -- (addr << 9) | 0x0100 | (command >> 8)); -- -- /* Wait for i2c_rx_data_rdy */ -- for (i = 0; i < 10; ++i) { -- if (go7007_read_addr(go, STATUS_REG_ADDR, &val) < 0) -- goto i2c_done; -- if (val & I2C_READ_READY_MASK) -- break; -- msleep(100); -- } -- if (i == 10) { -- printk(KERN_ERR "go7007-i2c: I2C adapter is hung\n"); -- goto i2c_done; -- } -- -- /* Retrieve the read byte */ -- if (go7007_read_addr(go, I2C_DATA_REG_ADDR, &val) < 0) -- goto i2c_done; -- *data = val; -- ret = 0; -- --i2c_done: -- if (go->board_id == GO7007_BOARDID_ADLINK_MPG24) { -- /* Isolate the I2C port on this GO7007 from the shared bus */ -- go7007_write_addr(go, 0x3c82, 0x0000); -- up(&adlink_mpg24_i2c_lock); -- } -- up(&go->hw_lock); -- return ret; --} -- --static int go7007_smbus_xfer(struct i2c_adapter *adapter, u16 addr, -- unsigned short flags, char read_write, -- u8 command, int size, union i2c_smbus_data *data) --{ -- struct go7007 *go = i2c_get_adapdata(adapter); -- -- if (size != I2C_SMBUS_BYTE_DATA) -- return -1; -- return go7007_i2c_xfer(go, addr, read_write == I2C_SMBUS_READ, command, -- flags & I2C_CLIENT_SCCB ? 0x10 : 0x00, &data->byte); --} -- --/* VERY LIMITED I2C master xfer function -- only needed because the -- * SMBus functions only support 8-bit commands and the SAA7135 uses -- * 16-bit commands. The I2C interface on the GO7007, as limited as -- * it is, does support this mode. */ -- --static int go7007_i2c_master_xfer(struct i2c_adapter *adapter, -- struct i2c_msg msgs[], int num) --{ -- struct go7007 *go = i2c_get_adapdata(adapter); -- int i; -- -- for (i = 0; i < num; ++i) { -- /* We can only do two things here -- write three bytes, or -- * write two bytes and read one byte. */ -- if (msgs[i].len == 2) { -- if (i + 1 == num || msgs[i].addr != msgs[i + 1].addr || -- (msgs[i].flags & I2C_M_RD) || -- !(msgs[i + 1].flags & I2C_M_RD) || -- msgs[i + 1].len != 1) -- return -1; -- if (go7007_i2c_xfer(go, msgs[i].addr, 1, -- (msgs[i].buf[0] << 8) | msgs[i].buf[1], -- 0x01, &msgs[i + 1].buf[0]) < 0) -- return -1; -- ++i; -- } else if (msgs[i].len == 3) { -- if (msgs[i].flags & I2C_M_RD) -- return -1; -- if (msgs[i].len != 3) -- return -1; -- if (go7007_i2c_xfer(go, msgs[i].addr, 0, -- (msgs[i].buf[0] << 8) | msgs[i].buf[1], -- 0x01, &msgs[i].buf[2]) < 0) -- return -1; -- } else -- return -1; -- } -- -- return 0; --} -- --static u32 go7007_functionality(struct i2c_adapter *adapter) --{ -- return I2C_FUNC_SMBUS_BYTE_DATA; --} -- --static struct i2c_algorithm go7007_algo = { -- .smbus_xfer = go7007_smbus_xfer, -- .master_xfer = go7007_i2c_master_xfer, -- .functionality = go7007_functionality, --}; -- --static struct i2c_adapter go7007_adap_templ = { -- .owner = THIS_MODULE, -- .name = "WIS GO7007SB", -- .algo = &go7007_algo, --}; -- --int go7007_i2c_init(struct go7007 *go) --{ -- memcpy(&go->i2c_adapter, &go7007_adap_templ, -- sizeof(go7007_adap_templ)); -- go->i2c_adapter.dev.parent = go->dev; -- i2c_set_adapdata(&go->i2c_adapter, go); -- if (i2c_add_adapter(&go->i2c_adapter) < 0) { -- printk(KERN_ERR -- "go7007-i2c: error: i2c_add_adapter failed\n"); -- return -1; -- } -- return 0; --} ---- a/drivers/staging/go7007/go7007-priv.h -+++ /dev/null -@@ -1,282 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --/* -- * This is the private include file for the go7007 driver. It should not -- * be included by anybody but the driver itself, and especially not by -- * user-space applications. -- */ -- --struct go7007; -- --/* IDs to activate board-specific support code */ --#define GO7007_BOARDID_MATRIX_II 0 --#define GO7007_BOARDID_MATRIX_RELOAD 1 --#define GO7007_BOARDID_STAR_TREK 2 --#define GO7007_BOARDID_PCI_VOYAGER 3 --#define GO7007_BOARDID_XMEN 4 --#define GO7007_BOARDID_XMEN_II 5 --#define GO7007_BOARDID_XMEN_III 6 --#define GO7007_BOARDID_MATRIX_REV 7 --#define GO7007_BOARDID_PX_M402U 16 --#define GO7007_BOARDID_PX_TV402U_ANY 17 /* need to check tuner model */ --#define GO7007_BOARDID_PX_TV402U_NA 18 /* detected NTSC tuner */ --#define GO7007_BOARDID_PX_TV402U_EU 19 /* detected PAL tuner */ --#define GO7007_BOARDID_PX_TV402U_JP 20 /* detected NTSC-J tuner */ --#define GO7007_BOARDID_LIFEVIEW_LR192 21 /* TV Walker Ultra */ --#define GO7007_BOARDID_ENDURA 22 --#define GO7007_BOARDID_ADLINK_MPG24 23 --#define GO7007_BOARDID_SENSORAY_2250 24 /* Sensoray 2250/2251 */ -- --/* Various characteristics of each board */ --#define GO7007_BOARD_HAS_AUDIO (1<<0) --#define GO7007_BOARD_USE_ONBOARD_I2C (1<<1) --#define GO7007_BOARD_HAS_TUNER (1<<2) -- --/* Characteristics of sensor devices */ --#define GO7007_SENSOR_VALID_POLAR (1<<0) --#define GO7007_SENSOR_HREF_POLAR (1<<1) --#define GO7007_SENSOR_VREF_POLAR (1<<2) --#define GO7007_SENSOR_FIELD_ID_POLAR (1<<3) --#define GO7007_SENSOR_BIT_WIDTH (1<<4) --#define GO7007_SENSOR_VALID_ENABLE (1<<5) --#define GO7007_SENSOR_656 (1<<6) --#define GO7007_SENSOR_CONFIG_MASK 0x7f --#define GO7007_SENSOR_TV (1<<7) --#define GO7007_SENSOR_VBI (1<<8) --#define GO7007_SENSOR_SCALING (1<<9) -- --/* Characteristics of audio sensor devices */ --#define GO7007_AUDIO_I2S_MODE_1 (1) --#define GO7007_AUDIO_I2S_MODE_2 (2) --#define GO7007_AUDIO_I2S_MODE_3 (3) --#define GO7007_AUDIO_BCLK_POLAR (1<<2) --#define GO7007_AUDIO_WORD_14 (14<<4) --#define GO7007_AUDIO_WORD_16 (16<<4) --#define GO7007_AUDIO_ONE_CHANNEL (1<<11) --#define GO7007_AUDIO_I2S_MASTER (1<<16) --#define GO7007_AUDIO_OKI_MODE (1<<17) -- --struct go7007_board_info { -- char *firmware; -- unsigned int flags; -- int hpi_buffer_cap; -- unsigned int sensor_flags; -- int sensor_width; -- int sensor_height; -- int sensor_framerate; -- int sensor_h_offset; -- int sensor_v_offset; -- unsigned int audio_flags; -- int audio_rate; -- int audio_bclk_div; -- int audio_main_div; -- int num_i2c_devs; -- struct { -- const char *type; -- int id; -- int addr; -- } i2c_devs[4]; -- int num_inputs; -- struct { -- int video_input; -- int audio_input; -- char *name; -- } inputs[4]; --}; -- --struct go7007_hpi_ops { -- int (*interface_reset)(struct go7007 *go); -- int (*write_interrupt)(struct go7007 *go, int addr, int data); -- int (*read_interrupt)(struct go7007 *go); -- int (*stream_start)(struct go7007 *go); -- int (*stream_stop)(struct go7007 *go); -- int (*send_firmware)(struct go7007 *go, u8 *data, int len); -- int (*send_command)(struct go7007 *go, unsigned int cmd, void *arg); --}; -- --/* The video buffer size must be a multiple of PAGE_SIZE */ --#define GO7007_BUF_PAGES (128 * 1024 / PAGE_SIZE) --#define GO7007_BUF_SIZE (GO7007_BUF_PAGES << PAGE_SHIFT) -- --struct go7007_buffer { -- struct go7007 *go; /* Reverse reference for VMA ops */ -- int index; /* Reverse reference for DQBUF */ -- enum { BUF_STATE_IDLE, BUF_STATE_QUEUED, BUF_STATE_DONE } state; -- u32 seq; -- struct timeval timestamp; -- struct list_head stream; -- struct page *pages[GO7007_BUF_PAGES + 1]; /* extra for straddling */ -- unsigned long user_addr; -- unsigned int page_count; -- unsigned int offset; -- unsigned int bytesused; -- unsigned int frame_offset; -- u32 modet_active; -- int mapped; --}; -- --struct go7007_file { -- struct go7007 *go; -- struct semaphore lock; -- int buf_count; -- struct go7007_buffer *bufs; --}; -- --#define GO7007_FORMAT_MJPEG 0 --#define GO7007_FORMAT_MPEG4 1 --#define GO7007_FORMAT_MPEG1 2 --#define GO7007_FORMAT_MPEG2 3 --#define GO7007_FORMAT_H263 4 -- --#define GO7007_RATIO_1_1 0 --#define GO7007_RATIO_4_3 1 --#define GO7007_RATIO_16_9 2 -- --enum go7007_parser_state { -- STATE_DATA, -- STATE_00, -- STATE_00_00, -- STATE_00_00_01, -- STATE_FF, -- STATE_VBI_LEN_A, -- STATE_VBI_LEN_B, -- STATE_MODET_MAP, -- STATE_UNPARSED, --}; -- --struct go7007 { -- struct device *dev; -- struct go7007_board_info *board_info; -- unsigned int board_id; -- int tuner_type; -- int channel_number; /* for multi-channel boards like Adlink PCI-MPG24 */ -- char name[64]; -- struct video_device *video_dev; -- int ref_count; -- enum { STATUS_INIT, STATUS_ONLINE, STATUS_SHUTDOWN } status; -- spinlock_t spinlock; -- struct semaphore hw_lock; -- int streaming; -- int in_use; -- int audio_enabled; -- -- /* Video input */ -- int input; -- enum { GO7007_STD_NTSC, GO7007_STD_PAL, GO7007_STD_OTHER } standard; -- int sensor_framerate; -- int width; -- int height; -- int encoder_h_offset; -- int encoder_v_offset; -- unsigned int encoder_h_halve:1; -- unsigned int encoder_v_halve:1; -- unsigned int encoder_subsample:1; -- -- /* Encoder config */ -- int format; -- int bitrate; -- int fps_scale; -- int pali; -- int aspect_ratio; -- int gop_size; -- unsigned int ipb:1; -- unsigned int closed_gop:1; -- unsigned int repeat_seqhead:1; -- unsigned int seq_header_enable:1; -- unsigned int gop_header_enable:1; -- unsigned int dvd_mode:1; -- unsigned int interlace_coding:1; -- -- /* Motion detection */ -- unsigned int modet_enable:1; -- struct { -- unsigned int enable:1; -- int pixel_threshold; -- int motion_threshold; -- int mb_threshold; -- } modet[4]; -- unsigned char modet_map[1624]; -- unsigned char active_map[216]; -- -- /* Video streaming */ -- struct go7007_buffer *active_buf; -- enum go7007_parser_state state; -- int parse_length; -- u16 modet_word; -- int seen_frame; -- u32 next_seq; -- struct list_head stream; -- wait_queue_head_t frame_waitq; -- -- /* Audio streaming */ -- void (*audio_deliver)(struct go7007 *go, u8 *buf, int length); -- void *snd_context; -- -- /* I2C */ -- int i2c_adapter_online; -- struct i2c_adapter i2c_adapter; -- -- /* HPI driver */ -- struct go7007_hpi_ops *hpi_ops; -- void *hpi_context; -- int interrupt_available; -- wait_queue_head_t interrupt_waitq; -- unsigned short interrupt_value; -- unsigned short interrupt_data; --}; -- --/* All of these must be called with the hpi_lock semaphore held! */ --#define go7007_interface_reset(go) \ -- ((go)->hpi_ops->interface_reset(go)) --#define go7007_write_interrupt(go, x, y) \ -- ((go)->hpi_ops->write_interrupt)((go), (x), (y)) --#define go7007_stream_start(go) \ -- ((go)->hpi_ops->stream_start(go)) --#define go7007_stream_stop(go) \ -- ((go)->hpi_ops->stream_stop(go)) --#define go7007_send_firmware(go, x, y) \ -- ((go)->hpi_ops->send_firmware)((go), (x), (y)) --#define go7007_write_addr(go, x, y) \ -- ((go)->hpi_ops->write_interrupt)((go), (x)|0x8000, (y)) -- --/* go7007-driver.c */ --int go7007_read_addr(struct go7007 *go, u16 addr, u16 *data); --int go7007_read_interrupt(struct go7007 *go, u16 *value, u16 *data); --int go7007_boot_encoder(struct go7007 *go, int init_i2c); --int go7007_reset_encoder(struct go7007 *go); --int go7007_register_encoder(struct go7007 *go); --int go7007_start_encoder(struct go7007 *go); --void go7007_parse_video_stream(struct go7007 *go, u8 *buf, int length); --struct go7007 *go7007_alloc(struct go7007_board_info *board, -- struct device *dev); --void go7007_remove(struct go7007 *go); -- --/* go7007-fw.c */ --int go7007_construct_fw_image(struct go7007 *go, u8 **fw, int *fwlen); -- --/* go7007-i2c.c */ --int go7007_i2c_init(struct go7007 *go); --int go7007_i2c_remove(struct go7007 *go); -- --/* go7007-v4l2.c */ --int go7007_v4l2_init(struct go7007 *go); --void go7007_v4l2_remove(struct go7007 *go); -- --/* snd-go7007.c */ --int go7007_snd_init(struct go7007 *go); --int go7007_snd_remove(struct go7007 *go); ---- a/drivers/staging/go7007/go7007.txt -+++ /dev/null -@@ -1,481 +0,0 @@ --This is a driver for the WIS GO7007SB multi-format video encoder. -- --Pete Eberlein <pete@sensoray.com> -- --The driver was originally released under the GPL and is currently hosted at: --http://nikosapi.org/wiki/index.php/WIS_Go7007_Linux_driver --The go7007 firmware can be acquired from the package on the site above. -- --I've modified the driver to support the following Video4Linux2 MPEG --controls, with acceptable values: -- --V4L2_CID_MPEG_STREAM_TYPE V4L2_MPEG_STREAM_TYPE_MPEG2_DVD -- V4L2_MPEG_STREAM_TYPE_MPEG_ELEM --V4L2_CID_MPEG_VIDEO_ENCODING V4L2_MPEG_VIDEO_ENCODING_MPEG_1 -- V4L2_MPEG_VIDEO_ENCODING_MPEG_2 -- V4L2_MPEG_VIDEO_ENCODING_MPEG_4 --V4L2_CID_MPEG_VIDEO_ASPECT V4L2_MPEG_VIDEO_ASPECT_1x1 -- V4L2_MPEG_VIDEO_ASPECT_4x3 -- V4L2_MPEG_VIDEO_ASPECT_16x9 --V4L2_CID_MPEG_VIDEO_GOP_SIZE integer --V4L2_CID_MPEG_VIDEO_BITRATE 64000 .. 10000000 -- --These should be used instead of the non-standard GO7007 ioctls described --below. -- -- --The README files from the original package appears below: -- ----------------------------------------------------------------------------- -- WIS GO7007SB Public Linux Driver ----------------------------------------------------------------------------- -- -- --*** Please see the file RELEASE-NOTES for important last-minute updates *** -- -- -- 0. OVERVIEW AND LICENSING/DISCLAIMER -- -- --This driver kit contains Linux drivers for the WIS GO7007SB multi-format --video encoder. Only kernel version 2.6.x is supported. The video stream --is available through the Video4Linux2 API and the audio stream is available --through the ALSA API (or the OSS emulation layer of the ALSA system). -- --The files in kernel/ and hotplug/ are licensed under the GNU General Public --License Version 2 from the Free Software Foundation. A copy of the license --is included in the file COPYING. -- --The example applications in apps/ and C header files in include/ are --licensed under a permissive license included in the source files which --allows copying, modification and redistribution for any purpose without --attribution. -- --The firmware files included in the firmware/ directory may be freely --redistributed only in conjunction with this document; but modification, --tampering and reverse engineering are prohibited. -- --MICRONAS USA, INC., MAKES NO WARRANTIES TO ANY PERSON OR ENTITY WITH --RESPECT TO THE SOFTWARE OR ANY DERIVATIVES THEREOF OR ANY SERVICES OR --LICENSES AND DISCLAIMS ALL IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION --WARRANTIES OF MERCHANTABILITY, SUPPORT, AND FITNESS FOR A PARTICULAR --PURPOSE AND NON-INFRINGEMENT. -- -- -- 1. SYSTEM REQUIREMENTS -- -- --This driver requires Linux kernel 2.6. Kernel 2.4 is not supported. Using --kernel 2.6.10 or later is recommended, as earlier kernels are known to have --unstable USB 2.0 support. -- --A fully built kernel source tree must be available. Typically this will be --linked from "/lib/modules/<KERNEL VERSION>/build" for convenience. If this --link does not exist, an extra parameter will need to be passed to the --`make` command. -- --All vendor-built kernels should already be configured properly. However, --for custom-built kernels, the following options need to be enabled in the --kernel as built-in or modules: -- -- CONFIG_HOTPLUG - Support for hot-pluggable devices -- CONFIG_MODULES - Enable loadable module support -- CONFIG_KMOD - Automatic kernel module loading -- CONFIG_FW_LOADER - Hotplug firmware loading support -- CONFIG_I2C - I2C support -- CONFIG_VIDEO_DEV - Video For Linux -- CONFIG_SOUND - Sound card support -- CONFIG_SND - Advanced Linux Sound Architecture -- CONFIG_USB - Support for Host-side USB -- CONFIG_USB_DEVICEFS - USB device filesystem -- CONFIG_USB_EHCI_HCD - EHCI HCD (USB 2.0) support -- --Additionally, to use the example application, the following options need to --be enabled in the ALSA section: -- -- CONFIG_SND_MIXER_OSS - OSS Mixer API -- CONFIG_SND_PCM_OSS - OSS PCM (digital audio) API -- --The hotplug scripts, along with the fxload utility, must also be installed. --These scripts can be obtained from <http://linux-hotplug.sourceforge.net/>. --Hotplugging is used for loading firmware into the Cypruss EZ-USB chip using --fxload and for loading firmware into the driver using the firmware agent. -- -- -- 2. COMPILING AND INSTALLING THE DRIVER -- -- --Most users should be able to compile the driver by simply running: -- -- $ make -- --in the top-level directory of the driver kit. First the kernel modules --will be built, followed by the example applications. -- --If the build system is unable to locate the kernel source tree for the --currently-running kernel, or if the module should be built for a kernel --other than the currently-running kernel, an additional parameter will need --to be passed to make to specify the appropriate kernel source directory: -- -- $ make KERNELSRC=/usr/src/linux-2.6.10-custom3 -- --Once the compile completes, the driver and firmware files should be --installed by running: -- -- $ make install -- --The kernel modules will be placed in "/lib/modules/<KERNEL VERSION>/extra" --and the firmware files will be placed in the appropriate hotplug firmware --directory, usually /lib/firmware. In addition, USB maps and scripts will --be placed in /etc/hotplug/usb to enable fxload to initialize the EZ-USB --control chip when the device is connected. -- -- -- 3. PAL/SECAM TUNER CONFIGURATION (TV402U-EU only) -- -- --The PAL model of the Plextor ConvertX TV402U may require additional --configuration to correctly select the appropriate TV frequency band and --audio subchannel. -- --Users with a device other than the Plextor ConvertX TV402U-EU should skip --this section. -- --The wide variety of PAL TV systems used in Europe requires that additional --information about the local TV standards be passed to the driver in order --to properly tune TV channels. The two necessary parameters are (a) the PAL --TV band, and (b) the audio subchannel format in use. -- --In many cases, the appropriate TV band selection is passed to the driver --from applications. However, in some cases, the application only specifies --that the driver should use PAL but not the specific information about the --appropriate TV band. To work around this issue, the correct TV band may be --specified in the "force_band" parameter to the wis-sony-tuner module: -- -- TV band force_band -- ------- ---------- -- PAL B/G B -- PAL I I -- PAL D/K D -- SECAM L L -- --If the "force_band" parameter is specified, the driver will ignore any TV --band specified by applications and will always use the band provided in the --module parameter. -- --The other parameter that can be specified is the audio subchannel format. --There are several stereo audio carrier systems in use, including NICAM and --three varieties of A2. To receive audio broadcast on one of these stereo --carriers, the "force_mpx_mode" parameter must be specified to the --wis-sony-tuner module. -- -- TV band Audio subcarrier force_mpx_mode -- ------- ---------------- -------------- -- PAL B/G Mono (default) 1 -- PAL B/G A2 2 -- PAL B/G NICAM 3 -- PAL I Mono (default) 4 -- PAL I NICAM 5 -- PAL D/K Mono (default) 6 -- PAL D/K A2 (1) 7 -- PAL D/K A2 (2) 8 -- PAL D/K A2 (3) 9 -- PAL D/K NICAM 10 -- SECAM L Mono (default) 11 -- SECAM L NICAM 12 -- --If the "force_mpx_mode" parameter is not specified, the correct mono-only --mode will be chosen based on the TV band. However, the tuner will not --receive stereo audio or bilingual broadcasts correctly. -- --To pass the "force_band" or "force_mpx_mode" parameters to the --wis-sony-tuner module, the following line must be added to the modprobe --configuration file, which varies from one Linux distribution to another. -- -- options wis-sony-tuner force_band=B force_mpx_mode=2 -- --The above example would force the tuner to the PAL B/G TV band and receive --stereo audio broadcasts on the A2 carrier. -- --To verify that the configuration has been placed in the correct location, --execute: -- -- $ modprobe -c | grep wis-sony-tuner -- --If the configuration line appears, then modprobe will pass the parameters --correctly the next time the wis-sony-tuner module is loaded into the --kernel. -- -- -- 4. TESTING THE DRIVER -- -- --Because few Linux applications are able to correctly capture from --Video4Linux2 devices with only compressed formats supported, the new driver --should be tested with the "gorecord" application in the apps/ directory. -- --First connect a video source to the device, such as a DVD player or VCR. --This will be captured to a file for testing the driver. If an input source --is unavailable, a test file can still be captured, but the video will be --black and the audio will be silent. -- --This application will auto-detect the V4L2 and ALSA/OSS device names of the --hardware and will record video and audio to an AVI file for a specified --number of seconds. For example: -- -- $ apps/gorecord -duration 60 capture.avi -- --If this application does not successfully record an AVI file, the error --messages produced by gorecord and recorded in the system log (usually in --/var/log/messages) should provide information to help resolve the problem. -- --Supplying no parameters to gorecord will cause it to probe the available --devices and exit. Use the -help flag for usage information. -- -- -- 5. USING THE DRIVER -- -- --The V4L2 device implemented by the driver provides a standard compressed --format API, within the following criteria: -- -- * Applications that only support the original Video4Linux1 API will not -- be able to communicate with this driver at all. -- -- * No raw video modes are supported, so applications like xawtv that -- expect only uncompressed video will not function. -- -- * Supported compression formats are: Motion-JPEG, MPEG1, MPEG2 and MPEG4. -- -- * MPEG video formats are delivered as Video Elementary Streams only. -- Program Stream (PS), Transport Stream (TS) and Packetized Elementary -- Stream (PES) formats are not supported. -- -- * Video parameters such as format and input port may not be changed while -- the encoder is active. -- -- * The audio capture device only functions when the video encoder is -- actively capturing video. Attempts to read from the audio device when -- the encoder is inactive will result in an I/O error. -- -- * The native format of the audio device is 48Khz 2-channel 16-bit -- little-endian PCM, delivered through the ALSA system. No audio -- compression is implemented in the hardware. ALSA may convert to other -- uncompressed formats on the fly. -- --The include/ directory contains a C header file describing non-standard --features of the GO7007SB encoder, which are described below: -- -- -- GO7007IOC_S_COMP_PARAMS, GO7007IOC_G_COMP_PARAMS -- -- These ioctls are used to negotiate general compression parameters. -- -- To query the current parameters, call the GO7007IOC_G_COMP_PARAMS ioctl -- with a pointer to a struct go7007_comp_params. If the driver is not -- set to MPEG format, the EINVAL error code will be returned. -- -- To change the current parameters, initialize all fields of a struct -- go7007_comp_params and call the GO7007_IOC_S_COMP_PARAMS ioctl with a -- pointer to this structure. The driver will return the current -- parameters with any necessary changes to conform to the limitations of -- the hardware or current compression mode. Any or all fields can be set -- to zero to request a reasonable default value. If the driver is not -- set to MPEG format, the EINVAL error code will be returned. When I/O -- is in progress, the EBUSY error code will be returned. -- -- Fields in struct go7007_comp_params: -- -- __u32 The maximum number of frames in each -- gop_size Group Of Pictures; i.e. the maximum -- number of frames minus one between -- each key frame. -- -- __u32 The maximum number of sequential -- max_b_frames bidirectionally-predicted frames. -- (B-frames are not yet supported.) -- -- enum go7007_aspect_ratio The aspect ratio to be encoded in the -- aspect_ratio meta-data of the compressed format. -- -- Choices are: -- GO7007_ASPECT_RATIO_1_1 -- GO7007_ASPECT_RATIO_4_3_NTSC -- GO7007_ASPECT_RATIO_4_3_PAL -- GO7007_ASPECT_RATIO_16_9_NTSC -- GO7007_ASPECT_RATIO_16_9_PAL -- -- __u32 Bit-wise OR of control flags (below) -- flags -- -- Flags in struct go7007_comp_params: -- -- GO7007_COMP_CLOSED_GOP Only produce self-contained GOPs, used -- to produce streams appropriate for -- random seeking. -- -- GO7007_COMP_OMIT_SEQ_HEADER Omit the stream sequence header. -- -- -- GO7007IOC_S_MPEG_PARAMS, GO7007IOC_G_MPEG_PARAMS -- -- These ioctls are used to negotiate MPEG-specific stream parameters when -- the pixelformat has been set to V4L2_PIX_FMT_MPEG. -- -- To query the current parameters, call the GO7007IOC_G_MPEG_PARAMS ioctl -- with a pointer to a struct go7007_mpeg_params. If the driver is not -- set to MPEG format, the EINVAL error code will be returned. -- -- To change the current parameters, initialize all fields of a struct -- go7007_mpeg_params and call the GO7007_IOC_S_MPEG_PARAMS ioctl with a -- pointer to this structure. The driver will return the current -- parameters with any necessary changes to conform to the limitations of -- the hardware or selected MPEG mode. Any or all fields can be set to -- zero to request a reasonable default value. If the driver is not set -- to MPEG format, the EINVAL error code will be returned. When I/O is in -- progress, the EBUSY error code will be returned. -- -- Fields in struct go7007_mpeg_params: -- -- enum go7007_mpeg_video_standard -- mpeg_video_standard The MPEG video standard in which to -- compress the video. -- -- Choices are: -- GO7007_MPEG_VIDEO_MPEG1 -- GO7007_MPEG_VIDEO_MPEG2 -- GO7007_MPEG_VIDEO_MPEG4 -- -- __u32 Bit-wise OR of control flags (below) -- flags -- -- __u32 The profile and level indication to be -- pali stored in the sequence header. This -- is only used as an indicator to the -- decoder, and does not affect the MPEG -- features used in the video stream. -- Not valid for MPEG1. -- -- Choices for MPEG2 are: -- GO7007_MPEG2_PROFILE_MAIN_MAIN -- -- Choices for MPEG4 are: -- GO7007_MPEG4_PROFILE_S_L0 -- GO7007_MPEG4_PROFILE_S_L1 -- GO7007_MPEG4_PROFILE_S_L2 -- GO7007_MPEG4_PROFILE_S_L3 -- GO7007_MPEG4_PROFILE_ARTS_L1 -- GO7007_MPEG4_PROFILE_ARTS_L2 -- GO7007_MPEG4_PROFILE_ARTS_L3 -- GO7007_MPEG4_PROFILE_ARTS_L4 -- GO7007_MPEG4_PROFILE_AS_L0 -- GO7007_MPEG4_PROFILE_AS_L1 -- GO7007_MPEG4_PROFILE_AS_L2 -- GO7007_MPEG4_PROFILE_AS_L3 -- GO7007_MPEG4_PROFILE_AS_L4 -- GO7007_MPEG4_PROFILE_AS_L5 -- -- Flags in struct go7007_mpeg_params: -- -- GO7007_MPEG_FORCE_DVD_MODE Force all compression parameters and -- bitrate control settings to comply -- with DVD MPEG2 stream requirements. -- This overrides most compression and -- bitrate settings! -- -- GO7007_MPEG_OMIT_GOP_HEADER Omit the GOP header. -- -- GO7007_MPEG_REPEAT_SEQHEADER Repeat the MPEG sequence header at -- the start of each GOP. -- -- -- GO7007IOC_S_BITRATE, GO7007IOC_G_BITRATE -- -- These ioctls are used to set and query the target bitrate value for the -- compressed video stream. The bitrate may be selected by storing the -- target bits per second in an int and calling GO7007IOC_S_BITRATE with a -- pointer to the int. The bitrate may be queried by calling -- GO7007IOC_G_BITRATE with a pointer to an int where the current bitrate -- will be stored. -- -- Note that this is the primary means of controlling the video quality -- for all compression modes, including V4L2_PIX_FMT_MJPEG. The -- VIDIOC_S_JPEGCOMP ioctl is not supported. -- -- ------------------------------------------------------------------------------ -- Installing the WIS PCI Voyager Driver ----------------------------------------------------------------------------- -- --The WIS PCI Voyager driver requires several patches to the Linux 2.6.11.x --kernel source tree before compiling the driver. These patches update the --in-kernel SAA7134 driver to the newest development version and patch bugs --in the TDA8290/TDA8275 tuner driver. -- --The following patches must be downloaded from Gerd Knorr's website and --applied in the order listed: -- -- http://dl.bytesex.org/patches/2.6.11-2/i2c-tuner -- http://dl.bytesex.org/patches/2.6.11-2/i2c-tuner2 -- http://dl.bytesex.org/patches/2.6.11-2/v4l2-api-mpeg -- http://dl.bytesex.org/patches/2.6.11-2/saa7134-update -- --The following patches are included with this SDK and can be applied in any --order: -- -- patches/2.6.11/saa7134-voyager.diff -- patches/2.6.11/tda8275-newaddr.diff -- patches/2.6.11/tda8290-ntsc.diff -- --Check to make sure the CONFIG_VIDEO_SAA7134 option is enabled in the kernel --configuration, and build and install the kernel. -- --After rebooting into the new kernel, the GO7007 driver can be compiled and --installed: -- -- $ make SAA7134_BUILD=y -- $ make install -- $ modprobe saa7134-go7007 -- --There will be two V4L video devices associated with the PCI Voyager. The --first device (most likely /dev/video0) provides access to the raw video --capture mode of the SAA7133 device and is used to configure the source --video parameters and tune the TV tuner. This device can be used with xawtv --or other V4L(2) video software as a standard uncompressed device. -- --The second device (most likely /dev/video1) provides access to the --compression functions of the GO7007. It can be tested using the gorecord --application in the apps/ directory of this SDK: -- -- $ apps/gorecord -vdevice /dev/video1 -noaudio test.avi -- --Currently the frame resolution is fixed at 720x480 (NTSC) or 720x576 (PAL), --and the video standard must be specified to both the raw and the compressed --video devices (xawtv and gorecord, for example). -- -- ---------------------------------------------------------------------------- --RELEASE NOTES FOR WIS GO7007SB LINUX DRIVER ----------------------------------------------------------------------------- -- --Last updated: 5 November 2005 -- -- - Release 0.9.7 includes new support for using udev to run fxload. The -- install script should automatically detect whether the old hotplug -- scripts or the new udev rules should be used. To force the use of -- hotplug, run "make install USE_UDEV=n". To force the use of udev, run -- "make install USE_UDEV=y". -- -- - Motion detection is supported but undocumented. Try the `modet` app -- for a demonstration of how to use the facility. -- -- - Using USB2.0 devices such as the TV402U with USB1.1 HCDs or hubs can -- cause buffer overruns and frame drops, even at low framerates, due to -- inconsistency in the bitrate control mechanism. -- -- - On devices with an SAA7115, including the Plextor ConvertX, video height -- values of 96, 128, 160, 192, 256, 320, and 384 do not work in NTSC mode. -- All valid heights up to 512 work correctly in PAL mode. -- -- - The WIS Star Trek and PCI Voyager boards have no support yet for audio -- or the TV tuner. ---- a/drivers/staging/go7007/go7007-usb.c -+++ /dev/null -@@ -1,1287 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#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/time.h> --#include <linux/mm.h> --#include <linux/usb.h> --#include <linux/i2c.h> --#include <asm/byteorder.h> --#include <media/tvaudio.h> -- --#include "go7007-priv.h" --#include "wis-i2c.h" -- --static unsigned int assume_endura; --module_param(assume_endura, int, 0644); --MODULE_PARM_DESC(assume_endura, "when probing fails, hardware is a Pelco Endura"); -- --/* #define GO7007_USB_DEBUG */ --/* #define GO7007_I2C_DEBUG */ /* for debugging the EZ-USB I2C adapter */ -- --#define HPI_STATUS_ADDR 0xFFF4 --#define INT_PARAM_ADDR 0xFFF6 --#define INT_INDEX_ADDR 0xFFF8 -- --/* -- * Pipes on EZ-USB interface: -- * 0 snd - Control -- * 0 rcv - Control -- * 2 snd - Download firmware (control) -- * 4 rcv - Read Interrupt (interrupt) -- * 6 rcv - Read Video (bulk) -- * 8 rcv - Read Audio (bulk) -- */ -- --#define GO7007_USB_EZUSB (1<<0) --#define GO7007_USB_EZUSB_I2C (1<<1) -- --struct go7007_usb_board { -- unsigned int flags; -- struct go7007_board_info main_info; --}; -- --struct go7007_usb { -- struct go7007_usb_board *board; -- struct semaphore i2c_lock; -- struct usb_device *usbdev; -- struct urb *video_urbs[8]; -- struct urb *audio_urbs[8]; -- struct urb *intr_urb; --}; -- --/*********************** Product specification data ***********************/ -- --static struct go7007_usb_board board_matrix_ii = { -- .flags = GO7007_USB_EZUSB, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_HAS_AUDIO | -- GO7007_BOARD_USE_ONBOARD_I2C, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_VALID_ENABLE | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI | -- GO7007_SENSOR_SCALING, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "wis_saa7115", -- .id = I2C_DRIVERID_WIS_SAA7115, -- .addr = 0x20, -- }, -- }, -- .num_inputs = 2, -- .inputs = { -- { -- .video_input = 0, -- .name = "Composite", -- }, -- { -- .video_input = 9, -- .name = "S-Video", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_matrix_reload = { -- .flags = GO7007_USB_EZUSB, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_HAS_AUDIO | -- GO7007_BOARD_USE_ONBOARD_I2C, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_I2S_MASTER | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_TV, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "wis_saa7113", -- .id = I2C_DRIVERID_WIS_SAA7113, -- .addr = 0x25, -- }, -- }, -- .num_inputs = 2, -- .inputs = { -- { -- .video_input = 0, -- .name = "Composite", -- }, -- { -- .video_input = 9, -- .name = "S-Video", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_star_trek = { -- .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_HAS_AUDIO, /* | -- GO7007_BOARD_HAS_TUNER, */ -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_VALID_ENABLE | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI | -- GO7007_SENSOR_SCALING, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_WORD_16, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "wis_saa7115", -- .id = I2C_DRIVERID_WIS_SAA7115, -- .addr = 0x20, -- }, -- }, -- .num_inputs = 2, -- .inputs = { -- { -- .video_input = 1, -- /* .audio_input = AUDIO_EXTERN, */ -- .name = "Composite", -- }, -- { -- .video_input = 8, -- /* .audio_input = AUDIO_EXTERN, */ -- .name = "S-Video", -- }, -- /* { -- * .video_input = 3, -- * .audio_input = AUDIO_TUNER, -- * .name = "Tuner", -- * }, -- */ -- }, -- }, --}; -- --static struct go7007_usb_board board_px_tv402u = { -- .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_HAS_AUDIO | -- GO7007_BOARD_HAS_TUNER, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_VALID_ENABLE | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI | -- GO7007_SENSOR_SCALING, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_WORD_16, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .num_i2c_devs = 3, -- .i2c_devs = { -- { -- .type = "wis_saa7115", -- .id = I2C_DRIVERID_WIS_SAA7115, -- .addr = 0x20, -- }, -- { -- .type = "wis_uda1342", -- .id = I2C_DRIVERID_WIS_UDA1342, -- .addr = 0x1a, -- }, -- { -- .type = "wis_sony_tuner", -- .id = I2C_DRIVERID_WIS_SONY_TUNER, -- .addr = 0x60, -- }, -- }, -- .num_inputs = 3, -- .inputs = { -- { -- .video_input = 1, -- .audio_input = TVAUDIO_INPUT_EXTERN, -- .name = "Composite", -- }, -- { -- .video_input = 8, -- .audio_input = TVAUDIO_INPUT_EXTERN, -- .name = "S-Video", -- }, -- { -- .video_input = 3, -- .audio_input = TVAUDIO_INPUT_TUNER, -- .name = "Tuner", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_xmen = { -- .flags = 0, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_USE_ONBOARD_I2C, -- .hpi_buffer_cap = 0, -- .sensor_flags = GO7007_SENSOR_VREF_POLAR, -- .sensor_width = 320, -- .sensor_height = 240, -- .sensor_framerate = 30030, -- .audio_flags = GO7007_AUDIO_ONE_CHANNEL | -- GO7007_AUDIO_I2S_MODE_3 | -- GO7007_AUDIO_WORD_14 | -- GO7007_AUDIO_I2S_MASTER | -- GO7007_AUDIO_BCLK_POLAR | -- GO7007_AUDIO_OKI_MODE, -- .audio_rate = 8000, -- .audio_bclk_div = 48, -- .audio_main_div = 1, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "wis_ov7640", -- .id = I2C_DRIVERID_WIS_OV7640, -- .addr = 0x21, -- }, -- }, -- .num_inputs = 1, -- .inputs = { -- { -- .name = "Camera", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_matrix_revolution = { -- .flags = GO7007_USB_EZUSB, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_HAS_AUDIO | -- GO7007_BOARD_USE_ONBOARD_I2C, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_I2S_MASTER | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "wis_tw9903", -- .id = I2C_DRIVERID_WIS_TW9903, -- .addr = 0x44, -- }, -- }, -- .num_inputs = 2, -- .inputs = { -- { -- .video_input = 2, -- .name = "Composite", -- }, -- { -- .video_input = 8, -- .name = "S-Video", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_lifeview_lr192 = { -- .flags = GO7007_USB_EZUSB, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_HAS_AUDIO | -- GO7007_BOARD_USE_ONBOARD_I2C, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_VALID_ENABLE | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI | -- GO7007_SENSOR_SCALING, -- .num_i2c_devs = 0, -- .num_inputs = 1, -- .inputs = { -- { -- .video_input = 0, -- .name = "Composite", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_endura = { -- .flags = 0, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = 0, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_I2S_MASTER | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 8000, -- .audio_bclk_div = 48, -- .audio_main_div = 8, -- .hpi_buffer_cap = 0, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_TV, -- .sensor_h_offset = 8, -- .num_i2c_devs = 0, -- .num_inputs = 1, -- .inputs = { -- { -- .name = "Camera", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_adlink_mpg24 = { -- .flags = 0, -- .main_info = { -- .firmware = "go7007tv.bin", -- .flags = GO7007_BOARD_USE_ONBOARD_I2C, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_I2S_MASTER | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 0, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "wis_twTW2804", -- .id = I2C_DRIVERID_WIS_TW2804, -- .addr = 0x00, /* yes, really */ -- }, -- }, -- .num_inputs = 1, -- .inputs = { -- { -- .name = "Composite", -- }, -- }, -- }, --}; -- --static struct go7007_usb_board board_sensoray_2250 = { -- .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C, -- .main_info = { -- .firmware = "go7007tv.bin", -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_I2S_MASTER | -- GO7007_AUDIO_WORD_16, -- .flags = GO7007_BOARD_HAS_AUDIO, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_TV, -- .num_i2c_devs = 1, -- .i2c_devs = { -- { -- .type = "s2250_board", -- .id = I2C_DRIVERID_S2250, -- .addr = 0x43, -- }, -- }, -- .num_inputs = 2, -- .inputs = { -- { -- .video_input = 0, -- .name = "Composite", -- }, -- { -- .video_input = 1, -- .name = "S-Video", -- }, -- }, -- }, --}; -- --static struct usb_device_id go7007_usb_id_table[] = { -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION | -- USB_DEVICE_ID_MATCH_INT_INFO, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x200, /* Revision number of XMen */ -- .bcdDevice_hi = 0x200, -- .bInterfaceClass = 255, -- .bInterfaceSubClass = 0, -- .bInterfaceProtocol = 255, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x202, /* Revision number of Matrix II */ -- .bcdDevice_hi = 0x202, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_II, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x204, /* Revision number of Matrix */ -- .bcdDevice_hi = 0x204, /* Reloaded */ -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_RELOAD, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION | -- USB_DEVICE_ID_MATCH_INT_INFO, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x205, /* Revision number of XMen-II */ -- .bcdDevice_hi = 0x205, -- .bInterfaceClass = 255, -- .bInterfaceSubClass = 0, -- .bInterfaceProtocol = 255, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN_II, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x208, /* Revision number of Star Trek */ -- .bcdDevice_hi = 0x208, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_STAR_TREK, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION | -- USB_DEVICE_ID_MATCH_INT_INFO, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x209, /* Revision number of XMen-III */ -- .bcdDevice_hi = 0x209, -- .bInterfaceClass = 255, -- .bInterfaceSubClass = 0, -- .bInterfaceProtocol = 255, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN_III, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ -- .idProduct = 0x7007, /* Product ID of GO7007SB chip */ -- .bcdDevice_lo = 0x210, /* Revision number of Matrix */ -- .bcdDevice_hi = 0x210, /* Revolution */ -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_REV, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x093b, /* Vendor ID of Plextor */ -- .idProduct = 0xa102, /* Product ID of M402U */ -- .bcdDevice_lo = 0x1, /* revision number of Blueberry */ -- .bcdDevice_hi = 0x1, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_PX_M402U, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x093b, /* Vendor ID of Plextor */ -- .idProduct = 0xa104, /* Product ID of TV402U */ -- .bcdDevice_lo = 0x1, -- .bcdDevice_hi = 0x1, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_PX_TV402U_ANY, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x10fd, /* Vendor ID of Anubis Electronics */ -- .idProduct = 0xde00, /* Product ID of Lifeview LR192 */ -- .bcdDevice_lo = 0x1, -- .bcdDevice_hi = 0x1, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_LIFEVIEW_LR192, -- }, -- { -- .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, -- .idVendor = 0x1943, /* Vendor ID Sensoray */ -- .idProduct = 0x2250, /* Product ID of 2250/2251 */ -- .bcdDevice_lo = 0x1, -- .bcdDevice_hi = 0x1, -- .driver_info = (kernel_ulong_t)GO7007_BOARDID_SENSORAY_2250, -- }, -- { } /* Terminating entry */ --}; -- --MODULE_DEVICE_TABLE(usb, go7007_usb_id_table); -- --/********************* Driver for EZ-USB HPI interface *********************/ -- --static int go7007_usb_vendor_request(struct go7007 *go, int request, -- int value, int index, void *transfer_buffer, int length, int in) --{ -- struct go7007_usb *usb = go->hpi_context; -- int timeout = 5000; -- -- if (in) { -- return usb_control_msg(usb->usbdev, -- usb_rcvctrlpipe(usb->usbdev, 0), request, -- USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, -- value, index, transfer_buffer, length, timeout); -- } else { -- return usb_control_msg(usb->usbdev, -- usb_sndctrlpipe(usb->usbdev, 0), request, -- USB_TYPE_VENDOR | USB_RECIP_DEVICE, -- value, index, transfer_buffer, length, timeout); -- } --} -- --static int go7007_usb_interface_reset(struct go7007 *go) --{ -- struct go7007_usb *usb = go->hpi_context; -- u16 intr_val, intr_data; -- -- /* Reset encoder */ -- if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0) -- return -1; -- msleep(100); -- -- if (usb->board->flags & GO7007_USB_EZUSB) { -- /* Reset buffer in EZ-USB */ --#ifdef GO7007_USB_DEBUG -- printk(KERN_DEBUG "go7007-usb: resetting EZ-USB buffers\n"); --#endif -- if (go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0 || -- go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0) -- return -1; -- -- /* Reset encoder again */ -- if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0) -- return -1; -- msleep(100); -- } -- -- /* Wait for an interrupt to indicate successful hardware reset */ -- if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 || -- (intr_val & ~0x1) != 0x55aa) { -- printk(KERN_ERR -- "go7007-usb: unable to reset the USB interface\n"); -- return -1; -- } -- return 0; --} -- --static int go7007_usb_ezusb_write_interrupt(struct go7007 *go, -- int addr, int data) --{ -- struct go7007_usb *usb = go->hpi_context; -- int i, r; -- u16 status_reg; -- int timeout = 500; -- --#ifdef GO7007_USB_DEBUG -- printk(KERN_DEBUG -- "go7007-usb: WriteInterrupt: %04x %04x\n", addr, data); --#endif -- -- for (i = 0; i < 100; ++i) { -- r = usb_control_msg(usb->usbdev, -- usb_rcvctrlpipe(usb->usbdev, 0), 0x14, -- USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, -- 0, HPI_STATUS_ADDR, &status_reg, -- sizeof(status_reg), timeout); -- if (r < 0) -- goto write_int_error; -- __le16_to_cpus(&status_reg); -- if (!(status_reg & 0x0010)) -- break; -- msleep(10); -- } -- if (i == 100) { -- printk(KERN_ERR -- "go7007-usb: device is hung, status reg = 0x%04x\n", -- status_reg); -- return -1; -- } -- r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0), 0x12, -- USB_TYPE_VENDOR | USB_RECIP_DEVICE, data, -- INT_PARAM_ADDR, NULL, 0, timeout); -- if (r < 0) -- goto write_int_error; -- r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0), -- 0x12, USB_TYPE_VENDOR | USB_RECIP_DEVICE, addr, -- INT_INDEX_ADDR, NULL, 0, timeout); -- if (r < 0) -- goto write_int_error; -- return 0; -- --write_int_error: -- printk(KERN_ERR "go7007-usb: error in WriteInterrupt: %d\n", r); -- return r; --} -- --static int go7007_usb_onboard_write_interrupt(struct go7007 *go, -- int addr, int data) --{ -- struct go7007_usb *usb = go->hpi_context; -- u8 *tbuf; -- int r; -- int timeout = 500; -- --#ifdef GO7007_USB_DEBUG -- printk(KERN_DEBUG -- "go7007-usb: WriteInterrupt: %04x %04x\n", addr, data); --#endif -- -- tbuf = kmalloc(8, GFP_KERNEL); -- if (tbuf == NULL) -- return -ENOMEM; -- memset(tbuf, 0, 8); -- tbuf[0] = data & 0xff; -- tbuf[1] = data >> 8; -- tbuf[2] = addr & 0xff; -- tbuf[3] = addr >> 8; -- r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 2), 0x00, -- USB_TYPE_VENDOR | USB_RECIP_ENDPOINT, 0x55aa, -- 0xf0f0, tbuf, 8, timeout); -- kfree(tbuf); -- if (r < 0) { -- printk(KERN_ERR "go7007-usb: error in WriteInterrupt: %d\n", r); -- return r; -- } -- return 0; --} -- --static void go7007_usb_readinterrupt_complete(struct urb *urb) --{ -- struct go7007 *go = (struct go7007 *)urb->context; -- u16 *regs = (u16 *)urb->transfer_buffer; -- int status = urb->status; -- -- if (status) { -- if (status != -ESHUTDOWN && -- go->status != STATUS_SHUTDOWN) { -- printk(KERN_ERR -- "go7007-usb: error in read interrupt: %d\n", -- urb->status); -- } else { -- wake_up(&go->interrupt_waitq); -- return; -- } -- } else if (urb->actual_length != urb->transfer_buffer_length) { -- printk(KERN_ERR "go7007-usb: short read in interrupt pipe!\n"); -- } else { -- go->interrupt_available = 1; -- go->interrupt_data = __le16_to_cpu(regs[0]); -- go->interrupt_value = __le16_to_cpu(regs[1]); --#ifdef GO7007_USB_DEBUG -- printk(KERN_DEBUG "go7007-usb: ReadInterrupt: %04x %04x\n", -- go->interrupt_value, go->interrupt_data); --#endif -- } -- -- wake_up(&go->interrupt_waitq); --} -- --static int go7007_usb_read_interrupt(struct go7007 *go) --{ -- struct go7007_usb *usb = go->hpi_context; -- int r; -- -- r = usb_submit_urb(usb->intr_urb, GFP_KERNEL); -- if (r < 0) { -- printk(KERN_ERR -- "go7007-usb: unable to submit interrupt urb: %d\n", r); -- return r; -- } -- return 0; --} -- --static void go7007_usb_read_video_pipe_complete(struct urb *urb) --{ -- struct go7007 *go = (struct go7007 *)urb->context; -- int r, status = urb-> status; -- -- if (!go->streaming) { -- wake_up_interruptible(&go->frame_waitq); -- return; -- } -- if (status) { -- printk(KERN_ERR "go7007-usb: error in video pipe: %d\n", status); -- return; -- } -- if (urb->actual_length != urb->transfer_buffer_length) { -- printk(KERN_ERR "go7007-usb: short read in video pipe!\n"); -- return; -- } -- go7007_parse_video_stream(go, urb->transfer_buffer, urb->actual_length); -- r = usb_submit_urb(urb, GFP_ATOMIC); -- if (r < 0) -- printk(KERN_ERR "go7007-usb: error in video pipe: %d\n", r); --} -- --static void go7007_usb_read_audio_pipe_complete(struct urb *urb) --{ -- struct go7007 *go = (struct go7007 *)urb->context; -- int r, status = urb->status; -- -- if (!go->streaming) -- return; -- if (status) { -- printk(KERN_ERR "go7007-usb: error in audio pipe: %d\n", status); -- return; -- } -- if (urb->actual_length != urb->transfer_buffer_length) { -- printk(KERN_ERR "go7007-usb: short read in audio pipe!\n"); -- return; -- } -- if (go->audio_deliver != NULL) -- go->audio_deliver(go, urb->transfer_buffer, urb->actual_length); -- r = usb_submit_urb(urb, GFP_ATOMIC); -- if (r < 0) -- printk(KERN_ERR "go7007-usb: error in audio pipe: %d\n", r); --} -- --static int go7007_usb_stream_start(struct go7007 *go) --{ -- struct go7007_usb *usb = go->hpi_context; -- int i, r; -- -- for (i = 0; i < 8; ++i) { -- r = usb_submit_urb(usb->video_urbs[i], GFP_KERNEL); -- if (r < 0) { -- printk(KERN_ERR "go7007-usb: error submitting video " -- "urb %d: %d\n", i, r); -- goto video_submit_failed; -- } -- } -- if (!go->audio_enabled) -- return 0; -- -- for (i = 0; i < 8; ++i) { -- r = usb_submit_urb(usb->audio_urbs[i], GFP_KERNEL); -- if (r < 0) { -- printk(KERN_ERR "go7007-usb: error submitting audio " -- "urb %d: %d\n", i, r); -- goto audio_submit_failed; -- } -- } -- return 0; -- --audio_submit_failed: -- for (i = 0; i < 7; ++i) -- usb_kill_urb(usb->audio_urbs[i]); --video_submit_failed: -- for (i = 0; i < 8; ++i) -- usb_kill_urb(usb->video_urbs[i]); -- return -1; --} -- --static int go7007_usb_stream_stop(struct go7007 *go) --{ -- struct go7007_usb *usb = go->hpi_context; -- int i; -- -- if (go->status == STATUS_SHUTDOWN) -- return 0; -- for (i = 0; i < 8; ++i) -- usb_kill_urb(usb->video_urbs[i]); -- if (go->audio_enabled) -- for (i = 0; i < 8; ++i) -- usb_kill_urb(usb->audio_urbs[i]); -- return 0; --} -- --static int go7007_usb_send_firmware(struct go7007 *go, u8 *data, int len) --{ -- struct go7007_usb *usb = go->hpi_context; -- int transferred, pipe; -- int timeout = 500; -- --#ifdef GO7007_USB_DEBUG -- printk(KERN_DEBUG "go7007-usb: DownloadBuffer sending %d bytes\n", len); --#endif -- -- if (usb->board->flags & GO7007_USB_EZUSB) -- pipe = usb_sndbulkpipe(usb->usbdev, 2); -- else -- pipe = usb_sndbulkpipe(usb->usbdev, 3); -- -- return usb_bulk_msg(usb->usbdev, pipe, data, len, -- &transferred, timeout); --} -- --static struct go7007_hpi_ops go7007_usb_ezusb_hpi_ops = { -- .interface_reset = go7007_usb_interface_reset, -- .write_interrupt = go7007_usb_ezusb_write_interrupt, -- .read_interrupt = go7007_usb_read_interrupt, -- .stream_start = go7007_usb_stream_start, -- .stream_stop = go7007_usb_stream_stop, -- .send_firmware = go7007_usb_send_firmware, --}; -- --static struct go7007_hpi_ops go7007_usb_onboard_hpi_ops = { -- .interface_reset = go7007_usb_interface_reset, -- .write_interrupt = go7007_usb_onboard_write_interrupt, -- .read_interrupt = go7007_usb_read_interrupt, -- .stream_start = go7007_usb_stream_start, -- .stream_stop = go7007_usb_stream_stop, -- .send_firmware = go7007_usb_send_firmware, --}; -- --/********************* Driver for EZ-USB I2C adapter *********************/ -- --static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter, -- struct i2c_msg msgs[], int num) --{ -- struct go7007 *go = i2c_get_adapdata(adapter); -- struct go7007_usb *usb = go->hpi_context; -- u8 buf[16]; -- int buf_len, i; -- int ret = -1; -- -- if (go->status == STATUS_SHUTDOWN) -- return -1; -- -- down(&usb->i2c_lock); -- -- for (i = 0; i < num; ++i) { -- /* The hardware command is "write some bytes then read some -- * bytes", so we try to coalesce a write followed by a read -- * into a single USB transaction */ -- if (i + 1 < num && msgs[i].addr == msgs[i + 1].addr && -- !(msgs[i].flags & I2C_M_RD) && -- (msgs[i + 1].flags & I2C_M_RD)) { --#ifdef GO7007_I2C_DEBUG -- printk(KERN_DEBUG "go7007-usb: i2c write/read %d/%d " -- "bytes on %02x\n", msgs[i].len, -- msgs[i + 1].len, msgs[i].addr); --#endif -- buf[0] = 0x01; -- buf[1] = msgs[i].len + 1; -- buf[2] = msgs[i].addr << 1; -- memcpy(&buf[3], msgs[i].buf, msgs[i].len); -- buf_len = msgs[i].len + 3; -- buf[buf_len++] = msgs[++i].len; -- } else if (msgs[i].flags & I2C_M_RD) { --#ifdef GO7007_I2C_DEBUG -- printk(KERN_DEBUG "go7007-usb: i2c read %d " -- "bytes on %02x\n", msgs[i].len, -- msgs[i].addr); --#endif -- buf[0] = 0x01; -- buf[1] = 1; -- buf[2] = msgs[i].addr << 1; -- buf[3] = msgs[i].len; -- buf_len = 4; -- } else { --#ifdef GO7007_I2C_DEBUG -- printk(KERN_DEBUG "go7007-usb: i2c write %d " -- "bytes on %02x\n", msgs[i].len, -- msgs[i].addr); --#endif -- buf[0] = 0x00; -- buf[1] = msgs[i].len + 1; -- buf[2] = msgs[i].addr << 1; -- memcpy(&buf[3], msgs[i].buf, msgs[i].len); -- buf_len = msgs[i].len + 3; -- buf[buf_len++] = 0; -- } -- if (go7007_usb_vendor_request(go, 0x24, 0, 0, -- buf, buf_len, 0) < 0) -- goto i2c_done; -- if (msgs[i].flags & I2C_M_RD) { -- memset(buf, 0, sizeof(buf)); -- if (go7007_usb_vendor_request(go, 0x25, 0, 0, buf, -- msgs[i].len + 1, 1) < 0) -- goto i2c_done; -- memcpy(msgs[i].buf, buf + 1, msgs[i].len); -- } -- } -- ret = 0; -- --i2c_done: -- up(&usb->i2c_lock); -- return ret; --} -- --static u32 go7007_usb_functionality(struct i2c_adapter *adapter) --{ -- /* No errors are reported by the hardware, so we don't bother -- * supporting quick writes to avoid confusing probing */ -- return (I2C_FUNC_SMBUS_EMUL) & ~I2C_FUNC_SMBUS_QUICK; --} -- --static struct i2c_algorithm go7007_usb_algo = { -- .master_xfer = go7007_usb_i2c_master_xfer, -- .functionality = go7007_usb_functionality, --}; -- --static struct i2c_adapter go7007_usb_adap_templ = { -- .owner = THIS_MODULE, -- .name = "WIS GO7007SB EZ-USB", -- .algo = &go7007_usb_algo, --}; -- --/********************* USB add/remove functions *********************/ -- --static int go7007_usb_probe(struct usb_interface *intf, -- const struct usb_device_id *id) --{ -- struct go7007 *go; -- struct go7007_usb *usb; -- struct go7007_usb_board *board; -- struct usb_device *usbdev = interface_to_usbdev(intf); -- char *name; -- int video_pipe, i, v_urb_len; -- -- printk(KERN_DEBUG "go7007-usb: probing new GO7007 USB board\n"); -- -- switch (id->driver_info) { -- case GO7007_BOARDID_MATRIX_II: -- name = "WIS Matrix II or compatible"; -- board = &board_matrix_ii; -- break; -- case GO7007_BOARDID_MATRIX_RELOAD: -- name = "WIS Matrix Reloaded or compatible"; -- board = &board_matrix_reload; -- break; -- case GO7007_BOARDID_MATRIX_REV: -- name = "WIS Matrix Revolution or compatible"; -- board = &board_matrix_revolution; -- break; -- case GO7007_BOARDID_STAR_TREK: -- name = "WIS Star Trek or compatible"; -- board = &board_star_trek; -- break; -- case GO7007_BOARDID_XMEN: -- name = "WIS XMen or compatible"; -- board = &board_xmen; -- break; -- case GO7007_BOARDID_XMEN_II: -- name = "WIS XMen II or compatible"; -- board = &board_xmen; -- break; -- case GO7007_BOARDID_XMEN_III: -- name = "WIS XMen III or compatible"; -- board = &board_xmen; -- break; -- case GO7007_BOARDID_PX_M402U: -- name = "Plextor PX-M402U"; -- board = &board_matrix_ii; -- break; -- case GO7007_BOARDID_PX_TV402U_ANY: -- name = "Plextor PX-TV402U (unknown tuner)"; -- board = &board_px_tv402u; -- break; -- case GO7007_BOARDID_LIFEVIEW_LR192: -- printk(KERN_ERR "go7007-usb: The Lifeview TV Walker Ultra " -- "is not supported. Sorry!\n"); -- return 0; -- name = "Lifeview TV Walker Ultra"; -- board = &board_lifeview_lr192; -- break; -- case GO7007_BOARDID_SENSORAY_2250: -- printk(KERN_INFO "Sensoray 2250 found\n"); -- name = "Sensoray 2250/2251\n"; -- board = &board_sensoray_2250; -- break; -- default: -- printk(KERN_ERR "go7007-usb: unknown board ID %d!\n", -- (unsigned int)id->driver_info); -- return 0; -- } -- -- usb = kzalloc(sizeof(struct go7007_usb), GFP_KERNEL); -- if (usb == NULL) -- return -ENOMEM; -- -- /* Allocate the URB and buffer for receiving incoming interrupts */ -- usb->intr_urb = usb_alloc_urb(0, GFP_KERNEL); -- if (usb->intr_urb == NULL) -- goto allocfail; -- usb->intr_urb->transfer_buffer = kmalloc(2*sizeof(u16), GFP_KERNEL); -- if (usb->intr_urb->transfer_buffer == NULL) -- goto allocfail; -- -- go = go7007_alloc(&board->main_info, &intf->dev); -- if (go == NULL) -- goto allocfail; -- usb->board = board; -- usb->usbdev = usbdev; -- go->board_id = id->driver_info; -- strncpy(go->name, name, sizeof(go->name)); -- if (board->flags & GO7007_USB_EZUSB) -- go->hpi_ops = &go7007_usb_ezusb_hpi_ops; -- else -- go->hpi_ops = &go7007_usb_onboard_hpi_ops; -- go->hpi_context = usb; -- usb_fill_int_urb(usb->intr_urb, usb->usbdev, -- usb_rcvintpipe(usb->usbdev, 4), -- usb->intr_urb->transfer_buffer, 2*sizeof(u16), -- go7007_usb_readinterrupt_complete, go, 8); -- usb_set_intfdata(intf, go); -- -- /* Boot the GO7007 */ -- if (go7007_boot_encoder(go, go->board_info->flags & -- GO7007_BOARD_USE_ONBOARD_I2C) < 0) -- goto initfail; -- -- /* Register the EZ-USB I2C adapter, if we're using it */ -- if (board->flags & GO7007_USB_EZUSB_I2C) { -- memcpy(&go->i2c_adapter, &go7007_usb_adap_templ, -- sizeof(go7007_usb_adap_templ)); -- init_MUTEX(&usb->i2c_lock); -- go->i2c_adapter.dev.parent = go->dev; -- i2c_set_adapdata(&go->i2c_adapter, go); -- if (i2c_add_adapter(&go->i2c_adapter) < 0) { -- printk(KERN_ERR -- "go7007-usb: error: i2c_add_adapter failed\n"); -- goto initfail; -- } -- go->i2c_adapter_online = 1; -- } -- -- /* Pelco and Adlink reused the XMen and XMen-III vendor and product -- * IDs for their own incompatible designs. We can detect XMen boards -- * by probing the sensor, but there is no way to probe the sensors on -- * the Pelco and Adlink designs so we default to the Adlink. If it -- * is actually a Pelco, the user must set the assume_endura module -- * parameter. */ -- if ((go->board_id == GO7007_BOARDID_XMEN || -- go->board_id == GO7007_BOARDID_XMEN_III) && -- go->i2c_adapter_online) { -- union i2c_smbus_data data; -- -- /* Check to see if register 0x0A is 0x76 */ -- i2c_smbus_xfer(&go->i2c_adapter, 0x21, I2C_CLIENT_SCCB, -- I2C_SMBUS_READ, 0x0A, I2C_SMBUS_BYTE_DATA, &data); -- if (data.byte != 0x76) { -- if (assume_endura) { -- go->board_id = GO7007_BOARDID_ENDURA; -- usb->board = board = &board_endura; -- go->board_info = &board->main_info; -- strncpy(go->name, "Pelco Endura", -- sizeof(go->name)); -- } else { -- u16 channel; -- -- /* set GPIO5 to be an output, currently low */ -- go7007_write_addr(go, 0x3c82, 0x0000); -- go7007_write_addr(go, 0x3c80, 0x00df); -- /* read channel number from GPIO[1:0] */ -- go7007_read_addr(go, 0x3c81, &channel); -- channel &= 0x3; -- go->board_id = GO7007_BOARDID_ADLINK_MPG24; -- usb->board = board = &board_adlink_mpg24; -- go->board_info = &board->main_info; -- go->channel_number = channel; -- snprintf(go->name, sizeof(go->name), -- "Adlink PCI-MPG24, channel #%d", -- channel); -- } -- } -- } -- -- /* Probe the tuner model on the TV402U */ -- if (go->board_id == GO7007_BOARDID_PX_TV402U_ANY) { -- u8 data[3]; -- -- /* Board strapping indicates tuner model */ -- if (go7007_usb_vendor_request(go, 0x41, 0, 0, data, 3, 1) < 0) { -- printk(KERN_ERR "go7007-usb: GPIO read failed!\n"); -- goto initfail; -- } -- switch (data[0] >> 6) { -- case 1: -- go->board_id = GO7007_BOARDID_PX_TV402U_EU; -- go->tuner_type = TUNER_SONY_BTF_PG472Z; -- strncpy(go->name, "Plextor PX-TV402U-EU", -- sizeof(go->name)); -- break; -- case 2: -- go->board_id = GO7007_BOARDID_PX_TV402U_JP; -- go->tuner_type = TUNER_SONY_BTF_PK467Z; -- strncpy(go->name, "Plextor PX-TV402U-JP", -- sizeof(go->name)); -- break; -- case 3: -- go->board_id = GO7007_BOARDID_PX_TV402U_NA; -- go->tuner_type = TUNER_SONY_BTF_PB463Z; -- strncpy(go->name, "Plextor PX-TV402U-NA", -- sizeof(go->name)); -- break; -- default: -- printk(KERN_DEBUG "go7007-usb: unable to detect " -- "tuner type!\n"); -- break; -- } -- /* Configure tuner mode selection inputs connected -- * to the EZ-USB GPIO output pins */ -- if (go7007_usb_vendor_request(go, 0x40, 0x7f02, 0, -- NULL, 0, 0) < 0) { -- printk(KERN_ERR -- "go7007-usb: GPIO write failed!\n"); -- goto initfail; -- } -- } -- -- /* Print a nasty message if the user attempts to use a USB2.0 device in -- * a USB1.1 port. There will be silent corruption of the stream. */ -- if ((board->flags & GO7007_USB_EZUSB) && -- usbdev->speed != USB_SPEED_HIGH) -- printk(KERN_ERR "go7007-usb: *** WARNING *** This device " -- "must be connected to a USB 2.0 port! " -- "Attempting to capture video through a USB 1.1 " -- "port will result in stream corruption, even " -- "at low bitrates!\n"); -- -- /* Do any final GO7007 initialization, then register the -- * V4L2 and ALSA interfaces */ -- if (go7007_register_encoder(go) < 0) -- goto initfail; -- -- /* Allocate the URBs and buffers for receiving the video stream */ -- if (board->flags & GO7007_USB_EZUSB) { -- v_urb_len = 1024; -- video_pipe = usb_rcvbulkpipe(usb->usbdev, 6); -- } else { -- v_urb_len = 512; -- video_pipe = usb_rcvbulkpipe(usb->usbdev, 1); -- } -- for (i = 0; i < 8; ++i) { -- usb->video_urbs[i] = usb_alloc_urb(0, GFP_KERNEL); -- if (usb->video_urbs[i] == NULL) -- goto initfail; -- usb->video_urbs[i]->transfer_buffer = -- kmalloc(v_urb_len, GFP_KERNEL); -- if (usb->video_urbs[i]->transfer_buffer == NULL) -- goto initfail; -- usb_fill_bulk_urb(usb->video_urbs[i], usb->usbdev, video_pipe, -- usb->video_urbs[i]->transfer_buffer, v_urb_len, -- go7007_usb_read_video_pipe_complete, go); -- } -- -- /* Allocate the URBs and buffers for receiving the audio stream */ -- if ((board->flags & GO7007_USB_EZUSB) && go->audio_enabled) -- for (i = 0; i < 8; ++i) { -- usb->audio_urbs[i] = usb_alloc_urb(0, GFP_KERNEL); -- if (usb->audio_urbs[i] == NULL) -- goto initfail; -- usb->audio_urbs[i]->transfer_buffer = kmalloc(4096, -- GFP_KERNEL); -- if (usb->audio_urbs[i]->transfer_buffer == NULL) -- goto initfail; -- usb_fill_bulk_urb(usb->audio_urbs[i], usb->usbdev, -- usb_rcvbulkpipe(usb->usbdev, 8), -- usb->audio_urbs[i]->transfer_buffer, 4096, -- go7007_usb_read_audio_pipe_complete, go); -- } -- -- -- go->status = STATUS_ONLINE; -- return 0; -- --initfail: -- go->status = STATUS_SHUTDOWN; -- return 0; -- --allocfail: -- if (usb->intr_urb) { -- kfree(usb->intr_urb->transfer_buffer); -- usb_free_urb(usb->intr_urb); -- } -- kfree(usb); -- return -ENOMEM; --} -- --static void go7007_usb_disconnect(struct usb_interface *intf) --{ -- struct go7007 *go = usb_get_intfdata(intf); -- struct go7007_usb *usb = go->hpi_context; -- struct urb *vurb, *aurb; -- int i; -- -- go->status = STATUS_SHUTDOWN; -- usb_kill_urb(usb->intr_urb); -- -- /* Free USB-related structs */ -- for (i = 0; i < 8; ++i) { -- vurb = usb->video_urbs[i]; -- if (vurb) { -- usb_kill_urb(vurb); -- if (vurb->transfer_buffer) -- kfree(vurb->transfer_buffer); -- usb_free_urb(vurb); -- } -- aurb = usb->audio_urbs[i]; -- if (aurb) { -- usb_kill_urb(aurb); -- if (aurb->transfer_buffer) -- kfree(aurb->transfer_buffer); -- usb_free_urb(aurb); -- } -- } -- kfree(usb->intr_urb->transfer_buffer); -- usb_free_urb(usb->intr_urb); -- -- kfree(go->hpi_context); -- -- go7007_remove(go); --} -- --static struct usb_driver go7007_usb_driver = { -- .name = "go7007", -- .probe = go7007_usb_probe, -- .disconnect = go7007_usb_disconnect, -- .id_table = go7007_usb_id_table, --}; -- --static int __init go7007_usb_init(void) --{ -- return usb_register(&go7007_usb_driver); --} -- --static void __exit go7007_usb_cleanup(void) --{ -- usb_deregister(&go7007_usb_driver); --} -- --module_init(go7007_usb_init); --module_exit(go7007_usb_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/go7007-v4l2.c -+++ /dev/null -@@ -1,1876 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/version.h> --#include <linux/delay.h> --#include <linux/sched.h> --#include <linux/spinlock.h> --#include <linux/fs.h> --#include <linux/unistd.h> --#include <linux/time.h> --#include <linux/vmalloc.h> --#include <linux/pagemap.h> --#include <linux/videodev2.h> --#include <media/v4l2-common.h> --#include <media/v4l2-ioctl.h> --#include <linux/i2c.h> --#include <linux/semaphore.h> --#include <linux/uaccess.h> --#include <asm/system.h> -- --#include "go7007.h" --#include "go7007-priv.h" --#include "wis-i2c.h" -- --/* Temporary defines until accepted in v4l-dvb */ --#ifndef V4L2_MPEG_STREAM_TYPE_MPEG_ELEM --#define V4L2_MPEG_STREAM_TYPE_MPEG_ELEM 6 /* MPEG elementary stream */ --#endif --#ifndef V4L2_MPEG_VIDEO_ENCODING_MPEG_4 --#define V4L2_MPEG_VIDEO_ENCODING_MPEG_4 3 --#endif -- --static void deactivate_buffer(struct go7007_buffer *gobuf) --{ -- int i; -- -- if (gobuf->state != BUF_STATE_IDLE) { -- list_del(&gobuf->stream); -- gobuf->state = BUF_STATE_IDLE; -- } -- if (gobuf->page_count > 0) { -- for (i = 0; i < gobuf->page_count; ++i) -- page_cache_release(gobuf->pages[i]); -- gobuf->page_count = 0; -- } --} -- --static void abort_queued(struct go7007 *go) --{ -- struct go7007_buffer *gobuf, *next; -- -- list_for_each_entry_safe(gobuf, next, &go->stream, stream) { -- deactivate_buffer(gobuf); -- } --} -- --static int go7007_streamoff(struct go7007 *go) --{ -- int retval = -EINVAL; -- unsigned long flags; -- -- down(&go->hw_lock); -- if (go->streaming) { -- go->streaming = 0; -- go7007_stream_stop(go); -- spin_lock_irqsave(&go->spinlock, flags); -- abort_queued(go); -- spin_unlock_irqrestore(&go->spinlock, flags); -- go7007_reset_encoder(go); -- retval = 0; -- } -- up(&go->hw_lock); -- return 0; --} -- --static int go7007_open(struct file *file) --{ -- struct go7007 *go = video_get_drvdata(video_devdata(file)); -- struct go7007_file *gofh; -- -- if (go->status != STATUS_ONLINE) -- return -EBUSY; -- gofh = kmalloc(sizeof(struct go7007_file), GFP_KERNEL); -- if (gofh == NULL) -- return -ENOMEM; -- ++go->ref_count; -- gofh->go = go; -- init_MUTEX(&gofh->lock); -- gofh->buf_count = 0; -- file->private_data = gofh; -- return 0; --} -- --static int go7007_release(struct file *file) --{ -- struct go7007_file *gofh = file->private_data; -- struct go7007 *go = gofh->go; -- -- if (gofh->buf_count > 0) { -- go7007_streamoff(go); -- go->in_use = 0; -- kfree(gofh->bufs); -- gofh->buf_count = 0; -- } -- kfree(gofh); -- if (--go->ref_count == 0) -- kfree(go); -- file->private_data = NULL; -- return 0; --} -- --static u32 get_frame_type_flag(struct go7007_buffer *gobuf, int format) --{ -- u8 *f = page_address(gobuf->pages[0]); -- -- switch (format) { -- case GO7007_FORMAT_MJPEG: -- return V4L2_BUF_FLAG_KEYFRAME; -- case GO7007_FORMAT_MPEG4: -- switch ((f[gobuf->frame_offset + 4] >> 6) & 0x3) { -- case 0: -- return V4L2_BUF_FLAG_KEYFRAME; -- case 1: -- return V4L2_BUF_FLAG_PFRAME; -- case 2: -- return V4L2_BUF_FLAG_BFRAME; -- default: -- return 0; -- } -- case GO7007_FORMAT_MPEG1: -- case GO7007_FORMAT_MPEG2: -- switch ((f[gobuf->frame_offset + 5] >> 3) & 0x7) { -- case 1: -- return V4L2_BUF_FLAG_KEYFRAME; -- case 2: -- return V4L2_BUF_FLAG_PFRAME; -- case 3: -- return V4L2_BUF_FLAG_BFRAME; -- default: -- return 0; -- } -- } -- -- return 0; --} -- --static int set_capture_size(struct go7007 *go, struct v4l2_format *fmt, int try) --{ -- int sensor_height = 0, sensor_width = 0; -- int width, height, i; -- -- if (fmt != NULL && fmt->fmt.pix.pixelformat != V4L2_PIX_FMT_MJPEG && -- fmt->fmt.pix.pixelformat != V4L2_PIX_FMT_MPEG && -- fmt->fmt.pix.pixelformat != V4L2_PIX_FMT_MPEG4) -- return -EINVAL; -- -- switch (go->standard) { -- case GO7007_STD_NTSC: -- sensor_width = 720; -- sensor_height = 480; -- break; -- case GO7007_STD_PAL: -- sensor_width = 720; -- sensor_height = 576; -- break; -- case GO7007_STD_OTHER: -- sensor_width = go->board_info->sensor_width; -- sensor_height = go->board_info->sensor_height; -- break; -- } -- -- if (fmt == NULL) { -- width = sensor_width; -- height = sensor_height; -- } else if (go->board_info->sensor_flags & GO7007_SENSOR_SCALING) { -- if (fmt->fmt.pix.width > sensor_width) -- width = sensor_width; -- else if (fmt->fmt.pix.width < 144) -- width = 144; -- else -- width = fmt->fmt.pix.width & ~0x0f; -- -- if (fmt->fmt.pix.height > sensor_height) -- height = sensor_height; -- else if (fmt->fmt.pix.height < 96) -- height = 96; -- else -- height = fmt->fmt.pix.height & ~0x0f; -- } else { -- int requested_size = fmt->fmt.pix.width * fmt->fmt.pix.height; -- int sensor_size = sensor_width * sensor_height; -- -- if (64 * requested_size < 9 * sensor_size) { -- width = sensor_width / 4; -- height = sensor_height / 4; -- } else if (64 * requested_size < 36 * sensor_size) { -- width = sensor_width / 2; -- height = sensor_height / 2; -- } else { -- width = sensor_width; -- height = sensor_height; -- } -- width &= ~0xf; -- height &= ~0xf; -- } -- -- if (fmt != NULL) { -- u32 pixelformat = fmt->fmt.pix.pixelformat; -- -- memset(fmt, 0, sizeof(*fmt)); -- fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- fmt->fmt.pix.width = width; -- fmt->fmt.pix.height = height; -- fmt->fmt.pix.pixelformat = pixelformat; -- fmt->fmt.pix.field = V4L2_FIELD_NONE; -- fmt->fmt.pix.bytesperline = 0; -- fmt->fmt.pix.sizeimage = GO7007_BUF_SIZE; -- fmt->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; /* ?? */ -- } -- -- if (try) -- return 0; -- -- go->width = width; -- go->height = height; -- go->encoder_h_offset = go->board_info->sensor_h_offset; -- go->encoder_v_offset = go->board_info->sensor_v_offset; -- for (i = 0; i < 4; ++i) -- go->modet[i].enable = 0; -- for (i = 0; i < 1624; ++i) -- go->modet_map[i] = 0; -- -- if (go->board_info->sensor_flags & GO7007_SENSOR_SCALING) { -- struct video_decoder_resolution res; -- -- res.width = width; -- if (height > sensor_height / 2) { -- res.height = height / 2; -- go->encoder_v_halve = 0; -- } else { -- res.height = height; -- go->encoder_v_halve = 1; -- } -- if (go->i2c_adapter_online) -- i2c_clients_command(&go->i2c_adapter, -- DECODER_SET_RESOLUTION, &res); -- } else { -- if (width <= sensor_width / 4) { -- go->encoder_h_halve = 1; -- go->encoder_v_halve = 1; -- go->encoder_subsample = 1; -- } else if (width <= sensor_width / 2) { -- go->encoder_h_halve = 1; -- go->encoder_v_halve = 1; -- go->encoder_subsample = 0; -- } else { -- go->encoder_h_halve = 0; -- go->encoder_v_halve = 0; -- go->encoder_subsample = 0; -- } -- } -- -- if (fmt == NULL) -- return 0; -- -- switch (fmt->fmt.pix.pixelformat) { -- case V4L2_PIX_FMT_MPEG: -- if (go->format == GO7007_FORMAT_MPEG1 || -- go->format == GO7007_FORMAT_MPEG2 || -- go->format == GO7007_FORMAT_MPEG4) -- break; -- go->format = GO7007_FORMAT_MPEG1; -- go->pali = 0; -- go->aspect_ratio = GO7007_RATIO_1_1; -- go->gop_size = go->sensor_framerate / 1000; -- go->ipb = 0; -- go->closed_gop = 1; -- go->repeat_seqhead = 1; -- go->seq_header_enable = 1; -- go->gop_header_enable = 1; -- go->dvd_mode = 0; -- break; -- /* Backwards compatibility only! */ -- case V4L2_PIX_FMT_MPEG4: -- if (go->format == GO7007_FORMAT_MPEG4) -- break; -- go->format = GO7007_FORMAT_MPEG4; -- go->pali = 0xf5; -- go->aspect_ratio = GO7007_RATIO_1_1; -- go->gop_size = go->sensor_framerate / 1000; -- go->ipb = 0; -- go->closed_gop = 1; -- go->repeat_seqhead = 1; -- go->seq_header_enable = 1; -- go->gop_header_enable = 1; -- go->dvd_mode = 0; -- break; -- case V4L2_PIX_FMT_MJPEG: -- go->format = GO7007_FORMAT_MJPEG; -- go->pali = 0; -- go->aspect_ratio = GO7007_RATIO_1_1; -- go->gop_size = 0; -- go->ipb = 0; -- go->closed_gop = 0; -- go->repeat_seqhead = 0; -- go->seq_header_enable = 0; -- go->gop_header_enable = 0; -- go->dvd_mode = 0; -- break; -- } -- return 0; --} -- --#if 0 --static int clip_to_modet_map(struct go7007 *go, int region, -- struct v4l2_clip *clip_list) --{ -- struct v4l2_clip clip, *clip_ptr; -- int x, y, mbnum; -- -- /* Check if coordinates are OK and if any macroblocks are already -- * used by other regions (besides 0) */ -- clip_ptr = clip_list; -- while (clip_ptr) { -- if (copy_from_user(&clip, clip_ptr, sizeof(clip))) -- return -EFAULT; -- if (clip.c.left < 0 || (clip.c.left & 0xF) || -- clip.c.width <= 0 || (clip.c.width & 0xF)) -- return -EINVAL; -- if (clip.c.left + clip.c.width > go->width) -- return -EINVAL; -- if (clip.c.top < 0 || (clip.c.top & 0xF) || -- clip.c.height <= 0 || (clip.c.height & 0xF)) -- return -EINVAL; -- if (clip.c.top + clip.c.height > go->height) -- return -EINVAL; -- for (y = 0; y < clip.c.height; y += 16) -- for (x = 0; x < clip.c.width; x += 16) { -- mbnum = (go->width >> 4) * -- ((clip.c.top + y) >> 4) + -- ((clip.c.left + x) >> 4); -- if (go->modet_map[mbnum] != 0 && -- go->modet_map[mbnum] != region) -- return -EBUSY; -- } -- clip_ptr = clip.next; -- } -- -- /* Clear old region macroblocks */ -- for (mbnum = 0; mbnum < 1624; ++mbnum) -- if (go->modet_map[mbnum] == region) -- go->modet_map[mbnum] = 0; -- -- /* Claim macroblocks in this list */ -- clip_ptr = clip_list; -- while (clip_ptr) { -- if (copy_from_user(&clip, clip_ptr, sizeof(clip))) -- return -EFAULT; -- for (y = 0; y < clip.c.height; y += 16) -- for (x = 0; x < clip.c.width; x += 16) { -- mbnum = (go->width >> 4) * -- ((clip.c.top + y) >> 4) + -- ((clip.c.left + x) >> 4); -- go->modet_map[mbnum] = region; -- } -- clip_ptr = clip.next; -- } -- return 0; --} -- --static int mpeg_queryctrl(u32 id, struct v4l2_queryctrl *ctrl) --{ -- static const u32 user_ctrls[] = { -- V4L2_CID_USER_CLASS, -- 0 -- }; -- static const u32 mpeg_ctrls[] = { -- V4L2_CID_MPEG_CLASS, -- V4L2_CID_MPEG_STREAM_TYPE, -- V4L2_CID_MPEG_VIDEO_ENCODING, -- V4L2_CID_MPEG_VIDEO_ASPECT, -- V4L2_CID_MPEG_VIDEO_GOP_SIZE, -- V4L2_CID_MPEG_VIDEO_GOP_CLOSURE, -- V4L2_CID_MPEG_VIDEO_BITRATE, -- 0 -- }; -- static const u32 *ctrl_classes[] = { -- user_ctrls, -- mpeg_ctrls, -- NULL -- }; -- -- /* The ctrl may already contain the queried i2c controls, -- * query the mpeg controls if the existing ctrl id is -- * greater than the next mpeg ctrl id. -- */ -- id = v4l2_ctrl_next(ctrl_classes, id); -- if (id >= ctrl->id && ctrl->name[0]) -- return 0; -- -- memset(ctrl, 0, sizeof(*ctrl)); -- ctrl->id = id; -- -- switch (ctrl->id) { -- case V4L2_CID_USER_CLASS: -- case V4L2_CID_MPEG_CLASS: -- return v4l2_ctrl_query_fill_std(ctrl); -- case V4L2_CID_MPEG_STREAM_TYPE: -- return v4l2_ctrl_query_fill(ctrl, -- V4L2_MPEG_STREAM_TYPE_MPEG2_DVD, -- V4L2_MPEG_STREAM_TYPE_MPEG_ELEM, 1, -- V4L2_MPEG_STREAM_TYPE_MPEG_ELEM); -- case V4L2_CID_MPEG_VIDEO_ENCODING: -- return v4l2_ctrl_query_fill(ctrl, -- V4L2_MPEG_VIDEO_ENCODING_MPEG_1, -- V4L2_MPEG_VIDEO_ENCODING_MPEG_4, 1, -- V4L2_MPEG_VIDEO_ENCODING_MPEG_2); -- case V4L2_CID_MPEG_VIDEO_ASPECT: -- return v4l2_ctrl_query_fill(ctrl, -- V4L2_MPEG_VIDEO_ASPECT_1x1, -- V4L2_MPEG_VIDEO_ASPECT_16x9, 1, -- V4L2_MPEG_VIDEO_ASPECT_1x1); -- case V4L2_CID_MPEG_VIDEO_GOP_SIZE: -- case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE: -- return v4l2_ctrl_query_fill_std(ctrl); -- case V4L2_CID_MPEG_VIDEO_BITRATE: -- return v4l2_ctrl_query_fill(ctrl, -- 64000, -- 10000000, 1, -- 9800000); -- default: -- break; -- } -- return -EINVAL; --} -- --static int mpeg_s_control(struct v4l2_control *ctrl, struct go7007 *go) --{ -- /* pretty sure we can't change any of these while streaming */ -- if (go->streaming) -- return -EBUSY; -- -- switch (ctrl->id) { -- case V4L2_CID_MPEG_STREAM_TYPE: -- switch (ctrl->value) { -- case V4L2_MPEG_STREAM_TYPE_MPEG2_DVD: -- go->format = GO7007_FORMAT_MPEG2; -- go->bitrate = 9800000; -- go->gop_size = 15; -- go->pali = 0x48; -- go->closed_gop = 1; -- go->repeat_seqhead = 0; -- go->seq_header_enable = 1; -- go->gop_header_enable = 1; -- go->dvd_mode = 1; -- break; -- case V4L2_MPEG_STREAM_TYPE_MPEG_ELEM: -- /* todo: */ -- break; -- default: -- return -EINVAL; -- } -- break; -- case V4L2_CID_MPEG_VIDEO_ENCODING: -- switch (ctrl->value) { -- case V4L2_MPEG_VIDEO_ENCODING_MPEG_1: -- go->format = GO7007_FORMAT_MPEG1; -- go->pali = 0; -- break; -- case V4L2_MPEG_VIDEO_ENCODING_MPEG_2: -- go->format = GO7007_FORMAT_MPEG2; -- /*if (mpeg->pali >> 24 == 2) -- go->pali = mpeg->pali & 0xff; -- else*/ -- go->pali = 0x48; -- break; -- case V4L2_MPEG_VIDEO_ENCODING_MPEG_4: -- go->format = GO7007_FORMAT_MPEG4; -- /*if (mpeg->pali >> 24 == 4) -- go->pali = mpeg->pali & 0xff; -- else*/ -- go->pali = 0xf5; -- break; -- default: -- return -EINVAL; -- } -- go->gop_header_enable = -- /*mpeg->flags & GO7007_MPEG_OMIT_GOP_HEADER -- ? 0 :*/ 1; -- /*if (mpeg->flags & GO7007_MPEG_REPEAT_SEQHEADER) -- go->repeat_seqhead = 1; -- else*/ -- go->repeat_seqhead = 0; -- go->dvd_mode = 0; -- break; -- case V4L2_CID_MPEG_VIDEO_ASPECT: -- if (go->format == GO7007_FORMAT_MJPEG) -- return -EINVAL; -- switch (ctrl->value) { -- case V4L2_MPEG_VIDEO_ASPECT_1x1: -- go->aspect_ratio = GO7007_RATIO_1_1; -- break; -- case V4L2_MPEG_VIDEO_ASPECT_4x3: -- go->aspect_ratio = GO7007_RATIO_4_3; -- break; -- case V4L2_MPEG_VIDEO_ASPECT_16x9: -- go->aspect_ratio = GO7007_RATIO_16_9; -- break; -- case V4L2_MPEG_VIDEO_ASPECT_221x100: -- default: -- return -EINVAL; -- } -- break; -- case V4L2_CID_MPEG_VIDEO_GOP_SIZE: -- go->gop_size = ctrl->value; -- break; -- case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE: -- if (ctrl->value != 0 && ctrl->value != 1) -- return -EINVAL; -- go->closed_gop = ctrl->value; -- break; -- case V4L2_CID_MPEG_VIDEO_BITRATE: -- /* Upper bound is kind of arbitrary here */ -- if (ctrl->value < 64000 || ctrl->value > 10000000) -- return -EINVAL; -- go->bitrate = ctrl->value; -- break; -- default: -- return -EINVAL; -- } -- return 0; --} -- --static int mpeg_g_control(struct v4l2_control *ctrl, struct go7007 *go) --{ -- switch (ctrl->id) { -- case V4L2_CID_MPEG_STREAM_TYPE: -- if (go->dvd_mode) -- ctrl->value = V4L2_MPEG_STREAM_TYPE_MPEG2_DVD; -- else -- ctrl->value = V4L2_MPEG_STREAM_TYPE_MPEG_ELEM; -- break; -- case V4L2_CID_MPEG_VIDEO_ENCODING: -- switch (go->format) { -- case GO7007_FORMAT_MPEG1: -- ctrl->value = V4L2_MPEG_VIDEO_ENCODING_MPEG_1; -- break; -- case GO7007_FORMAT_MPEG2: -- ctrl->value = V4L2_MPEG_VIDEO_ENCODING_MPEG_2; -- break; -- case GO7007_FORMAT_MPEG4: -- ctrl->value = V4L2_MPEG_VIDEO_ENCODING_MPEG_4; -- break; -- default: -- return -EINVAL; -- } -- break; -- case V4L2_CID_MPEG_VIDEO_ASPECT: -- switch (go->aspect_ratio) { -- case GO7007_RATIO_1_1: -- ctrl->value = V4L2_MPEG_VIDEO_ASPECT_1x1; -- break; -- case GO7007_RATIO_4_3: -- ctrl->value = V4L2_MPEG_VIDEO_ASPECT_4x3; -- break; -- case GO7007_RATIO_16_9: -- ctrl->value = V4L2_MPEG_VIDEO_ASPECT_16x9; -- break; -- default: -- return -EINVAL; -- } -- break; -- case V4L2_CID_MPEG_VIDEO_GOP_SIZE: -- ctrl->value = go->gop_size; -- break; -- case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE: -- ctrl->value = go->closed_gop; -- break; -- case V4L2_CID_MPEG_VIDEO_BITRATE: -- ctrl->value = go->bitrate; -- break; -- default: -- return -EINVAL; -- } -- return 0; --} --#endif -- --static int vidioc_querycap(struct file *file, void *priv, -- struct v4l2_capability *cap) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- strlcpy(cap->driver, "go7007", sizeof(cap->driver)); -- strlcpy(cap->card, go->name, sizeof(cap->card)); --#if 0 -- strlcpy(cap->bus_info, dev_name(&dev->udev->dev), sizeof(cap->bus_info)); --#endif -- -- cap->version = KERNEL_VERSION(0, 9, 8); -- -- cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | -- V4L2_CAP_STREAMING; /* | V4L2_CAP_AUDIO; */ -- -- if (go->board_info->flags & GO7007_BOARD_HAS_TUNER) -- cap->capabilities |= V4L2_CAP_TUNER; -- -- return 0; --} -- --static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, -- struct v4l2_fmtdesc *fmt) --{ -- char *desc = NULL; -- -- switch (fmt->index) { -- case 0: -- fmt->pixelformat = V4L2_PIX_FMT_MJPEG; -- desc = "Motion-JPEG"; -- break; -- case 1: -- fmt->pixelformat = V4L2_PIX_FMT_MPEG; -- desc = "MPEG1/MPEG2/MPEG4"; -- break; -- default: -- return -EINVAL; -- } -- fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- fmt->flags = V4L2_FMT_FLAG_COMPRESSED; -- -- strncpy(fmt->description, desc, sizeof(fmt->description)); -- -- return 0; --} -- --static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, -- struct v4l2_format *fmt) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- fmt->fmt.pix.width = go->width; -- fmt->fmt.pix.height = go->height; -- fmt->fmt.pix.pixelformat = (go->format == GO7007_FORMAT_MJPEG) ? -- V4L2_PIX_FMT_MJPEG : V4L2_PIX_FMT_MPEG; -- fmt->fmt.pix.field = V4L2_FIELD_NONE; -- fmt->fmt.pix.bytesperline = 0; -- fmt->fmt.pix.sizeimage = GO7007_BUF_SIZE; -- fmt->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; -- -- return 0; --} -- --static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, -- struct v4l2_format *fmt) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- return set_capture_size(go, fmt, 1); --} -- --static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, -- struct v4l2_format *fmt) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (go->streaming) -- return -EBUSY; -- -- return set_capture_size(go, fmt, 0); --} -- --static int vidioc_reqbufs(struct file *file, void *priv, -- struct v4l2_requestbuffers *req) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- int retval = -EBUSY; -- unsigned int count, i; -- -- if (go->streaming) -- return retval; -- -- if (req->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || -- req->memory != V4L2_MEMORY_MMAP) -- return -EINVAL; -- -- down(&gofh->lock); -- for (i = 0; i < gofh->buf_count; ++i) -- if (gofh->bufs[i].mapped > 0) -- goto unlock_and_return; -- -- down(&go->hw_lock); -- if (go->in_use > 0 && gofh->buf_count == 0) { -- up(&go->hw_lock); -- goto unlock_and_return; -- } -- -- if (gofh->buf_count > 0) -- kfree(gofh->bufs); -- -- retval = -ENOMEM; -- count = req->count; -- if (count > 0) { -- if (count < 2) -- count = 2; -- if (count > 32) -- count = 32; -- -- gofh->bufs = kmalloc(count * sizeof(struct go7007_buffer), -- GFP_KERNEL); -- -- if (!gofh->bufs) { -- up(&go->hw_lock); -- goto unlock_and_return; -- } -- -- memset(gofh->bufs, 0, count * sizeof(struct go7007_buffer)); -- -- for (i = 0; i < count; ++i) { -- gofh->bufs[i].go = go; -- gofh->bufs[i].index = i; -- gofh->bufs[i].state = BUF_STATE_IDLE; -- gofh->bufs[i].mapped = 0; -- } -- -- go->in_use = 1; -- } else { -- go->in_use = 0; -- } -- -- gofh->buf_count = count; -- up(&go->hw_lock); -- up(&gofh->lock); -- -- memset(req, 0, sizeof(*req)); -- -- req->count = count; -- req->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- req->memory = V4L2_MEMORY_MMAP; -- -- return 0; -- --unlock_and_return: -- up(&gofh->lock); -- return retval; --} -- --static int vidioc_querybuf(struct file *file, void *priv, -- struct v4l2_buffer *buf) --{ -- struct go7007_file *gofh = priv; -- int retval = -EINVAL; -- unsigned int index; -- -- if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return retval; -- -- index = buf->index; -- -- down(&gofh->lock); -- if (index >= gofh->buf_count) -- goto unlock_and_return; -- -- memset(buf, 0, sizeof(*buf)); -- buf->index = index; -- buf->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- -- switch (gofh->bufs[index].state) { -- case BUF_STATE_QUEUED: -- buf->flags = V4L2_BUF_FLAG_QUEUED; -- break; -- case BUF_STATE_DONE: -- buf->flags = V4L2_BUF_FLAG_DONE; -- break; -- default: -- buf->flags = 0; -- } -- -- if (gofh->bufs[index].mapped) -- buf->flags |= V4L2_BUF_FLAG_MAPPED; -- buf->memory = V4L2_MEMORY_MMAP; -- buf->m.offset = index * GO7007_BUF_SIZE; -- buf->length = GO7007_BUF_SIZE; -- up(&gofh->lock); -- -- return 0; -- --unlock_and_return: -- up(&gofh->lock); -- return retval; --} -- --static int vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *buf) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- struct go7007_buffer *gobuf; -- unsigned long flags; -- int retval = -EINVAL; -- int ret; -- -- if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || -- buf->memory != V4L2_MEMORY_MMAP) -- return retval; -- -- down(&gofh->lock); -- if (buf->index < 0 || buf->index >= gofh->buf_count) -- goto unlock_and_return; -- -- gobuf = &gofh->bufs[buf->index]; -- if (!gobuf->mapped) -- goto unlock_and_return; -- -- retval = -EBUSY; -- if (gobuf->state != BUF_STATE_IDLE) -- goto unlock_and_return; -- -- /* offset will be 0 until we really support USERPTR streaming */ -- gobuf->offset = gobuf->user_addr & ~PAGE_MASK; -- gobuf->bytesused = 0; -- gobuf->frame_offset = 0; -- gobuf->modet_active = 0; -- if (gobuf->offset > 0) -- gobuf->page_count = GO7007_BUF_PAGES + 1; -- else -- gobuf->page_count = GO7007_BUF_PAGES; -- -- retval = -ENOMEM; -- down_read(¤t->mm->mmap_sem); -- ret = get_user_pages(current, current->mm, -- gobuf->user_addr & PAGE_MASK, gobuf->page_count, -- 1, 1, gobuf->pages, NULL); -- up_read(¤t->mm->mmap_sem); -- -- if (ret != gobuf->page_count) { -- int i; -- for (i = 0; i < ret; ++i) -- page_cache_release(gobuf->pages[i]); -- gobuf->page_count = 0; -- goto unlock_and_return; -- } -- -- gobuf->state = BUF_STATE_QUEUED; -- spin_lock_irqsave(&go->spinlock, flags); -- list_add_tail(&gobuf->stream, &go->stream); -- spin_unlock_irqrestore(&go->spinlock, flags); -- up(&gofh->lock); -- -- return 0; -- --unlock_and_return: -- up(&gofh->lock); -- return retval; --} -- -- --static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *buf) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- struct go7007_buffer *gobuf; -- int retval = -EINVAL; -- unsigned long flags; -- u32 frame_type_flag; -- DEFINE_WAIT(wait); -- -- if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return retval; -- if (buf->memory != V4L2_MEMORY_MMAP) -- return retval; -- -- down(&gofh->lock); -- if (list_empty(&go->stream)) -- goto unlock_and_return; -- gobuf = list_entry(go->stream.next, -- struct go7007_buffer, stream); -- -- retval = -EAGAIN; -- if (gobuf->state != BUF_STATE_DONE && -- !(file->f_flags & O_NONBLOCK)) { -- for (;;) { -- prepare_to_wait(&go->frame_waitq, &wait, -- TASK_INTERRUPTIBLE); -- if (gobuf->state == BUF_STATE_DONE) -- break; -- if (signal_pending(current)) { -- retval = -ERESTARTSYS; -- break; -- } -- schedule(); -- } -- finish_wait(&go->frame_waitq, &wait); -- } -- if (gobuf->state != BUF_STATE_DONE) -- goto unlock_and_return; -- -- spin_lock_irqsave(&go->spinlock, flags); -- deactivate_buffer(gobuf); -- spin_unlock_irqrestore(&go->spinlock, flags); -- frame_type_flag = get_frame_type_flag(gobuf, go->format); -- gobuf->state = BUF_STATE_IDLE; -- -- memset(buf, 0, sizeof(*buf)); -- buf->index = gobuf->index; -- buf->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- buf->bytesused = gobuf->bytesused; -- buf->flags = V4L2_BUF_FLAG_MAPPED | frame_type_flag; -- buf->field = V4L2_FIELD_NONE; -- buf->timestamp = gobuf->timestamp; -- buf->sequence = gobuf->seq; -- buf->memory = V4L2_MEMORY_MMAP; -- buf->m.offset = gobuf->index * GO7007_BUF_SIZE; -- buf->length = GO7007_BUF_SIZE; -- buf->reserved = gobuf->modet_active; -- -- up(&gofh->lock); -- return 0; -- --unlock_and_return: -- up(&gofh->lock); -- return retval; --} -- --static int vidioc_streamon(struct file *file, void *priv, -- enum v4l2_buf_type type) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- int retval = 0; -- -- if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- -- down(&gofh->lock); -- down(&go->hw_lock); -- -- if (!go->streaming) { -- go->streaming = 1; -- go->next_seq = 0; -- go->active_buf = NULL; -- if (go7007_start_encoder(go) < 0) -- retval = -EIO; -- else -- retval = 0; -- } -- up(&go->hw_lock); -- up(&gofh->lock); -- -- return retval; --} -- --static int vidioc_streamoff(struct file *file, void *priv, -- enum v4l2_buf_type type) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- down(&gofh->lock); -- go7007_streamoff(go); -- up(&gofh->lock); -- -- return 0; --} -- --static int vidioc_queryctrl(struct file *file, void *priv, -- struct v4l2_queryctrl *query) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (!go->i2c_adapter_online) -- return -EIO; -- -- i2c_clients_command(&go->i2c_adapter, VIDIOC_QUERYCTRL, query); -- -- return (!query->name[0]) ? -EINVAL : 0; --} -- --static int vidioc_g_ctrl(struct file *file, void *priv, -- struct v4l2_control *ctrl) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- struct v4l2_queryctrl query; -- -- if (!go->i2c_adapter_online) -- return -EIO; -- -- memset(&query, 0, sizeof(query)); -- query.id = ctrl->id; -- i2c_clients_command(&go->i2c_adapter, VIDIOC_QUERYCTRL, &query); -- if (query.name[0] == 0) -- return -EINVAL; -- i2c_clients_command(&go->i2c_adapter, VIDIOC_G_CTRL, ctrl); -- -- return 0; --} -- --static int vidioc_s_ctrl(struct file *file, void *priv, -- struct v4l2_control *ctrl) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- struct v4l2_queryctrl query; -- -- if (!go->i2c_adapter_online) -- return -EIO; -- -- memset(&query, 0, sizeof(query)); -- query.id = ctrl->id; -- i2c_clients_command(&go->i2c_adapter, VIDIOC_QUERYCTRL, &query); -- if (query.name[0] == 0) -- return -EINVAL; -- i2c_clients_command(&go->i2c_adapter, VIDIOC_S_CTRL, ctrl); -- -- return 0; --} -- --static int vidioc_g_parm(struct file *filp, void *priv, -- struct v4l2_streamparm *parm) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- struct v4l2_fract timeperframe = { -- .numerator = 1001 * go->fps_scale, -- .denominator = go->sensor_framerate, -- }; -- -- if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- -- parm->parm.capture.capability |= V4L2_CAP_TIMEPERFRAME; -- parm->parm.capture.timeperframe = timeperframe; -- -- return 0; --} -- --static int vidioc_s_parm(struct file *filp, void *priv, -- struct v4l2_streamparm *parm) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- unsigned int n, d; -- -- if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- if (parm->parm.capture.capturemode != 0) -- return -EINVAL; -- -- n = go->sensor_framerate * -- parm->parm.capture.timeperframe.numerator; -- d = 1001 * parm->parm.capture.timeperframe.denominator; -- if (n != 0 && d != 0 && n > d) -- go->fps_scale = (n + d/2) / d; -- else -- go->fps_scale = 1; -- -- return 0; --} -- --/* VIDIOC_ENUMSTD on go7007 were used for enumberating the supported fps and -- its resolution, when the device is not connected to TV. -- This were an API abuse, probably used by the lack of specific IOCTL's to -- enumberate it, by the time the driver were written. -- -- However, since kernel 2.6.19, two new ioctls (VIDIOC_ENUM_FRAMEINTERVALS -- and VIDIOC_ENUM_FRAMESIZES) were added for this purpose. -- -- The two functions bellow implements the newer ioctls --*/ --static int vidioc_enum_framesizes(struct file *filp, void *priv, -- struct v4l2_frmsizeenum *fsize) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- /* Return -EINVAL, if it is a TV board */ -- if ((go->board_info->flags & GO7007_BOARD_HAS_TUNER) || -- (go->board_info->sensor_flags & GO7007_SENSOR_TV)) -- return -EINVAL; -- -- if (fsize->index > 0) -- return -EINVAL; -- -- fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; -- fsize->discrete.width = go->board_info->sensor_width; -- fsize->discrete.height = go->board_info->sensor_height; -- -- return 0; --} -- --static int vidioc_enum_frameintervals(struct file *filp, void *priv, -- struct v4l2_frmivalenum *fival) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- /* Return -EINVAL, if it is a TV board */ -- if ((go->board_info->flags & GO7007_BOARD_HAS_TUNER) || -- (go->board_info->sensor_flags & GO7007_SENSOR_TV)) -- return -EINVAL; -- -- if (fival->index > 0) -- return -EINVAL; -- -- fival->type = V4L2_FRMIVAL_TYPE_DISCRETE; -- fival->discrete.numerator = 1001; -- fival->discrete.denominator = go->board_info->sensor_framerate; -- -- return 0; --} -- --static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *std) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (go->streaming) -- return -EBUSY; -- -- if (!(go->board_info->sensor_flags & GO7007_SENSOR_TV) && -- *std != 0) -- return -EINVAL; -- -- if (*std == 0) -- return -EINVAL; -- -- if ((go->board_info->flags & GO7007_BOARD_HAS_TUNER) && -- go->input == go->board_info->num_inputs - 1) { -- if (!go->i2c_adapter_online) -- return -EIO; -- i2c_clients_command(&go->i2c_adapter, -- VIDIOC_S_STD, std); -- if (!*std) /* hack to indicate EINVAL from tuner */ -- return -EINVAL; -- } -- -- if (*std & V4L2_STD_NTSC) { -- go->standard = GO7007_STD_NTSC; -- go->sensor_framerate = 30000; -- } else if (*std & V4L2_STD_PAL) { -- go->standard = GO7007_STD_PAL; -- go->sensor_framerate = 25025; -- } else if (*std & V4L2_STD_SECAM) { -- go->standard = GO7007_STD_PAL; -- go->sensor_framerate = 25025; -- } else -- return -EINVAL; -- -- if (go->i2c_adapter_online) -- i2c_clients_command(&go->i2c_adapter, -- VIDIOC_S_STD, std); -- set_capture_size(go, NULL, 0); -- -- return 0; --} -- --#if 0 -- case VIDIOC_QUERYSTD: -- { -- v4l2_std_id *std = arg; -- -- if ((go->board_info->flags & GO7007_BOARD_HAS_TUNER) && -- go->input == go->board_info->num_inputs - 1) { -- if (!go->i2c_adapter_online) -- return -EIO; -- i2c_clients_command(&go->i2c_adapter, -- VIDIOC_QUERYSTD, arg); -- } else if (go->board_info->sensor_flags & GO7007_SENSOR_TV) -- *std = V4L2_STD_NTSC | V4L2_STD_PAL | V4L2_STD_SECAM; -- else -- *std = 0; -- return 0; -- } --#endif -- --static int vidioc_enum_input(struct file *file, void *priv, -- struct v4l2_input *inp) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (inp->index >= go->board_info->num_inputs) -- return -EINVAL; -- -- strncpy(inp->name, go->board_info->inputs[inp->index].name, -- sizeof(inp->name)); -- -- /* If this board has a tuner, it will be the last input */ -- if ((go->board_info->flags & GO7007_BOARD_HAS_TUNER) && -- inp->index == go->board_info->num_inputs - 1) -- inp->type = V4L2_INPUT_TYPE_TUNER; -- else -- inp->type = V4L2_INPUT_TYPE_CAMERA; -- -- inp->audioset = 0; -- inp->tuner = 0; -- if (go->board_info->sensor_flags & GO7007_SENSOR_TV) -- inp->std = V4L2_STD_NTSC | V4L2_STD_PAL | -- V4L2_STD_SECAM; -- else -- inp->std = 0; -- -- return 0; --} -- -- --static int vidioc_g_input(struct file *file, void *priv, unsigned int *input) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- *input = go->input; -- -- return 0; --} -- --static int vidioc_s_input(struct file *file, void *priv, unsigned int input) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (input >= go->board_info->num_inputs) -- return -EINVAL; -- if (go->streaming) -- return -EBUSY; -- -- go->input = input; -- if (go->i2c_adapter_online) { -- i2c_clients_command(&go->i2c_adapter, VIDIOC_S_INPUT, -- &go->board_info->inputs[input].video_input); -- i2c_clients_command(&go->i2c_adapter, VIDIOC_S_AUDIO, -- &go->board_info->inputs[input].audio_input); -- } -- -- return 0; --} -- --static int vidioc_g_tuner(struct file *file, void *priv, -- struct v4l2_tuner *t) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (!(go->board_info->flags & GO7007_BOARD_HAS_TUNER)) -- return -EINVAL; -- if (t->index != 0) -- return -EINVAL; -- if (!go->i2c_adapter_online) -- return -EIO; -- -- i2c_clients_command(&go->i2c_adapter, VIDIOC_G_TUNER, t); -- -- t->index = 0; -- return 0; --} -- --static int vidioc_s_tuner(struct file *file, void *priv, -- struct v4l2_tuner *t) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (!(go->board_info->flags & GO7007_BOARD_HAS_TUNER)) -- return -EINVAL; -- if (t->index != 0) -- return -EINVAL; -- if (!go->i2c_adapter_online) -- return -EIO; -- -- switch (go->board_id) { -- case GO7007_BOARDID_PX_TV402U_NA: -- case GO7007_BOARDID_PX_TV402U_JP: -- /* No selectable options currently */ -- if (t->audmode != V4L2_TUNER_MODE_STEREO) -- return -EINVAL; -- break; -- } -- -- i2c_clients_command(&go->i2c_adapter, VIDIOC_S_TUNER, t); -- -- return 0; --} -- --static int vidioc_g_frequency(struct file *file, void *priv, -- struct v4l2_frequency *f) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (!(go->board_info->flags & GO7007_BOARD_HAS_TUNER)) -- return -EINVAL; -- if (!go->i2c_adapter_online) -- return -EIO; -- -- f->type = V4L2_TUNER_ANALOG_TV; -- i2c_clients_command(&go->i2c_adapter, VIDIOC_G_FREQUENCY, f); -- return 0; --} -- --static int vidioc_s_frequency(struct file *file, void *priv, -- struct v4l2_frequency *f) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (!(go->board_info->flags & GO7007_BOARD_HAS_TUNER)) -- return -EINVAL; -- if (!go->i2c_adapter_online) -- return -EIO; -- -- i2c_clients_command(&go->i2c_adapter, VIDIOC_S_FREQUENCY, f); -- -- return 0; --} -- --static int vidioc_cropcap(struct file *file, void *priv, -- struct v4l2_cropcap *cropcap) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (cropcap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- -- /* These specify the raw input of the sensor */ -- switch (go->standard) { -- case GO7007_STD_NTSC: -- cropcap->bounds.top = 0; -- cropcap->bounds.left = 0; -- cropcap->bounds.width = 720; -- cropcap->bounds.height = 480; -- cropcap->defrect.top = 0; -- cropcap->defrect.left = 0; -- cropcap->defrect.width = 720; -- cropcap->defrect.height = 480; -- break; -- case GO7007_STD_PAL: -- cropcap->bounds.top = 0; -- cropcap->bounds.left = 0; -- cropcap->bounds.width = 720; -- cropcap->bounds.height = 576; -- cropcap->defrect.top = 0; -- cropcap->defrect.left = 0; -- cropcap->defrect.width = 720; -- cropcap->defrect.height = 576; -- break; -- case GO7007_STD_OTHER: -- cropcap->bounds.top = 0; -- cropcap->bounds.left = 0; -- cropcap->bounds.width = go->board_info->sensor_width; -- cropcap->bounds.height = go->board_info->sensor_height; -- cropcap->defrect.top = 0; -- cropcap->defrect.left = 0; -- cropcap->defrect.width = go->board_info->sensor_width; -- cropcap->defrect.height = go->board_info->sensor_height; -- break; -- } -- -- return 0; --} -- --static int vidioc_g_crop(struct file *file, void *priv, struct v4l2_crop *crop) --{ -- struct go7007_file *gofh = priv; -- struct go7007 *go = gofh->go; -- -- if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- -- crop->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; -- -- /* These specify the raw input of the sensor */ -- switch (go->standard) { -- case GO7007_STD_NTSC: -- crop->c.top = 0; -- crop->c.left = 0; -- crop->c.width = 720; -- crop->c.height = 480; -- break; -- case GO7007_STD_PAL: -- crop->c.top = 0; -- crop->c.left = 0; -- crop->c.width = 720; -- crop->c.height = 576; -- break; -- case GO7007_STD_OTHER: -- crop->c.top = 0; -- crop->c.left = 0; -- crop->c.width = go->board_info->sensor_width; -- crop->c.height = go->board_info->sensor_height; -- break; -- } -- -- return 0; --} -- --/* FIXME: vidioc_s_crop is not really implemented!!! -- */ --static int vidioc_s_crop(struct file *file, void *priv, struct v4l2_crop *crop) --{ -- if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) -- return -EINVAL; -- -- return 0; --} -- --static int vidioc_g_jpegcomp(struct file *file, void *priv, -- struct v4l2_jpegcompression *params) --{ -- memset(params, 0, sizeof(*params)); -- params->quality = 50; /* ?? */ -- params->jpeg_markers = V4L2_JPEG_MARKER_DHT | -- V4L2_JPEG_MARKER_DQT; -- -- return 0; --} -- --static int vidioc_s_jpegcomp(struct file *file, void *priv, -- struct v4l2_jpegcompression *params) --{ -- if (params->quality != 50 || -- params->jpeg_markers != (V4L2_JPEG_MARKER_DHT | -- V4L2_JPEG_MARKER_DQT)) -- return -EINVAL; -- -- return 0; --} -- --/* FIXME: -- Those ioctls are private, and not needed, since several standard -- extended controls already provide streaming control. -- So, those ioctls should be converted into vidioc_g_ext_ctrls() -- and vidioc_s_ext_ctrls() -- */ -- --#if 0 -- /* Temporary ioctls for controlling compression characteristics */ -- case GO7007IOC_S_BITRATE: -- { -- int *bitrate = arg; -- -- if (go->streaming) -- return -EINVAL; -- /* Upper bound is kind of arbitrary here */ -- if (*bitrate < 64000 || *bitrate > 10000000) -- return -EINVAL; -- go->bitrate = *bitrate; -- return 0; -- } -- case GO7007IOC_G_BITRATE: -- { -- int *bitrate = arg; -- -- *bitrate = go->bitrate; -- return 0; -- } -- case GO7007IOC_S_COMP_PARAMS: -- { -- struct go7007_comp_params *comp = arg; -- -- if (go->format == GO7007_FORMAT_MJPEG) -- return -EINVAL; -- if (comp->gop_size > 0) -- go->gop_size = comp->gop_size; -- else -- go->gop_size = go->sensor_framerate / 1000; -- if (go->gop_size != 15) -- go->dvd_mode = 0; -- /*go->ipb = comp->max_b_frames > 0;*/ /* completely untested */ -- if (go->board_info->sensor_flags & GO7007_SENSOR_TV) { -- switch (comp->aspect_ratio) { -- case GO7007_ASPECT_RATIO_4_3_NTSC: -- case GO7007_ASPECT_RATIO_4_3_PAL: -- go->aspect_ratio = GO7007_RATIO_4_3; -- break; -- case GO7007_ASPECT_RATIO_16_9_NTSC: -- case GO7007_ASPECT_RATIO_16_9_PAL: -- go->aspect_ratio = GO7007_RATIO_16_9; -- break; -- default: -- go->aspect_ratio = GO7007_RATIO_1_1; -- break; -- } -- } -- if (comp->flags & GO7007_COMP_OMIT_SEQ_HEADER) { -- go->dvd_mode = 0; -- go->seq_header_enable = 0; -- } else { -- go->seq_header_enable = 1; -- } -- /* fall-through */ -- } -- case GO7007IOC_G_COMP_PARAMS: -- { -- struct go7007_comp_params *comp = arg; -- -- if (go->format == GO7007_FORMAT_MJPEG) -- return -EINVAL; -- memset(comp, 0, sizeof(*comp)); -- comp->gop_size = go->gop_size; -- comp->max_b_frames = go->ipb ? 2 : 0; -- switch (go->aspect_ratio) { -- case GO7007_RATIO_4_3: -- if (go->standard == GO7007_STD_NTSC) -- comp->aspect_ratio = -- GO7007_ASPECT_RATIO_4_3_NTSC; -- else -- comp->aspect_ratio = -- GO7007_ASPECT_RATIO_4_3_PAL; -- break; -- case GO7007_RATIO_16_9: -- if (go->standard == GO7007_STD_NTSC) -- comp->aspect_ratio = -- GO7007_ASPECT_RATIO_16_9_NTSC; -- else -- comp->aspect_ratio = -- GO7007_ASPECT_RATIO_16_9_PAL; -- break; -- default: -- comp->aspect_ratio = GO7007_ASPECT_RATIO_1_1; -- break; -- } -- if (go->closed_gop) -- comp->flags |= GO7007_COMP_CLOSED_GOP; -- if (!go->seq_header_enable) -- comp->flags |= GO7007_COMP_OMIT_SEQ_HEADER; -- return 0; -- } -- case GO7007IOC_S_MPEG_PARAMS: -- { -- struct go7007_mpeg_params *mpeg = arg; -- -- if (go->format != GO7007_FORMAT_MPEG1 && -- go->format != GO7007_FORMAT_MPEG2 && -- go->format != GO7007_FORMAT_MPEG4) -- return -EINVAL; -- -- if (mpeg->flags & GO7007_MPEG_FORCE_DVD_MODE) { -- go->format = GO7007_FORMAT_MPEG2; -- go->bitrate = 9800000; -- go->gop_size = 15; -- go->pali = 0x48; -- go->closed_gop = 1; -- go->repeat_seqhead = 0; -- go->seq_header_enable = 1; -- go->gop_header_enable = 1; -- go->dvd_mode = 1; -- } else { -- switch (mpeg->mpeg_video_standard) { -- case GO7007_MPEG_VIDEO_MPEG1: -- go->format = GO7007_FORMAT_MPEG1; -- go->pali = 0; -- break; -- case GO7007_MPEG_VIDEO_MPEG2: -- go->format = GO7007_FORMAT_MPEG2; -- if (mpeg->pali >> 24 == 2) -- go->pali = mpeg->pali & 0xff; -- else -- go->pali = 0x48; -- break; -- case GO7007_MPEG_VIDEO_MPEG4: -- go->format = GO7007_FORMAT_MPEG4; -- if (mpeg->pali >> 24 == 4) -- go->pali = mpeg->pali & 0xff; -- else -- go->pali = 0xf5; -- break; -- default: -- return -EINVAL; -- } -- go->gop_header_enable = -- mpeg->flags & GO7007_MPEG_OMIT_GOP_HEADER -- ? 0 : 1; -- if (mpeg->flags & GO7007_MPEG_REPEAT_SEQHEADER) -- go->repeat_seqhead = 1; -- else -- go->repeat_seqhead = 0; -- go->dvd_mode = 0; -- } -- /* fall-through */ -- } -- case GO7007IOC_G_MPEG_PARAMS: -- { -- struct go7007_mpeg_params *mpeg = arg; -- -- memset(mpeg, 0, sizeof(*mpeg)); -- switch (go->format) { -- case GO7007_FORMAT_MPEG1: -- mpeg->mpeg_video_standard = GO7007_MPEG_VIDEO_MPEG1; -- mpeg->pali = 0; -- break; -- case GO7007_FORMAT_MPEG2: -- mpeg->mpeg_video_standard = GO7007_MPEG_VIDEO_MPEG2; -- mpeg->pali = GO7007_MPEG_PROFILE(2, go->pali); -- break; -- case GO7007_FORMAT_MPEG4: -- mpeg->mpeg_video_standard = GO7007_MPEG_VIDEO_MPEG4; -- mpeg->pali = GO7007_MPEG_PROFILE(4, go->pali); -- break; -- default: -- return -EINVAL; -- } -- if (!go->gop_header_enable) -- mpeg->flags |= GO7007_MPEG_OMIT_GOP_HEADER; -- if (go->repeat_seqhead) -- mpeg->flags |= GO7007_MPEG_REPEAT_SEQHEADER; -- if (go->dvd_mode) -- mpeg->flags |= GO7007_MPEG_FORCE_DVD_MODE; -- return 0; -- } -- case GO7007IOC_S_MD_PARAMS: -- { -- struct go7007_md_params *mdp = arg; -- -- if (mdp->region > 3) -- return -EINVAL; -- if (mdp->trigger > 0) { -- go->modet[mdp->region].pixel_threshold = -- mdp->pixel_threshold >> 1; -- go->modet[mdp->region].motion_threshold = -- mdp->motion_threshold >> 1; -- go->modet[mdp->region].mb_threshold = -- mdp->trigger >> 1; -- go->modet[mdp->region].enable = 1; -- } else -- go->modet[mdp->region].enable = 0; -- /* fall-through */ -- } -- case GO7007IOC_G_MD_PARAMS: -- { -- struct go7007_md_params *mdp = arg; -- int region = mdp->region; -- -- if (mdp->region > 3) -- return -EINVAL; -- memset(mdp, 0, sizeof(struct go7007_md_params)); -- mdp->region = region; -- if (!go->modet[region].enable) -- return 0; -- mdp->pixel_threshold = -- (go->modet[region].pixel_threshold << 1) + 1; -- mdp->motion_threshold = -- (go->modet[region].motion_threshold << 1) + 1; -- mdp->trigger = -- (go->modet[region].mb_threshold << 1) + 1; -- return 0; -- } -- case GO7007IOC_S_MD_REGION: -- { -- struct go7007_md_region *region = arg; -- -- if (region->region < 1 || region->region > 3) -- return -EINVAL; -- return clip_to_modet_map(go, region->region, region->clips); -- } --#endif -- --static ssize_t go7007_read(struct file *file, char __user *data, -- size_t count, loff_t *ppos) --{ -- return -EINVAL; --} -- --static void go7007_vm_open(struct vm_area_struct *vma) --{ -- struct go7007_buffer *gobuf = vma->vm_private_data; -- -- ++gobuf->mapped; --} -- --static void go7007_vm_close(struct vm_area_struct *vma) --{ -- struct go7007_buffer *gobuf = vma->vm_private_data; -- unsigned long flags; -- -- if (--gobuf->mapped == 0) { -- spin_lock_irqsave(&gobuf->go->spinlock, flags); -- deactivate_buffer(gobuf); -- spin_unlock_irqrestore(&gobuf->go->spinlock, flags); -- } --} -- --/* Copied from videobuf-dma-sg.c */ --static int go7007_vm_fault(struct vm_area_struct *vma, struct vm_fault *vmf) --{ -- struct page *page; -- -- page = alloc_page(GFP_USER | __GFP_DMA32); -- if (!page) -- return VM_FAULT_OOM; -- clear_user_highpage(page, (unsigned long)vmf->virtual_address); -- vmf->page = page; -- return 0; --} -- --static struct vm_operations_struct go7007_vm_ops = { -- .open = go7007_vm_open, -- .close = go7007_vm_close, -- .fault = go7007_vm_fault, --}; -- --static int go7007_mmap(struct file *file, struct vm_area_struct *vma) --{ -- struct go7007_file *gofh = file->private_data; -- unsigned int index; -- -- if (gofh->go->status != STATUS_ONLINE) -- return -EIO; -- if (!(vma->vm_flags & VM_SHARED)) -- return -EINVAL; /* only support VM_SHARED mapping */ -- if (vma->vm_end - vma->vm_start != GO7007_BUF_SIZE) -- return -EINVAL; /* must map exactly one full buffer */ -- down(&gofh->lock); -- index = vma->vm_pgoff / GO7007_BUF_PAGES; -- if (index >= gofh->buf_count) { -- up(&gofh->lock); -- return -EINVAL; /* trying to map beyond requested buffers */ -- } -- if (index * GO7007_BUF_PAGES != vma->vm_pgoff) { -- up(&gofh->lock); -- return -EINVAL; /* offset is not aligned on buffer boundary */ -- } -- if (gofh->bufs[index].mapped > 0) { -- up(&gofh->lock); -- return -EBUSY; -- } -- gofh->bufs[index].mapped = 1; -- gofh->bufs[index].user_addr = vma->vm_start; -- vma->vm_ops = &go7007_vm_ops; -- vma->vm_flags |= VM_DONTEXPAND; -- vma->vm_flags &= ~VM_IO; -- vma->vm_private_data = &gofh->bufs[index]; -- up(&gofh->lock); -- return 0; --} -- --static unsigned int go7007_poll(struct file *file, poll_table *wait) --{ -- struct go7007_file *gofh = file->private_data; -- struct go7007_buffer *gobuf; -- -- if (list_empty(&gofh->go->stream)) -- return POLLERR; -- gobuf = list_entry(gofh->go->stream.next, struct go7007_buffer, stream); -- poll_wait(file, &gofh->go->frame_waitq, wait); -- if (gobuf->state == BUF_STATE_DONE) -- return POLLIN | POLLRDNORM; -- return 0; --} -- --static void go7007_vfl_release(struct video_device *vfd) --{ -- struct go7007 *go = video_get_drvdata(vfd); -- -- video_device_release(vfd); -- if (--go->ref_count == 0) -- kfree(go); --} -- --static struct v4l2_file_operations go7007_fops = { -- .owner = THIS_MODULE, -- .open = go7007_open, -- .release = go7007_release, -- .ioctl = video_ioctl2, -- .read = go7007_read, -- .mmap = go7007_mmap, -- .poll = go7007_poll, --}; -- --static const struct v4l2_ioctl_ops video_ioctl_ops = { -- .vidioc_querycap = vidioc_querycap, -- .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, -- .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, -- .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, -- .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, -- .vidioc_reqbufs = vidioc_reqbufs, -- .vidioc_querybuf = vidioc_querybuf, -- .vidioc_qbuf = vidioc_qbuf, -- .vidioc_dqbuf = vidioc_dqbuf, -- .vidioc_s_std = vidioc_s_std, -- .vidioc_enum_input = vidioc_enum_input, -- .vidioc_g_input = vidioc_g_input, -- .vidioc_s_input = vidioc_s_input, -- .vidioc_queryctrl = vidioc_queryctrl, -- .vidioc_g_ctrl = vidioc_g_ctrl, -- .vidioc_s_ctrl = vidioc_s_ctrl, -- .vidioc_streamon = vidioc_streamon, -- .vidioc_streamoff = vidioc_streamoff, -- .vidioc_g_tuner = vidioc_g_tuner, -- .vidioc_s_tuner = vidioc_s_tuner, -- .vidioc_g_frequency = vidioc_g_frequency, -- .vidioc_s_frequency = vidioc_s_frequency, -- .vidioc_g_parm = vidioc_g_parm, -- .vidioc_s_parm = vidioc_s_parm, -- .vidioc_enum_framesizes = vidioc_enum_framesizes, -- .vidioc_enum_frameintervals = vidioc_enum_frameintervals, -- .vidioc_cropcap = vidioc_cropcap, -- .vidioc_g_crop = vidioc_g_crop, -- .vidioc_s_crop = vidioc_s_crop, -- .vidioc_g_jpegcomp = vidioc_g_jpegcomp, -- .vidioc_s_jpegcomp = vidioc_s_jpegcomp, --}; -- --static struct video_device go7007_template = { -- .name = "go7007", -- .fops = &go7007_fops, -- .minor = -1, -- .release = go7007_vfl_release, -- .ioctl_ops = &video_ioctl_ops, -- .tvnorms = V4L2_STD_ALL, -- .current_norm = V4L2_STD_NTSC, --}; -- --int go7007_v4l2_init(struct go7007 *go) --{ -- int rv; -- -- go->video_dev = video_device_alloc(); -- if (go->video_dev == NULL) -- return -ENOMEM; -- memcpy(go->video_dev, &go7007_template, sizeof(go7007_template)); -- go->video_dev->parent = go->dev; -- rv = video_register_device(go->video_dev, VFL_TYPE_GRABBER, -1); -- if (rv < 0) { -- video_device_release(go->video_dev); -- go->video_dev = NULL; -- return rv; -- } -- video_set_drvdata(go->video_dev, go); -- ++go->ref_count; -- printk(KERN_INFO "%s: registered device video%d [v4l2]\n", -- go->video_dev->name, go->video_dev->num); -- -- return 0; --} -- --void go7007_v4l2_remove(struct go7007 *go) --{ -- unsigned long flags; -- -- down(&go->hw_lock); -- if (go->streaming) { -- go->streaming = 0; -- go7007_stream_stop(go); -- spin_lock_irqsave(&go->spinlock, flags); -- abort_queued(go); -- spin_unlock_irqrestore(&go->spinlock, flags); -- } -- up(&go->hw_lock); -- if (go->video_dev) -- video_unregister_device(go->video_dev); --} ---- a/drivers/staging/go7007/Kconfig -+++ /dev/null -@@ -1,37 +0,0 @@ --config VIDEO_GO7007 -- tristate "Go 7007 support" -- depends on VIDEO_DEV && PCI && I2C && INPUT -- depends on SND -- select VIDEOBUF_DMA_SG -- select VIDEO_IR -- select VIDEO_TUNER -- select VIDEO_TVEEPROM -- select SND_PCM -- select CRC32 -- default N -- ---help--- -- This is a video4linux driver for some weird device... -- -- To compile this driver as a module, choose M here: the -- module will be called go7007 -- --config VIDEO_GO7007_USB -- tristate "Go 7007 USB support" -- depends on VIDEO_GO7007 && USB -- default N -- ---help--- -- This is a video4linux driver for some weird device... -- -- To compile this driver as a module, choose M here: the -- module will be called go7007-usb -- --config VIDEO_GO7007_USB_S2250_BOARD -- tristate "Sensoray 2250/2251 support" -- depends on VIDEO_GO7007_USB && DVB_USB -- default N -- ---help--- -- This is a video4linux driver for the Sensoray 2250/2251 device -- -- To compile this driver as a module, choose M here: the -- module will be called s2250-board -- ---- a/drivers/staging/go7007/Makefile -+++ /dev/null -@@ -1,27 +0,0 @@ --#obj-m += go7007.o go7007-usb.o snd-go7007.o wis-saa7115.o wis-tw9903.o \ -- wis-uda1342.o wis-sony-tuner.o wis-saa7113.o wis-ov7640.o \ -- wis-tw2804.o -- -- --obj-$(CONFIG_VIDEO_GO7007) += go7007.o --obj-$(CONFIG_VIDEO_GO7007_USB) += go7007-usb.o --obj-$(CONFIG_VIDEO_GO7007_USB_S2250_BOARD) += s2250.o -- --go7007-objs += go7007-v4l2.o go7007-driver.o go7007-i2c.o go7007-fw.o \ -- snd-go7007.o wis-saa7113.o -- --s2250-objs += s2250-board.o s2250-loader.o -- --# Uncompile when the saa7134 patches get into upstream --#ifneq ($(CONFIG_VIDEO_SAA7134),) --#obj-$(CONFIG_VIDEO_SAA7134) += saa7134-go7007.o --#EXTRA_CFLAGS += -Idrivers/media/video/saa7134 --#endif -- --ifneq ($(CONFIG_VIDEO_GO7007_USB_S2250_BOARD),) --EXTRA_CFLAGS += -Idrivers/media/dvb/dvb-usb --endif -- --EXTRA_CFLAGS += -Idrivers/staging/saa7134 --EXTRA_CFLAGS += -Idrivers/media/dvb/frontends --EXTRA_CFLAGS += -Idrivers/media/dvb/dvb-core ---- a/drivers/staging/go7007/README -+++ /dev/null -@@ -1,11 +0,0 @@ --Todo: -- - checkpatch.pl cleanups -- - sparse cleanups -- - lots of little modules, should be merged together -- and added to the build. -- - testing? -- - handle churn in v4l layer. -- --Please send patchs to Greg Kroah-Hartman <greg@kroah.com> and Cc: Ross --Cohen <rcohen@snurgle.org> as well. -- ---- a/drivers/staging/go7007/s2250-board.c -+++ /dev/null -@@ -1,622 +0,0 @@ --/* -- * Copyright (C) 2008 Sensoray Company Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/usb.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <media/v4l2-common.h> --#include "go7007-priv.h" --#include "wis-i2c.h" -- --extern int s2250loader_init(void); --extern void s2250loader_cleanup(void); -- --#define TLV320_ADDRESS 0x34 --#define VPX322_ADDR_ANALOGCONTROL1 0x02 --#define VPX322_ADDR_BRIGHTNESS0 0x0127 --#define VPX322_ADDR_BRIGHTNESS1 0x0131 --#define VPX322_ADDR_CONTRAST0 0x0128 --#define VPX322_ADDR_CONTRAST1 0x0132 --#define VPX322_ADDR_HUE 0x00dc --#define VPX322_ADDR_SAT 0x0030 -- --struct go7007_usb_board { -- unsigned int flags; -- struct go7007_board_info main_info; --}; -- --struct go7007_usb { -- struct go7007_usb_board *board; -- struct semaphore i2c_lock; -- struct usb_device *usbdev; -- struct urb *video_urbs[8]; -- struct urb *audio_urbs[8]; -- struct urb *intr_urb; --}; -- --static unsigned char aud_regs[] = { -- 0x1e, 0x00, -- 0x00, 0x17, -- 0x02, 0x17, -- 0x04, 0xf9, -- 0x06, 0xf9, -- 0x08, 0x02, -- 0x0a, 0x00, -- 0x0c, 0x00, -- 0x0a, 0x00, -- 0x0c, 0x00, -- 0x0e, 0x02, -- 0x10, 0x00, -- 0x12, 0x01, -- 0x00, 0x00, --}; -- -- --static unsigned char vid_regs[] = { -- 0xF2, 0x0f, -- 0xAA, 0x00, -- 0xF8, 0xff, -- 0x00, 0x00, --}; -- --static u16 vid_regs_fp[] = { -- 0x028, 0x067, -- 0x120, 0x016, -- 0x121, 0xcF2, -- 0x122, 0x0F2, -- 0x123, 0x00c, -- 0x124, 0x2d0, -- 0x125, 0x2e0, -- 0x126, 0x004, -- 0x128, 0x1E0, -- 0x12A, 0x016, -- 0x12B, 0x0F2, -- 0x12C, 0x0F2, -- 0x12D, 0x00c, -- 0x12E, 0x2d0, -- 0x12F, 0x2e0, -- 0x130, 0x004, -- 0x132, 0x1E0, -- 0x140, 0x060, -- 0x153, 0x00C, -- 0x154, 0x200, -- 0x150, 0x801, -- 0x000, 0x000 --}; -- --/* PAL specific values */ --static u16 vid_regs_fp_pal[] = --{ -- 0x120, 0x017, -- 0x121, 0xd22, -- 0x122, 0x122, -- 0x12A, 0x017, -- 0x12B, 0x122, -- 0x12C, 0x122, -- 0x140, 0x060, -- 0x000, 0x000, --}; -- --struct s2250 { -- int std; -- int input; -- int brightness; -- int contrast; -- int saturation; -- int hue; -- int reg12b_val; -- int audio_input; -- struct i2c_client *audio; --}; -- --/* from go7007-usb.c which is Copyright (C) 2005-2006 Micronas USA Inc.*/ --static int go7007_usb_vendor_request(struct go7007 *go, u16 request, -- u16 value, u16 index, void *transfer_buffer, int length, int in) --{ -- struct go7007_usb *usb = go->hpi_context; -- int timeout = 5000; -- -- if (in) { -- return usb_control_msg(usb->usbdev, -- usb_rcvctrlpipe(usb->usbdev, 0), request, -- USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, -- value, index, transfer_buffer, length, timeout); -- } else { -- return usb_control_msg(usb->usbdev, -- usb_sndctrlpipe(usb->usbdev, 0), request, -- USB_TYPE_VENDOR | USB_RECIP_DEVICE, -- value, index, transfer_buffer, length, timeout); -- } --} --/* end from go7007-usb.c which is Copyright (C) 2005-2006 Micronas USA Inc.*/ -- --static int write_reg(struct i2c_client *client, u8 reg, u8 value) --{ -- struct go7007 *go = i2c_get_adapdata(client->adapter); -- struct go7007_usb *usb; -- int rc; -- int dev_addr = client->addr; -- u8 *buf; -- -- if (go == NULL) -- return -ENODEV; -- -- if (go->status == STATUS_SHUTDOWN) -- return -EBUSY; -- -- buf = kzalloc(16, GFP_KERNEL); -- if (buf == NULL) -- return -ENOMEM; -- -- usb = go->hpi_context; -- if (down_interruptible(&usb->i2c_lock) != 0) { -- printk(KERN_INFO "i2c lock failed\n"); -- kfree(buf); -- return -EINTR; -- } -- rc = go7007_usb_vendor_request(go, 0x55, dev_addr, -- (reg<<8 | value), -- buf, -- 16, 1); -- -- up(&usb->i2c_lock); -- kfree(buf); -- return rc; --} -- --static int write_reg_fp(struct i2c_client *client, u16 addr, u16 val) --{ -- struct go7007 *go = i2c_get_adapdata(client->adapter); -- struct go7007_usb *usb; -- u8 *buf; -- struct s2250 *dec = i2c_get_clientdata(client); -- -- if (go == NULL) -- return -ENODEV; -- -- if (go->status == STATUS_SHUTDOWN) -- return -EBUSY; -- -- buf = kzalloc(16, GFP_KERNEL); -- -- if (buf == NULL) -- return -ENOMEM; -- -- -- -- memset(buf, 0xcd, 6); -- -- usb = go->hpi_context; -- if (down_interruptible(&usb->i2c_lock) != 0) { -- printk(KERN_INFO "i2c lock failed\n"); -- return -EINTR; -- } -- if (go7007_usb_vendor_request(go, 0x57, addr, val, buf, 16, 1) < 0) -- return -EFAULT; -- -- up(&usb->i2c_lock); -- if (buf[0] == 0) { -- unsigned int subaddr, val_read; -- -- subaddr = (buf[4] << 8) + buf[5]; -- val_read = (buf[2] << 8) + buf[3]; -- if (val_read != val) { -- printk(KERN_INFO "invalid fp write %x %x\n", -- val_read, val); -- return -EFAULT; -- } -- if (subaddr != addr) { -- printk(KERN_INFO "invalid fp write addr %x %x\n", -- subaddr, addr); -- return -EFAULT; -- } -- } else -- return -EFAULT; -- -- /* save last 12b value */ -- if (addr == 0x12b) -- dec->reg12b_val = val; -- -- return 0; --} -- --static int write_regs(struct i2c_client *client, u8 *regs) --{ -- int i; -- -- for (i = 0; !((regs[i] == 0x00) && (regs[i+1] == 0x00)); i += 2) { -- if (write_reg(client, regs[i], regs[i+1]) < 0) { -- printk(KERN_INFO "s2250: failed\n"); -- return -1; -- } -- } -- return 0; --} -- --static int write_regs_fp(struct i2c_client *client, u16 *regs) --{ -- int i; -- -- for (i = 0; !((regs[i] == 0x00) && (regs[i+1] == 0x00)); i += 2) { -- if (write_reg_fp(client, regs[i], regs[i+1]) < 0) { -- printk(KERN_INFO "s2250: failed fp\n"); -- return -1; -- } -- } -- return 0; --} -- -- --static int s2250_command(struct i2c_client *client, -- unsigned int cmd, void *arg) --{ -- struct s2250 *dec = i2c_get_clientdata(client); -- -- switch (cmd) { -- case VIDIOC_S_INPUT: -- { -- int vidsys; -- int *input = arg; -- -- vidsys = (dec->std == V4L2_STD_NTSC) ? 0x01 : 0x00; -- if (*input == 0) { -- /* composite */ -- write_reg_fp(client, 0x20, 0x020 | vidsys); -- write_reg_fp(client, 0x21, 0x662); -- write_reg_fp(client, 0x140, 0x060); -- } else { -- /* S-Video */ -- write_reg_fp(client, 0x20, 0x040 | vidsys); -- write_reg_fp(client, 0x21, 0x666); -- write_reg_fp(client, 0x140, 0x060); -- } -- dec->input = *input; -- break; -- } -- case VIDIOC_S_STD: -- { -- v4l2_std_id *std = arg; -- u16 vidsource; -- -- vidsource = (dec->input == 1) ? 0x040 : 0x020; -- dec->std = *std; -- switch (dec->std) { -- case V4L2_STD_NTSC: -- write_regs_fp(client, vid_regs_fp); -- write_reg_fp(client, 0x20, vidsource | 1); -- break; -- case V4L2_STD_PAL: -- write_regs_fp(client, vid_regs_fp); -- write_regs_fp(client, vid_regs_fp_pal); -- write_reg_fp(client, 0x20, vidsource); -- break; -- default: -- return -EINVAL; -- } -- break; -- } -- case VIDIOC_QUERYCTRL: -- { -- struct v4l2_queryctrl *ctrl = arg; -- static const u32 user_ctrls[] = { -- V4L2_CID_BRIGHTNESS, -- V4L2_CID_CONTRAST, -- V4L2_CID_SATURATION, -- V4L2_CID_HUE, -- 0 -- }; -- static const u32 *ctrl_classes[] = { -- user_ctrls, -- NULL -- }; -- -- ctrl->id = v4l2_ctrl_next(ctrl_classes, ctrl->id); -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- v4l2_ctrl_query_fill(ctrl, 0, 100, 1, 50); -- break; -- case V4L2_CID_CONTRAST: -- v4l2_ctrl_query_fill(ctrl, 0, 100, 1, 50); -- break; -- case V4L2_CID_SATURATION: -- v4l2_ctrl_query_fill(ctrl, 0, 100, 1, 50); -- break; -- case V4L2_CID_HUE: -- v4l2_ctrl_query_fill(ctrl, -50, 50, 1, 0); -- break; -- default: -- ctrl->name[0] = '\0'; -- return -EINVAL; -- } -- break; -- } -- case VIDIOC_S_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- int value1; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- printk(KERN_INFO "s2250: future setting\n"); -- return -EINVAL; -- case V4L2_CID_CONTRAST: -- printk(KERN_INFO "s2250: future setting\n"); -- return -EINVAL; -- break; -- case V4L2_CID_SATURATION: -- if (ctrl->value > 127) -- dec->saturation = 127; -- else if (ctrl->value < 0) -- dec->saturation = 0; -- else -- dec->saturation = ctrl->value; -- -- value1 = dec->saturation * 4140 / 100; -- if (value1 > 4094) -- value1 = 4094; -- write_reg_fp(client, VPX322_ADDR_SAT, value1); -- break; -- case V4L2_CID_HUE: -- if (ctrl->value > 50) -- dec->hue = 50; -- else if (ctrl->value < -50) -- dec->hue = -50; -- else -- dec->hue = ctrl->value; -- /* clamp the hue range */ -- value1 = dec->hue * 280 / 50; -- write_reg_fp(client, VPX322_ADDR_HUE, value1); -- break; -- } -- break; -- } -- case VIDIOC_G_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->value = dec->brightness; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->value = dec->contrast; -- break; -- case V4L2_CID_SATURATION: -- ctrl->value = dec->saturation; -- break; -- case V4L2_CID_HUE: -- ctrl->value = dec->hue; -- break; -- } -- break; -- } -- case VIDIOC_S_FMT: -- { -- struct v4l2_format *fmt = arg; -- if (fmt->fmt.pix.height < 640) { -- write_reg_fp(client, 0x12b, dec->reg12b_val | 0x400); -- write_reg_fp(client, 0x140, 0x060); -- } else { -- write_reg_fp(client, 0x12b, dec->reg12b_val & ~0x400); -- write_reg_fp(client, 0x140, 0x060); -- } -- return 0; -- } -- case VIDIOC_G_AUDIO: -- { -- struct v4l2_audio *audio = arg; -- -- memset(audio, 0, sizeof(*audio)); -- audio->index = dec->audio_input; -- /* fall through */ -- } -- case VIDIOC_ENUMAUDIO: -- { -- struct v4l2_audio *audio = arg; -- -- switch (audio->index) { -- case 0: -- strcpy(audio->name, "Line In"); -- break; -- case 1: -- strcpy(audio->name, "Mic"); -- break; -- case 2: -- strcpy(audio->name, "Mic Boost"); -- break; -- default: -- audio->name[0] = '\0'; -- return 0; -- } -- audio->capability = V4L2_AUDCAP_STEREO; -- audio->mode = 0; -- return 0; -- } -- case VIDIOC_S_AUDIO: -- { -- struct v4l2_audio *audio = arg; -- -- switch (audio->index) { -- case 0: -- write_reg(dec->audio, 0x08, 0x02); /* Line In */ -- break; -- case 1: -- write_reg(dec->audio, 0x08, 0x04); /* Mic */ -- break; -- case 2: -- write_reg(dec->audio, 0x08, 0x05); /* Mic Boost */ -- break; -- default: -- return -EINVAL; -- } -- dec->audio_input = audio->index; -- return 0; -- } -- -- default: -- printk(KERN_INFO "s2250: unknown command 0x%x\n", cmd); -- break; -- } -- return 0; --} -- --static int s2250_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_client *audio; -- struct i2c_adapter *adapter = client->adapter; -- struct s2250 *dec; -- u8 *data; -- struct go7007 *go = i2c_get_adapdata(adapter); -- struct go7007_usb *usb = go->hpi_context; -- -- audio = i2c_new_dummy(adapter, TLV320_ADDRESS >> 1); -- if (audio == NULL) -- return -ENOMEM; -- -- dec = kmalloc(sizeof(struct s2250), GFP_KERNEL); -- if (dec == NULL) { -- i2c_unregister_device(audio); -- return -ENOMEM; -- } -- -- dec->std = V4L2_STD_NTSC; -- dec->brightness = 50; -- dec->contrast = 50; -- dec->saturation = 50; -- dec->hue = 0; -- dec->audio = audio; -- i2c_set_clientdata(client, dec); -- -- printk(KERN_DEBUG -- "s2250: initializing video decoder on %s\n", -- adapter->name); -- -- /* initialize the audio */ -- if (write_regs(audio, aud_regs) < 0) { -- printk(KERN_ERR -- "s2250: error initializing audio\n"); -- i2c_unregister_device(audio); -- kfree(dec); -- return 0; -- } -- -- if (write_regs(client, vid_regs) < 0) { -- printk(KERN_ERR -- "s2250: error initializing decoder\n"); -- i2c_unregister_device(audio); -- kfree(dec); -- return 0; -- } -- if (write_regs_fp(client, vid_regs_fp) < 0) { -- printk(KERN_ERR -- "s2250: error initializing decoder\n"); -- i2c_unregister_device(audio); -- kfree(dec); -- return 0; -- } -- /* set default channel */ -- /* composite */ -- write_reg_fp(client, 0x20, 0x020 | 1); -- write_reg_fp(client, 0x21, 0x662); -- write_reg_fp(client, 0x140, 0x060); -- -- /* set default audio input */ -- dec->audio_input = 0; -- write_reg(client, 0x08, 0x02); /* Line In */ -- -- if (down_interruptible(&usb->i2c_lock) == 0) { -- data = kzalloc(16, GFP_KERNEL); -- if (data != NULL) { -- int rc; -- rc = go7007_usb_vendor_request(go, 0x41, 0, 0, -- data, 16, 1); -- if (rc > 0) { -- u8 mask; -- data[0] = 0; -- mask = 1<<5; -- data[0] &= ~mask; -- data[1] |= mask; -- go7007_usb_vendor_request(go, 0x40, 0, -- (data[1]<<8) -- + data[1], -- data, 16, 0); -- } -- kfree(data); -- } -- up(&usb->i2c_lock); -- } -- -- printk("s2250: initialized successfully\n"); -- return 0; --} -- --static int s2250_remove(struct i2c_client *client) --{ -- struct s2250 *dec = i2c_get_clientdata(client); -- -- i2c_set_clientdata(client, NULL); -- i2c_unregister_device(dec->audio); -- kfree(dec); -- return 0; --} -- --static struct i2c_device_id s2250_id[] = { -- { "s2250_board", 0 }, -- { } --}; -- --static struct i2c_driver s2250_driver = { -- .driver = { -- .name = "Sensoray 2250 board driver", -- }, -- .probe = s2250_probe, -- .remove = s2250_remove, -- .command = s2250_command, -- .id_table = s2250_id, --}; -- --static int __init s2250_init(void) --{ -- int r; -- -- r = s2250loader_init(); -- if (r < 0) -- return r; -- -- r = i2c_add_driver(&s2250_driver); -- if (r < 0) -- s2250loader_cleanup(); -- -- return r; --} -- --static void __exit s2250_cleanup(void) --{ -- i2c_del_driver(&s2250_driver); -- -- s2250loader_cleanup(); --} -- --module_init(s2250_init); --module_exit(s2250_cleanup); -- --MODULE_AUTHOR(""); --MODULE_DESCRIPTION("Board driver for Sensoryray 2250"); --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/s2250-loader.c -+++ /dev/null -@@ -1,189 +0,0 @@ --/* -- * Copyright (C) 2008 Sensoray Company Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/smp_lock.h> --#include <linux/usb.h> --#include <dvb-usb.h> -- --#define S2250_LOADER_FIRMWARE "s2250_loader.fw" --#define S2250_FIRMWARE "s2250.fw" -- --typedef struct device_extension_s { -- struct kref kref; -- int minor; -- struct usb_device *usbdev; --} device_extension_t, *pdevice_extension_t; -- --#define USB_s2250loader_MAJOR 240 --#define USB_s2250loader_MINOR_BASE 0 --#define MAX_DEVICES 256 -- --static pdevice_extension_t s2250_dev_table[MAX_DEVICES]; --static DECLARE_MUTEX(s2250_dev_table_mutex); -- --#define to_s2250loader_dev_common(d) container_of(d, device_extension_t, kref) --static void s2250loader_delete(struct kref *kref) --{ -- pdevice_extension_t s = to_s2250loader_dev_common(kref); -- s2250_dev_table[s->minor] = NULL; -- kfree(s); --} -- --static int s2250loader_probe(struct usb_interface *interface, -- const struct usb_device_id *id) --{ -- struct usb_device *usbdev; -- int minor, ret; -- pdevice_extension_t s = NULL; -- const struct firmware *fw; -- -- usbdev = usb_get_dev(interface_to_usbdev(interface)); -- if (!usbdev) { -- printk(KERN_ERR "Enter s2250loader_probe failed\n"); -- return -1; -- } -- printk(KERN_INFO "Enter s2250loader_probe 2.6 kernel\n"); -- printk(KERN_INFO "vendor id 0x%x, device id 0x%x devnum:%d\n", -- usbdev->descriptor.idVendor, usbdev->descriptor.idProduct, -- usbdev->devnum); -- -- if (usbdev->descriptor.bNumConfigurations != 1) { -- printk(KERN_ERR "can't handle multiple config\n"); -- return -1; -- } -- down(&s2250_dev_table_mutex); -- -- for (minor = 0; minor < MAX_DEVICES; minor++) { -- if (s2250_dev_table[minor] == NULL) -- break; -- } -- -- if (minor < 0 || minor >= MAX_DEVICES) { -- printk(KERN_ERR "Invalid minor: %d\n", minor); -- goto failed; -- } -- -- /* Allocate dev data structure */ -- s = kmalloc(sizeof(device_extension_t), GFP_KERNEL); -- if (s == NULL) { -- printk(KERN_ERR "Out of memory\n"); -- goto failed; -- } -- s2250_dev_table[minor] = s; -- -- printk(KERN_INFO "s2250loader_probe: Device %d on Bus %d Minor %d\n", -- usbdev->devnum, usbdev->bus->busnum, minor); -- -- memset(s, 0, sizeof(device_extension_t)); -- s->usbdev = usbdev; -- printk(KERN_INFO "loading 2250 loader\n"); -- -- kref_init(&(s->kref)); -- -- up(&s2250_dev_table_mutex); -- -- if (request_firmware(&fw, S2250_LOADER_FIRMWARE, &usbdev->dev)) { -- printk(KERN_ERR -- "s2250: unable to load firmware from file \"%s\"\n", -- S2250_LOADER_FIRMWARE); -- goto failed2; -- } -- ret = usb_cypress_load_firmware(usbdev, fw, CYPRESS_FX2); -- release_firmware(fw); -- if (0 != ret) { -- printk(KERN_ERR "loader download failed\n"); -- goto failed2; -- } -- -- if (request_firmware(&fw, S2250_FIRMWARE, &usbdev->dev)) { -- printk(KERN_ERR -- "s2250: unable to load firmware from file \"%s\"\n", -- S2250_FIRMWARE); -- goto failed2; -- } -- ret = usb_cypress_load_firmware(usbdev, fw, CYPRESS_FX2); -- release_firmware(fw); -- if (0 != ret) { -- printk(KERN_ERR "firmware_s2250 download failed\n"); -- goto failed2; -- } -- -- usb_set_intfdata(interface, s); -- return 0; -- --failed: -- up(&s2250_dev_table_mutex); --failed2: -- if (s) -- kref_put(&(s->kref), s2250loader_delete); -- -- printk(KERN_ERR "probe failed\n"); -- return -1; --} -- --static void s2250loader_disconnect(struct usb_interface *interface) --{ -- pdevice_extension_t s = usb_get_intfdata(interface); -- printk(KERN_INFO "s2250: disconnect\n"); -- lock_kernel(); -- s = usb_get_intfdata(interface); -- usb_set_intfdata(interface, NULL); -- kref_put(&(s->kref), s2250loader_delete); -- unlock_kernel(); --} -- --static struct usb_device_id s2250loader_ids[] = { -- {USB_DEVICE(0x1943, 0xa250)}, -- {} /* Terminating entry */ --}; -- --MODULE_DEVICE_TABLE(usb, s2250loader_ids); -- --static struct usb_driver s2250loader_driver = { -- .name = "s2250-loader", -- .probe = s2250loader_probe, -- .disconnect = s2250loader_disconnect, -- .id_table = s2250loader_ids, --}; -- --int s2250loader_init(void) --{ -- int r; -- unsigned i = 0; -- -- for (i = 0; i < MAX_DEVICES; i++) -- s2250_dev_table[i] = NULL; -- -- r = usb_register(&s2250loader_driver); -- if (r) { -- printk(KERN_ERR "usb_register failed. Error number %d\n", r); -- return -1; -- } -- -- printk(KERN_INFO "s2250loader_init: driver registered\n"); -- return 0; --} --EXPORT_SYMBOL(s2250loader_init); -- --void s2250loader_cleanup(void) --{ -- printk(KERN_INFO "s2250loader_cleanup\n"); -- usb_deregister(&s2250loader_driver); --} --EXPORT_SYMBOL(s2250loader_cleanup); ---- a/drivers/staging/go7007/saa7134-go7007.c -+++ /dev/null -@@ -1,532 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/kernel.h> --#include <linux/init.h> --#include <linux/spinlock.h> --#include <linux/wait.h> --#include <linux/list.h> --#include <linux/slab.h> --#include <linux/time.h> --#include <linux/mm.h> --#include <linux/usb.h> --#include <linux/i2c.h> --#include <asm/byteorder.h> --#include <media/v4l2-common.h> -- --#include "saa7134-reg.h" --#include "saa7134.h" --#include "go7007-priv.h" -- --#define GO7007_HPI_DEBUG -- --enum hpi_address { -- HPI_ADDR_VIDEO_BUFFER = 0xe4, -- HPI_ADDR_INIT_BUFFER = 0xea, -- HPI_ADDR_INTR_RET_VALUE = 0xee, -- HPI_ADDR_INTR_RET_DATA = 0xec, -- HPI_ADDR_INTR_STATUS = 0xf4, -- HPI_ADDR_INTR_WR_PARAM = 0xf6, -- HPI_ADDR_INTR_WR_INDEX = 0xf8, --}; -- --enum gpio_command { -- GPIO_COMMAND_RESET = 0x00, /* 000b */ -- GPIO_COMMAND_REQ1 = 0x04, /* 001b */ -- GPIO_COMMAND_WRITE = 0x20, /* 010b */ -- GPIO_COMMAND_REQ2 = 0x24, /* 011b */ -- GPIO_COMMAND_READ = 0x80, /* 100b */ -- GPIO_COMMAND_VIDEO = 0x84, /* 101b */ -- GPIO_COMMAND_IDLE = 0xA0, /* 110b */ -- GPIO_COMMAND_ADDR = 0xA4, /* 111b */ --}; -- --struct saa7134_go7007 { -- struct saa7134_dev *dev; -- u8 *top; -- u8 *bottom; -- dma_addr_t top_dma; -- dma_addr_t bottom_dma; --}; -- --static struct go7007_board_info board_voyager = { -- .firmware = "go7007tv.bin", -- .flags = 0, -- .sensor_flags = GO7007_SENSOR_656 | -- GO7007_SENSOR_VALID_ENABLE | -- GO7007_SENSOR_TV | -- GO7007_SENSOR_VBI, -- .audio_flags = GO7007_AUDIO_I2S_MODE_1 | -- GO7007_AUDIO_WORD_16, -- .audio_rate = 48000, -- .audio_bclk_div = 8, -- .audio_main_div = 2, -- .hpi_buffer_cap = 7, -- .num_inputs = 1, -- .inputs = { -- { -- .name = "SAA7134", -- }, -- }, --}; -- --/********************* Driver for GPIO HPI interface *********************/ -- --static int gpio_write(struct saa7134_dev *dev, u8 addr, u16 data) --{ -- saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); -- -- /* Write HPI address */ -- saa_writeb(SAA7134_GPIO_GPSTATUS0, addr); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- -- /* Write low byte */ -- saa_writeb(SAA7134_GPIO_GPSTATUS0, data & 0xff); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- -- /* Write high byte */ -- saa_writeb(SAA7134_GPIO_GPSTATUS0, data >> 8); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- -- return 0; --} -- --static int gpio_read(struct saa7134_dev *dev, u8 addr, u16 *data) --{ -- saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); -- -- /* Write HPI address */ -- saa_writeb(SAA7134_GPIO_GPSTATUS0, addr); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- -- saa_writeb(SAA7134_GPIO_GPMODE0, 0x00); -- -- /* Read low byte */ -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ); -- saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- *data = saa_readb(SAA7134_GPIO_GPSTATUS0); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- -- /* Read high byte */ -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ); -- saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- *data |= saa_readb(SAA7134_GPIO_GPSTATUS0) << 8; -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- -- return 0; --} -- --static int saa7134_go7007_interface_reset(struct go7007 *go) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev = saa->dev; -- u32 status; -- u16 intr_val, intr_data; -- int count = 20; -- -- saa_clearb(SAA7134_TS_PARALLEL, 0x80); /* Disable TS interface */ -- saa_writeb(SAA7134_GPIO_GPMODE2, 0xa4); -- saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); -- -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_RESET); -- msleep(1); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2); -- msleep(10); -- -- saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- -- status = saa_readb(SAA7134_GPIO_GPSTATUS2); -- /*printk(KERN_DEBUG "status is %s\n", status & 0x40 ? "OK" : "not OK"); */ -- -- /* enter command mode...(?) */ -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2); -- -- do { -- saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); -- status = saa_readb(SAA7134_GPIO_GPSTATUS2); -- /*printk(KERN_INFO "gpio is %08x\n", saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2)); */ -- } while (--count > 0); -- -- /* Wait for an interrupt to indicate successful hardware reset */ -- if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 || -- (intr_val & ~0x1) != 0x55aa) { -- printk(KERN_ERR -- "saa7134-go7007: unable to reset the GO7007\n"); -- return -1; -- } -- return 0; --} -- --static int saa7134_go7007_write_interrupt(struct go7007 *go, int addr, int data) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev = saa->dev; -- int i; -- u16 status_reg; -- --#ifdef GO7007_HPI_DEBUG -- printk(KERN_DEBUG -- "saa7134-go7007: WriteInterrupt: %04x %04x\n", addr, data); --#endif -- -- for (i = 0; i < 100; ++i) { -- gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg); -- if (!(status_reg & 0x0010)) -- break; -- msleep(10); -- } -- if (i == 100) { -- printk(KERN_ERR -- "saa7134-go7007: device is hung, status reg = 0x%04x\n", -- status_reg); -- return -1; -- } -- gpio_write(dev, HPI_ADDR_INTR_WR_PARAM, data); -- gpio_write(dev, HPI_ADDR_INTR_WR_INDEX, addr); -- -- return 0; --} -- --static int saa7134_go7007_read_interrupt(struct go7007 *go) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev = saa->dev; -- -- /* XXX we need to wait if there is no interrupt available */ -- go->interrupt_available = 1; -- gpio_read(dev, HPI_ADDR_INTR_RET_VALUE, &go->interrupt_value); -- gpio_read(dev, HPI_ADDR_INTR_RET_DATA, &go->interrupt_data); --#ifdef GO7007_HPI_DEBUG -- printk(KERN_DEBUG "saa7134-go7007: ReadInterrupt: %04x %04x\n", -- go->interrupt_value, go->interrupt_data); --#endif -- return 0; --} -- --static void saa7134_go7007_irq_ts_done(struct saa7134_dev *dev, -- unsigned long status) --{ -- struct go7007 *go = video_get_drvdata(dev->empress_dev); -- struct saa7134_go7007 *saa = go->hpi_context; -- -- if (!go->streaming) -- return; -- if (0 != (status & 0x000f0000)) -- printk(KERN_DEBUG "saa7134-go7007: irq: lost %ld\n", -- (status >> 16) & 0x0f); -- if (status & 0x100000) { -- dma_sync_single(&dev->pci->dev, -- saa->bottom_dma, PAGE_SIZE, DMA_FROM_DEVICE); -- go7007_parse_video_stream(go, saa->bottom, PAGE_SIZE); -- saa_writel(SAA7134_RS_BA2(5), cpu_to_le32(saa->bottom_dma)); -- } else { -- dma_sync_single(&dev->pci->dev, -- saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE); -- go7007_parse_video_stream(go, saa->top, PAGE_SIZE); -- saa_writel(SAA7134_RS_BA1(5), cpu_to_le32(saa->top_dma)); -- } --} -- --static int saa7134_go7007_stream_start(struct go7007 *go) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev = saa->dev; -- -- saa->top_dma = dma_map_page(&dev->pci->dev, virt_to_page(saa->top), -- 0, PAGE_SIZE, DMA_FROM_DEVICE); -- if (!saa->top_dma) -- return -ENOMEM; -- saa->bottom_dma = dma_map_page(&dev->pci->dev, -- virt_to_page(saa->bottom), -- 0, PAGE_SIZE, DMA_FROM_DEVICE); -- if (!saa->bottom_dma) { -- dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE, -- DMA_FROM_DEVICE); -- return -ENOMEM; -- } -- -- saa_writel(SAA7134_VIDEO_PORT_CTRL0 >> 2, 0xA300B000); -- saa_writel(SAA7134_VIDEO_PORT_CTRL4 >> 2, 0x40000200); -- -- /* Set HPI interface for video */ -- saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); -- saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_VIDEO_BUFFER); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); -- saa_writeb(SAA7134_GPIO_GPMODE0, 0x00); -- -- /* Enable TS interface */ -- saa_writeb(SAA7134_TS_PARALLEL, 0xe6); -- -- /* Reset TS interface */ -- saa_setb(SAA7134_TS_SERIAL1, 0x01); -- saa_clearb(SAA7134_TS_SERIAL1, 0x01); -- -- /* Set up transfer block size */ -- saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 128 - 1); -- saa_writeb(SAA7134_TS_DMA0, (PAGE_SIZE >> 7) - 1); -- saa_writeb(SAA7134_TS_DMA1, 0); -- saa_writeb(SAA7134_TS_DMA2, 0); -- -- /* Enable video streaming mode */ -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_VIDEO); -- -- saa_writel(SAA7134_RS_BA1(5), cpu_to_le32(saa->top_dma)); -- saa_writel(SAA7134_RS_BA2(5), cpu_to_le32(saa->bottom_dma)); -- saa_writel(SAA7134_RS_PITCH(5), 128); -- saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_MAX); -- -- /* Enable TS FIFO */ -- saa_setl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5); -- -- /* Enable DMA IRQ */ -- saa_setl(SAA7134_IRQ1, -- SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0); -- -- return 0; --} -- --static int saa7134_go7007_stream_stop(struct go7007 *go) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev; -- -- if (!saa) -- return -EINVAL; -- dev = saa->dev; -- if (!dev) -- return -EINVAL; -- -- /* Shut down TS FIFO */ -- saa_clearl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5); -- -- /* Disable DMA IRQ */ -- saa_clearl(SAA7134_IRQ1, -- SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0); -- -- /* Disable TS interface */ -- saa_clearb(SAA7134_TS_PARALLEL, 0x80); -- -- dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE, -- DMA_FROM_DEVICE); -- dma_unmap_page(&dev->pci->dev, saa->bottom_dma, PAGE_SIZE, -- DMA_FROM_DEVICE); -- -- return 0; --} -- --static int saa7134_go7007_send_firmware(struct go7007 *go, u8 *data, int len) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev = saa->dev; -- u16 status_reg; -- int i; -- --#ifdef GO7007_HPI_DEBUG -- printk(KERN_DEBUG "saa7134-go7007: DownloadBuffer " -- "sending %d bytes\n", len); --#endif -- -- while (len > 0) { -- i = len > 64 ? 64 : len; -- saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); -- saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_INIT_BUFFER); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- while (i-- > 0) { -- saa_writeb(SAA7134_GPIO_GPSTATUS0, *data); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE); -- saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); -- ++data; -- --len; -- } -- for (i = 0; i < 100; ++i) { -- gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg); -- if (!(status_reg & 0x0002)) -- break; -- } -- if (i == 100) { -- printk(KERN_ERR "saa7134-go7007: device is hung, " -- "status reg = 0x%04x\n", status_reg); -- return -1; -- } -- } -- return 0; --} -- --static int saa7134_go7007_send_command(struct go7007 *go, unsigned int cmd, -- void *arg) --{ -- struct saa7134_go7007 *saa = go->hpi_context; -- struct saa7134_dev *dev = saa->dev; -- -- switch (cmd) { -- case VIDIOC_S_STD: -- { -- v4l2_std_id *std = arg; -- return saa7134_s_std_internal(dev, NULL, std); -- } -- case VIDIOC_G_STD: -- { -- v4l2_std_id *std = arg; -- *std = dev->tvnorm->id; -- return 0; -- } -- case VIDIOC_QUERYCTRL: -- { -- struct v4l2_queryctrl *ctrl = arg; -- if (V4L2_CTRL_ID2CLASS(ctrl->id) == V4L2_CTRL_CLASS_USER) -- return saa7134_queryctrl(NULL, NULL, ctrl); -- } -- case VIDIOC_G_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- if (V4L2_CTRL_ID2CLASS(ctrl->id) == V4L2_CTRL_CLASS_USER) -- return saa7134_g_ctrl_internal(dev, NULL, ctrl); -- } -- case VIDIOC_S_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- if (V4L2_CTRL_ID2CLASS(ctrl->id) == V4L2_CTRL_CLASS_USER) -- return saa7134_s_ctrl_internal(dev, NULL, ctrl); -- } -- } -- return -EINVAL; -- --} -- --static struct go7007_hpi_ops saa7134_go7007_hpi_ops = { -- .interface_reset = saa7134_go7007_interface_reset, -- .write_interrupt = saa7134_go7007_write_interrupt, -- .read_interrupt = saa7134_go7007_read_interrupt, -- .stream_start = saa7134_go7007_stream_start, -- .stream_stop = saa7134_go7007_stream_stop, -- .send_firmware = saa7134_go7007_send_firmware, -- .send_command = saa7134_go7007_send_command, --}; -- --/********************* Add/remove functions *********************/ -- --static int saa7134_go7007_init(struct saa7134_dev *dev) --{ -- struct go7007 *go; -- struct saa7134_go7007 *saa; -- -- printk(KERN_DEBUG "saa7134-go7007: probing new SAA713X board\n"); -- -- saa = kmalloc(sizeof(struct saa7134_go7007), GFP_KERNEL); -- if (saa == NULL) -- return -ENOMEM; -- memset(saa, 0, sizeof(struct saa7134_go7007)); -- -- /* Allocate a couple pages for receiving the compressed stream */ -- saa->top = (u8 *)get_zeroed_page(GFP_KERNEL); -- if (!saa->top) -- goto allocfail; -- saa->bottom = (u8 *)get_zeroed_page(GFP_KERNEL); -- if (!saa->bottom) -- goto allocfail; -- -- go = go7007_alloc(&board_voyager, &dev->pci->dev); -- if (go == NULL) -- goto allocfail; -- go->board_id = GO7007_BOARDID_PCI_VOYAGER; -- strncpy(go->name, saa7134_boards[dev->board].name, sizeof(go->name)); -- go->hpi_ops = &saa7134_go7007_hpi_ops; -- go->hpi_context = saa; -- saa->dev = dev; -- -- /* Boot the GO7007 */ -- if (go7007_boot_encoder(go, go->board_info->flags & -- GO7007_BOARD_USE_ONBOARD_I2C) < 0) -- goto initfail; -- -- /* Do any final GO7007 initialization, then register the -- * V4L2 and ALSA interfaces */ -- if (go7007_register_encoder(go) < 0) -- goto initfail; -- dev->empress_dev = go->video_dev; -- video_set_drvdata(dev->empress_dev, go); -- -- go->status = STATUS_ONLINE; -- return 0; -- --initfail: -- go->status = STATUS_SHUTDOWN; -- return 0; -- --allocfail: -- if (saa->top) -- free_page((unsigned long)saa->top); -- if (saa->bottom) -- free_page((unsigned long)saa->bottom); -- kfree(saa); -- return -ENOMEM; --} -- --static int saa7134_go7007_fini(struct saa7134_dev *dev) --{ -- struct go7007 *go; -- struct saa7134_go7007 *saa; -- -- if (NULL == dev->empress_dev) -- return 0; -- -- go = video_get_drvdata(dev->empress_dev); -- saa = go->hpi_context; -- go->status = STATUS_SHUTDOWN; -- free_page((unsigned long)saa->top); -- free_page((unsigned long)saa->bottom); -- kfree(saa); -- go7007_remove(go); -- dev->empress_dev = NULL; -- -- return 0; --} -- --static struct saa7134_mpeg_ops saa7134_go7007_ops = { -- .type = SAA7134_MPEG_GO7007, -- .init = saa7134_go7007_init, -- .fini = saa7134_go7007_fini, -- .irq_ts_done = saa7134_go7007_irq_ts_done, --}; -- --static int __init saa7134_go7007_mod_init(void) --{ -- return saa7134_ts_register(&saa7134_go7007_ops); --} -- --static void __exit saa7134_go7007_mod_cleanup(void) --{ -- saa7134_ts_unregister(&saa7134_go7007_ops); --} -- --module_init(saa7134_go7007_mod_init); --module_exit(saa7134_go7007_mod_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/snd-go7007.c -+++ /dev/null -@@ -1,305 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/kernel.h> --#include <linux/module.h> --#include <linux/moduleparam.h> --#include <linux/init.h> --#include <linux/spinlock.h> --#include <linux/delay.h> --#include <linux/sched.h> --#include <linux/vmalloc.h> --#include <linux/time.h> --#include <linux/mm.h> --#include <linux/i2c.h> --#include <linux/semaphore.h> --#include <linux/uaccess.h> --#include <asm/system.h> --#include <sound/core.h> --#include <sound/pcm.h> --#include <sound/initval.h> -- --#include "go7007-priv.h" -- --static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; --static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; --static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; -- --module_param_array(index, int, NULL, 0444); --module_param_array(id, charp, NULL, 0444); --module_param_array(enable, bool, NULL, 0444); --MODULE_PARM_DESC(index, "Index value for the go7007 audio driver"); --MODULE_PARM_DESC(id, "ID string for the go7007 audio driver"); --MODULE_PARM_DESC(enable, "Enable for the go7007 audio driver"); -- --struct go7007_snd { -- struct snd_card *card; -- struct snd_pcm *pcm; -- struct snd_pcm_substream *substream; -- spinlock_t lock; -- int w_idx; -- int hw_ptr; -- int avail; -- int capturing; --}; -- --static struct snd_pcm_hardware go7007_snd_capture_hw = { -- .info = (SNDRV_PCM_INFO_MMAP | -- SNDRV_PCM_INFO_INTERLEAVED | -- SNDRV_PCM_INFO_BLOCK_TRANSFER | -- SNDRV_PCM_INFO_MMAP_VALID), -- .formats = SNDRV_PCM_FMTBIT_S16_LE, -- .rates = SNDRV_PCM_RATE_48000, -- .rate_min = 48000, -- .rate_max = 48000, -- .channels_min = 2, -- .channels_max = 2, -- .buffer_bytes_max = (128*1024), -- .period_bytes_min = 4096, -- .period_bytes_max = (128*1024), -- .periods_min = 1, -- .periods_max = 32, --}; -- --static void parse_audio_stream_data(struct go7007 *go, u8 *buf, int length) --{ -- struct go7007_snd *gosnd = go->snd_context; -- struct snd_pcm_runtime *runtime = gosnd->substream->runtime; -- int frames = bytes_to_frames(runtime, length); -- -- spin_lock(&gosnd->lock); -- gosnd->hw_ptr += frames; -- if (gosnd->hw_ptr >= runtime->buffer_size) -- gosnd->hw_ptr -= runtime->buffer_size; -- gosnd->avail += frames; -- spin_unlock(&gosnd->lock); -- if (gosnd->w_idx + length > runtime->dma_bytes) { -- int cpy = runtime->dma_bytes - gosnd->w_idx; -- -- memcpy(runtime->dma_area + gosnd->w_idx, buf, cpy); -- length -= cpy; -- buf += cpy; -- gosnd->w_idx = 0; -- } -- memcpy(runtime->dma_area + gosnd->w_idx, buf, length); -- gosnd->w_idx += length; -- spin_lock(&gosnd->lock); -- if (gosnd->avail < runtime->period_size) { -- spin_unlock(&gosnd->lock); -- return; -- } -- gosnd->avail -= runtime->period_size; -- spin_unlock(&gosnd->lock); -- if (gosnd->capturing) -- snd_pcm_period_elapsed(gosnd->substream); --} -- --static int go7007_snd_hw_params(struct snd_pcm_substream *substream, -- struct snd_pcm_hw_params *hw_params) --{ -- struct go7007 *go = snd_pcm_substream_chip(substream); -- unsigned int bytes; -- -- bytes = params_buffer_bytes(hw_params); -- if (substream->runtime->dma_bytes > 0) -- vfree(substream->runtime->dma_area); -- substream->runtime->dma_bytes = 0; -- substream->runtime->dma_area = vmalloc(bytes); -- if (substream->runtime->dma_area == NULL) -- return -ENOMEM; -- substream->runtime->dma_bytes = bytes; -- go->audio_deliver = parse_audio_stream_data; -- return 0; --} -- --static int go7007_snd_hw_free(struct snd_pcm_substream *substream) --{ -- struct go7007 *go = snd_pcm_substream_chip(substream); -- -- go->audio_deliver = NULL; -- if (substream->runtime->dma_bytes > 0) -- vfree(substream->runtime->dma_area); -- substream->runtime->dma_bytes = 0; -- return 0; --} -- --static int go7007_snd_capture_open(struct snd_pcm_substream *substream) --{ -- struct go7007 *go = snd_pcm_substream_chip(substream); -- struct go7007_snd *gosnd = go->snd_context; -- unsigned long flags; -- int r; -- -- spin_lock_irqsave(&gosnd->lock, flags); -- if (gosnd->substream == NULL) { -- gosnd->substream = substream; -- substream->runtime->hw = go7007_snd_capture_hw; -- r = 0; -- } else -- r = -EBUSY; -- spin_unlock_irqrestore(&gosnd->lock, flags); -- return r; --} -- --static int go7007_snd_capture_close(struct snd_pcm_substream *substream) --{ -- struct go7007 *go = snd_pcm_substream_chip(substream); -- struct go7007_snd *gosnd = go->snd_context; -- -- gosnd->substream = NULL; -- return 0; --} -- --static int go7007_snd_pcm_prepare(struct snd_pcm_substream *substream) --{ -- return 0; --} -- --static int go7007_snd_pcm_trigger(struct snd_pcm_substream *substream, int cmd) --{ -- struct go7007 *go = snd_pcm_substream_chip(substream); -- struct go7007_snd *gosnd = go->snd_context; -- -- switch (cmd) { -- case SNDRV_PCM_TRIGGER_START: -- /* Just set a flag to indicate we should signal ALSA when -- * sound comes in */ -- gosnd->capturing = 1; -- return 0; -- case SNDRV_PCM_TRIGGER_STOP: -- gosnd->hw_ptr = gosnd->w_idx = gosnd->avail = 0; -- gosnd->capturing = 0; -- return 0; -- default: -- return -EINVAL; -- } --} -- --static snd_pcm_uframes_t go7007_snd_pcm_pointer(struct snd_pcm_substream *substream) --{ -- struct go7007 *go = snd_pcm_substream_chip(substream); -- struct go7007_snd *gosnd = go->snd_context; -- -- return gosnd->hw_ptr; --} -- --static struct page *go7007_snd_pcm_page(struct snd_pcm_substream *substream, -- unsigned long offset) --{ -- return vmalloc_to_page(substream->runtime->dma_area + offset); --} -- --static struct snd_pcm_ops go7007_snd_capture_ops = { -- .open = go7007_snd_capture_open, -- .close = go7007_snd_capture_close, -- .ioctl = snd_pcm_lib_ioctl, -- .hw_params = go7007_snd_hw_params, -- .hw_free = go7007_snd_hw_free, -- .prepare = go7007_snd_pcm_prepare, -- .trigger = go7007_snd_pcm_trigger, -- .pointer = go7007_snd_pcm_pointer, -- .page = go7007_snd_pcm_page, --}; -- --static int go7007_snd_free(struct snd_device *device) --{ -- struct go7007 *go = device->device_data; -- -- kfree(go->snd_context); -- go->snd_context = NULL; -- if (--go->ref_count == 0) -- kfree(go); -- return 0; --} -- --static struct snd_device_ops go7007_snd_device_ops = { -- .dev_free = go7007_snd_free, --}; -- --int go7007_snd_init(struct go7007 *go) --{ -- static int dev; -- struct go7007_snd *gosnd; -- int ret = 0; -- -- if (dev >= SNDRV_CARDS) -- return -ENODEV; -- if (!enable[dev]) { -- dev++; -- return -ENOENT; -- } -- gosnd = kmalloc(sizeof(struct go7007_snd), GFP_KERNEL); -- if (gosnd == NULL) -- return -ENOMEM; -- spin_lock_init(&gosnd->lock); -- gosnd->hw_ptr = gosnd->w_idx = gosnd->avail = 0; -- gosnd->capturing = 0; -- ret = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, -- &gosnd->card); -- if (ret < 0) { -- kfree(gosnd); -- return ret; -- } -- ret = snd_device_new(gosnd->card, SNDRV_DEV_LOWLEVEL, go, -- &go7007_snd_device_ops); -- if (ret < 0) { -- kfree(gosnd); -- return ret; -- } -- snd_card_set_dev(gosnd->card, go->dev); -- ret = snd_pcm_new(gosnd->card, "go7007", 0, 0, 1, &gosnd->pcm); -- if (ret < 0) { -- snd_card_free(gosnd->card); -- kfree(gosnd); -- return ret; -- } -- strncpy(gosnd->card->driver, "go7007", sizeof(gosnd->card->driver)); -- strncpy(gosnd->card->shortname, go->name, sizeof(gosnd->card->driver)); -- strncpy(gosnd->card->longname, gosnd->card->shortname, -- sizeof(gosnd->card->longname)); -- -- gosnd->pcm->private_data = go; -- snd_pcm_set_ops(gosnd->pcm, SNDRV_PCM_STREAM_CAPTURE, -- &go7007_snd_capture_ops); -- -- ret = snd_card_register(gosnd->card); -- if (ret < 0) { -- snd_card_free(gosnd->card); -- kfree(gosnd); -- return ret; -- } -- -- gosnd->substream = NULL; -- go->snd_context = gosnd; -- ++dev; -- ++go->ref_count; -- -- return 0; --} --EXPORT_SYMBOL(go7007_snd_init); -- --int go7007_snd_remove(struct go7007 *go) --{ -- struct go7007_snd *gosnd = go->snd_context; -- -- snd_card_disconnect(gosnd->card); -- snd_card_free_when_closed(gosnd->card); -- return 0; --} --EXPORT_SYMBOL(go7007_snd_remove); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-i2c.h -+++ /dev/null -@@ -1,47 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --/* Temporary I2C IDs -- these need to be replaced with real registered IDs */ --#define I2C_DRIVERID_WIS_SAA7115 0xf0f0 --#define I2C_DRIVERID_WIS_UDA1342 0xf0f1 --#define I2C_DRIVERID_WIS_SONY_TUNER 0xf0f2 --#define I2C_DRIVERID_WIS_TW9903 0xf0f3 --#define I2C_DRIVERID_WIS_SAA7113 0xf0f4 --#define I2C_DRIVERID_WIS_OV7640 0xf0f5 --#define I2C_DRIVERID_WIS_TW2804 0xf0f6 --#define I2C_DRIVERID_S2250 0xf0f7 -- --/* Flag to indicate that the client needs to be accessed with SCCB semantics */ --/* We re-use the I2C_M_TEN value so the flag passes through the masks in the -- * core I2C code. Major kludge, but the I2C layer ain't exactly flexible. */ --#define I2C_CLIENT_SCCB 0x10 -- --/* Definitions for new video decoder commands */ -- --struct video_decoder_resolution { -- unsigned int width; -- unsigned int height; --}; -- --#define DECODER_SET_RESOLUTION _IOW('d', 200, struct video_decoder_resolution) --#define DECODER_SET_CHANNEL _IOW('d', 201, int) -- --/* Sony tuner types */ -- --#define TUNER_SONY_BTF_PG472Z 200 --#define TUNER_SONY_BTF_PK467Z 201 --#define TUNER_SONY_BTF_PB463Z 202 ---- a/drivers/staging/go7007/wis-ov7640.c -+++ /dev/null -@@ -1,107 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> -- --#include "wis-i2c.h" -- --struct wis_ov7640 { -- int brightness; -- int contrast; -- int saturation; -- int hue; --}; -- --static u8 initial_registers[] = --{ -- 0x12, 0x80, -- 0x12, 0x54, -- 0x14, 0x24, -- 0x15, 0x01, -- 0x28, 0x20, -- 0x75, 0x82, -- 0xFF, 0xFF, /* Terminator (reg 0xFF is unused) */ --}; -- --static int write_regs(struct i2c_client *client, u8 *regs) --{ -- int i; -- -- for (i = 0; regs[i] != 0xFF; i += 2) -- if (i2c_smbus_write_byte_data(client, regs[i], regs[i + 1]) < 0) -- return -1; -- return 0; --} -- --static int wis_ov7640_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) -- return -ENODEV; -- -- client->flags = I2C_CLIENT_SCCB; -- -- printk(KERN_DEBUG -- "wis-ov7640: initializing OV7640 at address %d on %s\n", -- client->addr, adapter->name); -- -- if (write_regs(client, initial_registers) < 0) { -- printk(KERN_ERR "wis-ov7640: error initializing OV7640\n"); -- return -ENODEV; -- } -- -- return 0; --} -- --static int wis_ov7640_remove(struct i2c_client *client) --{ -- return 0; --} -- --static struct i2c_device_id wis_ov7640_id[] = { -- { "wis_ov7640", 0 }, -- { } --}; -- --static struct i2c_driver wis_ov7640_driver = { -- .driver = { -- .name = "WIS OV7640 I2C driver", -- }, -- .probe = wis_ov7640_probe, -- .remove = wis_ov7640_remove, -- .id_table = wis_ov7640_id, --}; -- --static int __init wis_ov7640_init(void) --{ -- return i2c_add_driver(&wis_ov7640_driver); --} -- --static void __exit wis_ov7640_cleanup(void) --{ -- i2c_del_driver(&wis_ov7640_driver); --} -- --module_init(wis_ov7640_init); --module_exit(wis_ov7640_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-saa7113.c -+++ /dev/null -@@ -1,335 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <linux/ioctl.h> -- --#include "wis-i2c.h" -- --struct wis_saa7113 { -- int norm; -- int brightness; -- int contrast; -- int saturation; -- int hue; --}; -- --static u8 initial_registers[] = --{ -- 0x01, 0x08, -- 0x02, 0xc0, -- 0x03, 0x33, -- 0x04, 0x00, -- 0x05, 0x00, -- 0x06, 0xe9, -- 0x07, 0x0d, -- 0x08, 0xd8, -- 0x09, 0x40, -- 0x0a, 0x80, -- 0x0b, 0x47, -- 0x0c, 0x40, -- 0x0d, 0x00, -- 0x0e, 0x01, -- 0x0f, 0x2a, -- 0x10, 0x40, -- 0x11, 0x0c, -- 0x12, 0xfe, -- 0x13, 0x00, -- 0x14, 0x00, -- 0x15, 0x04, -- 0x16, 0x00, -- 0x17, 0x00, -- 0x18, 0x00, -- 0x19, 0x00, -- 0x1a, 0x00, -- 0x1b, 0x00, -- 0x1c, 0x00, -- 0x1d, 0x00, -- 0x1e, 0x00, -- 0x1f, 0xc8, -- 0x40, 0x00, -- 0x41, 0xff, -- 0x42, 0xff, -- 0x43, 0xff, -- 0x44, 0xff, -- 0x45, 0xff, -- 0x46, 0xff, -- 0x47, 0xff, -- 0x48, 0xff, -- 0x49, 0xff, -- 0x4a, 0xff, -- 0x4b, 0xff, -- 0x4c, 0xff, -- 0x4d, 0xff, -- 0x4e, 0xff, -- 0x4f, 0xff, -- 0x50, 0xff, -- 0x51, 0xff, -- 0x52, 0xff, -- 0x53, 0xff, -- 0x54, 0xff, -- 0x55, 0xff, -- 0x56, 0xff, -- 0x57, 0xff, -- 0x58, 0x00, -- 0x59, 0x54, -- 0x5a, 0x07, -- 0x5b, 0x83, -- 0x5c, 0x00, -- 0x5d, 0x00, -- 0x5e, 0x00, -- 0x5f, 0x00, -- 0x60, 0x00, -- 0x61, 0x00, -- 0x00, 0x00, /* Terminator (reg 0x00 is read-only) */ --}; -- --static int write_reg(struct i2c_client *client, u8 reg, u8 value) --{ -- return i2c_smbus_write_byte_data(client, reg, value); --} -- --static int write_regs(struct i2c_client *client, u8 *regs) --{ -- int i; -- -- for (i = 0; regs[i] != 0x00; i += 2) -- if (i2c_smbus_write_byte_data(client, regs[i], regs[i + 1]) < 0) -- return -1; -- return 0; --} -- --static int wis_saa7113_command(struct i2c_client *client, -- unsigned int cmd, void *arg) --{ -- struct wis_saa7113 *dec = i2c_get_clientdata(client); -- -- switch (cmd) { -- case VIDIOC_S_INPUT: -- { -- int *input = arg; -- -- i2c_smbus_write_byte_data(client, 0x02, 0xC0 | *input); -- i2c_smbus_write_byte_data(client, 0x09, -- *input < 6 ? 0x40 : 0x80); -- break; -- } -- case VIDIOC_S_STD: -- { -- v4l2_std_id *input = arg; -- dec->norm = *input; -- if (dec->norm & V4L2_STD_NTSC) { -- write_reg(client, 0x0e, 0x01); -- write_reg(client, 0x10, 0x40); -- } else if (dec->norm & V4L2_STD_PAL) { -- write_reg(client, 0x0e, 0x01); -- write_reg(client, 0x10, 0x48); -- } else if (dec->norm * V4L2_STD_SECAM) { -- write_reg(client, 0x0e, 0x50); -- write_reg(client, 0x10, 0x48); -- } -- break; -- } -- case VIDIOC_QUERYCTRL: -- { -- struct v4l2_queryctrl *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Brightness", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 128; -- ctrl->flags = 0; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Contrast", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 71; -- ctrl->flags = 0; -- break; -- case V4L2_CID_SATURATION: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Saturation", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 64; -- ctrl->flags = 0; -- break; -- case V4L2_CID_HUE: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Hue", sizeof(ctrl->name)); -- ctrl->minimum = -128; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 0; -- ctrl->flags = 0; -- break; -- } -- break; -- } -- case VIDIOC_S_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- if (ctrl->value > 255) -- dec->brightness = 255; -- else if (ctrl->value < 0) -- dec->brightness = 0; -- else -- dec->brightness = ctrl->value; -- write_reg(client, 0x0a, dec->brightness); -- break; -- case V4L2_CID_CONTRAST: -- if (ctrl->value > 127) -- dec->contrast = 127; -- else if (ctrl->value < 0) -- dec->contrast = 0; -- else -- dec->contrast = ctrl->value; -- write_reg(client, 0x0b, dec->contrast); -- break; -- case V4L2_CID_SATURATION: -- if (ctrl->value > 127) -- dec->saturation = 127; -- else if (ctrl->value < 0) -- dec->saturation = 0; -- else -- dec->saturation = ctrl->value; -- write_reg(client, 0x0c, dec->saturation); -- break; -- case V4L2_CID_HUE: -- if (ctrl->value > 127) -- dec->hue = 127; -- else if (ctrl->value < -128) -- dec->hue = -128; -- else -- dec->hue = ctrl->value; -- write_reg(client, 0x0d, dec->hue); -- break; -- } -- break; -- } -- case VIDIOC_G_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->value = dec->brightness; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->value = dec->contrast; -- break; -- case V4L2_CID_SATURATION: -- ctrl->value = dec->saturation; -- break; -- case V4L2_CID_HUE: -- ctrl->value = dec->hue; -- break; -- } -- break; -- } -- default: -- break; -- } -- return 0; --} -- --static int wis_saa7113_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- struct wis_saa7113 *dec; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) -- return -ENODEV; -- -- dec = kmalloc(sizeof(struct wis_saa7113), GFP_KERNEL); -- if (dec == NULL) -- return -ENOMEM; -- -- dec->norm = V4L2_STD_NTSC; -- dec->brightness = 128; -- dec->contrast = 71; -- dec->saturation = 64; -- dec->hue = 0; -- i2c_set_clientdata(client, dec); -- -- printk(KERN_DEBUG -- "wis-saa7113: initializing SAA7113 at address %d on %s\n", -- client->addr, adapter->name); -- -- if (write_regs(client, initial_registers) < 0) { -- printk(KERN_ERR -- "wis-saa7113: error initializing SAA7113\n"); -- kfree(dec); -- return -ENODEV; -- } -- -- return 0; --} -- --static int wis_saa7113_remove(struct i2c_client *client) --{ -- struct wis_saa7113 *dec = i2c_get_clientdata(client); -- -- i2c_set_clientdata(client, NULL); -- kfree(dec); -- return 0; --} -- --static struct i2c_device_id wis_saa7113_id[] = { -- { "wis_saa7113", 0 }, -- { } --}; -- --static struct i2c_driver wis_saa7113_driver = { -- .driver = { -- .name = "WIS SAA7113 I2C driver", -- }, -- .probe = wis_saa7113_probe, -- .remove = wis_saa7113_remove, -- .command = wis_saa7113_command, -- .id_table = wis_saa7113_id, --}; -- --static int __init wis_saa7113_init(void) --{ -- return i2c_add_driver(&wis_saa7113_driver); --} -- --static void __exit wis_saa7113_cleanup(void) --{ -- i2c_del_driver(&wis_saa7113_driver); --} -- --module_init(wis_saa7113_init); --module_exit(wis_saa7113_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-saa7115.c -+++ /dev/null -@@ -1,468 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <linux/ioctl.h> -- --#include "wis-i2c.h" -- --struct wis_saa7115 { -- int norm; -- int brightness; -- int contrast; -- int saturation; -- int hue; --}; -- --static u8 initial_registers[] = --{ -- 0x01, 0x08, -- 0x02, 0xc0, -- 0x03, 0x20, -- 0x04, 0x80, -- 0x05, 0x80, -- 0x06, 0xeb, -- 0x07, 0xe0, -- 0x08, 0xf0, /* always toggle FID */ -- 0x09, 0x40, -- 0x0a, 0x80, -- 0x0b, 0x40, -- 0x0c, 0x40, -- 0x0d, 0x00, -- 0x0e, 0x03, -- 0x0f, 0x2a, -- 0x10, 0x0e, -- 0x11, 0x00, -- 0x12, 0x8d, -- 0x13, 0x00, -- 0x14, 0x00, -- 0x15, 0x11, -- 0x16, 0x01, -- 0x17, 0xda, -- 0x18, 0x40, -- 0x19, 0x80, -- 0x1a, 0x00, -- 0x1b, 0x42, -- 0x1c, 0xa9, -- 0x30, 0x66, -- 0x31, 0x90, -- 0x32, 0x01, -- 0x34, 0x00, -- 0x35, 0x00, -- 0x36, 0x20, -- 0x38, 0x03, -- 0x39, 0x20, -- 0x3a, 0x88, -- 0x40, 0x00, -- 0x41, 0xff, -- 0x42, 0xff, -- 0x43, 0xff, -- 0x44, 0xff, -- 0x45, 0xff, -- 0x46, 0xff, -- 0x47, 0xff, -- 0x48, 0xff, -- 0x49, 0xff, -- 0x4a, 0xff, -- 0x4b, 0xff, -- 0x4c, 0xff, -- 0x4d, 0xff, -- 0x4e, 0xff, -- 0x4f, 0xff, -- 0x50, 0xff, -- 0x51, 0xff, -- 0x52, 0xff, -- 0x53, 0xff, -- 0x54, 0xf4 /*0xff*/, -- 0x55, 0xff, -- 0x56, 0xff, -- 0x57, 0xff, -- 0x58, 0x40, -- 0x59, 0x47, -- 0x5a, 0x06 /*0x03*/, -- 0x5b, 0x83, -- 0x5d, 0x06, -- 0x5e, 0x00, -- 0x80, 0x30, /* window defined scaler operation, task A and B enabled */ -- 0x81, 0x03, /* use scaler datapath generated V */ -- 0x83, 0x00, -- 0x84, 0x00, -- 0x85, 0x00, -- 0x86, 0x45, -- 0x87, 0x31, -- 0x88, 0xc0, -- 0x90, 0x02, /* task A process top field */ -- 0x91, 0x08, -- 0x92, 0x09, -- 0x93, 0x80, -- 0x94, 0x06, -- 0x95, 0x00, -- 0x96, 0xc0, -- 0x97, 0x02, -- 0x98, 0x12, -- 0x99, 0x00, -- 0x9a, 0xf2, -- 0x9b, 0x00, -- 0x9c, 0xd0, -- 0x9d, 0x02, -- 0x9e, 0xf2, -- 0x9f, 0x00, -- 0xa0, 0x01, -- 0xa1, 0x01, -- 0xa2, 0x01, -- 0xa4, 0x80, -- 0xa5, 0x40, -- 0xa6, 0x40, -- 0xa8, 0x00, -- 0xa9, 0x04, -- 0xaa, 0x00, -- 0xac, 0x00, -- 0xad, 0x02, -- 0xae, 0x00, -- 0xb0, 0x00, -- 0xb1, 0x04, -- 0xb2, 0x00, -- 0xb3, 0x04, -- 0xb4, 0x00, -- 0xb8, 0x00, -- 0xbc, 0x00, -- 0xc0, 0x03, /* task B process bottom field */ -- 0xc1, 0x08, -- 0xc2, 0x09, -- 0xc3, 0x80, -- 0xc4, 0x06, -- 0xc5, 0x00, -- 0xc6, 0xc0, -- 0xc7, 0x02, -- 0xc8, 0x12, -- 0xc9, 0x00, -- 0xca, 0xf2, -- 0xcb, 0x00, -- 0xcc, 0xd0, -- 0xcd, 0x02, -- 0xce, 0xf2, -- 0xcf, 0x00, -- 0xd0, 0x01, -- 0xd1, 0x01, -- 0xd2, 0x01, -- 0xd4, 0x80, -- 0xd5, 0x40, -- 0xd6, 0x40, -- 0xd8, 0x00, -- 0xd9, 0x04, -- 0xda, 0x00, -- 0xdc, 0x00, -- 0xdd, 0x02, -- 0xde, 0x00, -- 0xe0, 0x00, -- 0xe1, 0x04, -- 0xe2, 0x00, -- 0xe3, 0x04, -- 0xe4, 0x00, -- 0xe8, 0x00, -- 0x88, 0xf0, /* End of original static list */ -- 0x00, 0x00, /* Terminator (reg 0x00 is read-only) */ --}; -- --static int write_reg(struct i2c_client *client, u8 reg, u8 value) --{ -- return i2c_smbus_write_byte_data(client, reg, value); --} -- --static int write_regs(struct i2c_client *client, u8 *regs) --{ -- int i; -- -- for (i = 0; regs[i] != 0x00; i += 2) -- if (i2c_smbus_write_byte_data(client, regs[i], regs[i + 1]) < 0) -- return -1; -- return 0; --} -- --static int wis_saa7115_command(struct i2c_client *client, -- unsigned int cmd, void *arg) --{ -- struct wis_saa7115 *dec = i2c_get_clientdata(client); -- -- switch (cmd) { -- case VIDIOC_S_INPUT: -- { -- int *input = arg; -- -- i2c_smbus_write_byte_data(client, 0x02, 0xC0 | *input); -- i2c_smbus_write_byte_data(client, 0x09, -- *input < 6 ? 0x40 : 0xC0); -- break; -- } -- case DECODER_SET_RESOLUTION: -- { -- struct video_decoder_resolution *res = arg; -- /* Course-grained scaler */ -- int h_integer_scaler = res->width < 704 ? 704 / res->width : 1; -- /* Fine-grained scaler to take care of remainder */ -- int h_scaling_increment = (704 / h_integer_scaler) * -- 1024 / res->width; -- /* Fine-grained scaler only */ -- int v_scaling_increment = (dec->norm & V4L2_STD_NTSC ? -- 240 : 288) * 1024 / res->height; -- u8 regs[] = { -- 0x88, 0xc0, -- 0x9c, res->width & 0xff, -- 0x9d, res->width >> 8, -- 0x9e, res->height & 0xff, -- 0x9f, res->height >> 8, -- 0xa0, h_integer_scaler, -- 0xa1, 1, -- 0xa2, 1, -- 0xa8, h_scaling_increment & 0xff, -- 0xa9, h_scaling_increment >> 8, -- 0xac, (h_scaling_increment / 2) & 0xff, -- 0xad, (h_scaling_increment / 2) >> 8, -- 0xb0, v_scaling_increment & 0xff, -- 0xb1, v_scaling_increment >> 8, -- 0xb2, v_scaling_increment & 0xff, -- 0xb3, v_scaling_increment >> 8, -- 0xcc, res->width & 0xff, -- 0xcd, res->width >> 8, -- 0xce, res->height & 0xff, -- 0xcf, res->height >> 8, -- 0xd0, h_integer_scaler, -- 0xd1, 1, -- 0xd2, 1, -- 0xd8, h_scaling_increment & 0xff, -- 0xd9, h_scaling_increment >> 8, -- 0xdc, (h_scaling_increment / 2) & 0xff, -- 0xdd, (h_scaling_increment / 2) >> 8, -- 0xe0, v_scaling_increment & 0xff, -- 0xe1, v_scaling_increment >> 8, -- 0xe2, v_scaling_increment & 0xff, -- 0xe3, v_scaling_increment >> 8, -- 0x88, 0xf0, -- 0, 0, -- }; -- write_regs(client, regs); -- break; -- } -- case VIDIOC_S_STD: -- { -- v4l2_std_id *input = arg; -- u8 regs[] = { -- 0x88, 0xc0, -- 0x98, *input & V4L2_STD_NTSC ? 0x12 : 0x16, -- 0x9a, *input & V4L2_STD_NTSC ? 0xf2 : 0x20, -- 0x9b, *input & V4L2_STD_NTSC ? 0x00 : 0x01, -- 0xc8, *input & V4L2_STD_NTSC ? 0x12 : 0x16, -- 0xca, *input & V4L2_STD_NTSC ? 0xf2 : 0x20, -- 0xcb, *input & V4L2_STD_NTSC ? 0x00 : 0x01, -- 0x88, 0xf0, -- 0x30, *input & V4L2_STD_NTSC ? 0x66 : 0x00, -- 0x31, *input & V4L2_STD_NTSC ? 0x90 : 0xe0, -- 0, 0, -- }; -- write_regs(client, regs); -- dec->norm = *input; -- break; -- } -- case VIDIOC_QUERYCTRL: -- { -- struct v4l2_queryctrl *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Brightness", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 128; -- ctrl->flags = 0; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Contrast", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 64; -- ctrl->flags = 0; -- break; -- case V4L2_CID_SATURATION: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Saturation", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 64; -- ctrl->flags = 0; -- break; -- case V4L2_CID_HUE: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Hue", sizeof(ctrl->name)); -- ctrl->minimum = -128; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 0; -- ctrl->flags = 0; -- break; -- } -- break; -- } -- case VIDIOC_S_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- if (ctrl->value > 255) -- dec->brightness = 255; -- else if (ctrl->value < 0) -- dec->brightness = 0; -- else -- dec->brightness = ctrl->value; -- write_reg(client, 0x0a, dec->brightness); -- break; -- case V4L2_CID_CONTRAST: -- if (ctrl->value > 127) -- dec->contrast = 127; -- else if (ctrl->value < 0) -- dec->contrast = 0; -- else -- dec->contrast = ctrl->value; -- write_reg(client, 0x0b, dec->contrast); -- break; -- case V4L2_CID_SATURATION: -- if (ctrl->value > 127) -- dec->saturation = 127; -- else if (ctrl->value < 0) -- dec->saturation = 0; -- else -- dec->saturation = ctrl->value; -- write_reg(client, 0x0c, dec->saturation); -- break; -- case V4L2_CID_HUE: -- if (ctrl->value > 127) -- dec->hue = 127; -- else if (ctrl->value < -128) -- dec->hue = -128; -- else -- dec->hue = ctrl->value; -- write_reg(client, 0x0d, dec->hue); -- break; -- } -- break; -- } -- case VIDIOC_G_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->value = dec->brightness; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->value = dec->contrast; -- break; -- case V4L2_CID_SATURATION: -- ctrl->value = dec->saturation; -- break; -- case V4L2_CID_HUE: -- ctrl->value = dec->hue; -- break; -- } -- break; -- } -- default: -- break; -- } -- return 0; --} -- --static int wis_saa7115_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- struct wis_saa7115 *dec; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) -- return -ENODEV; -- -- dec = kmalloc(sizeof(struct wis_saa7115), GFP_KERNEL); -- if (dec == NULL) -- return -ENOMEM; -- -- dec->norm = V4L2_STD_NTSC; -- dec->brightness = 128; -- dec->contrast = 64; -- dec->saturation = 64; -- dec->hue = 0; -- i2c_set_clientdata(client, dec); -- -- printk(KERN_DEBUG -- "wis-saa7115: initializing SAA7115 at address %d on %s\n", -- client->addr, adapter->name); -- -- if (write_regs(client, initial_registers) < 0) { -- printk(KERN_ERR -- "wis-saa7115: error initializing SAA7115\n"); -- kfree(dec); -- return -ENODEV; -- } -- -- return 0; --} -- --static int wis_saa7115_remove(struct i2c_client *client) --{ -- struct wis_saa7115 *dec = i2c_get_clientdata(client); -- -- i2c_set_clientdata(client, NULL); -- kfree(dec); -- return 0; --} -- --static struct i2c_device_id wis_saa7115_id[] = { -- { "wis_saa7115", 0 }, -- { } --}; -- --static struct i2c_driver wis_saa7115_driver = { -- .driver = { -- .name = "WIS SAA7115 I2C driver", -- }, -- .probe = wis_saa7115_probe, -- .remove = wis_saa7115_remove, -- .command = wis_saa7115_command, -- .id_table = wis_saa7115_id, --}; -- --static int __init wis_saa7115_init(void) --{ -- return i2c_add_driver(&wis_saa7115_driver); --} -- --static void __exit wis_saa7115_cleanup(void) --{ -- i2c_del_driver(&wis_saa7115_driver); --} -- --module_init(wis_saa7115_init); --module_exit(wis_saa7115_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-sony-tuner.c -+++ /dev/null -@@ -1,719 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <media/tuner.h> --#include <media/v4l2-common.h> --#include <media/v4l2-ioctl.h> -- --#include "wis-i2c.h" -- --/* #define MPX_DEBUG */ -- --/* AS(IF/MPX) pin: LOW HIGH/OPEN -- * IF/MPX address: 0x42/0x40 0x43/0x44 -- */ --#define IF_I2C_ADDR 0x43 --#define MPX_I2C_ADDR 0x44 -- --static v4l2_std_id force_band; --static char force_band_str[] = "-"; --module_param_string(force_band, force_band_str, sizeof(force_band_str), 0644); --static int force_mpx_mode = -1; --module_param(force_mpx_mode, int, 0644); -- --/* Store tuner info in the same format as tuner.c, so maybe we can put the -- * Sony tuner support in there. */ --struct sony_tunertype { -- char *name; -- unsigned char Vendor; /* unused here */ -- unsigned char Type; /* unused here */ -- -- unsigned short thresh1; /* band switch VHF_LO <=> VHF_HI */ -- unsigned short thresh2; /* band switch VHF_HI <=> UHF */ -- unsigned char VHF_L; -- unsigned char VHF_H; -- unsigned char UHF; -- unsigned char config; -- unsigned short IFPCoff; --}; -- --/* This array is indexed by (tuner_type - 200) */ --static struct sony_tunertype sony_tuners[] = { -- { "Sony PAL+SECAM (BTF-PG472Z)", 0, 0, -- 16*144.25, 16*427.25, 0x01, 0x02, 0x04, 0xc6, 623}, -- { "Sony NTSC_JP (BTF-PK467Z)", 0, 0, -- 16*220.25, 16*467.25, 0x01, 0x02, 0x04, 0xc6, 940}, -- { "Sony NTSC (BTF-PB463Z)", 0, 0, -- 16*130.25, 16*364.25, 0x01, 0x02, 0x04, 0xc6, 732}, --}; -- --struct wis_sony_tuner { -- int type; -- v4l2_std_id std; -- unsigned int freq; -- int mpxmode; -- u32 audmode; --}; -- --/* Basically the same as default_set_tv_freq() in tuner.c */ --static int set_freq(struct i2c_client *client, int freq) --{ -- struct wis_sony_tuner *t = i2c_get_clientdata(client); -- char *band_name; -- int n; -- int band_select; -- struct sony_tunertype *tun; -- u8 buffer[4]; -- -- tun = &sony_tuners[t->type - 200]; -- if (freq < tun->thresh1) { -- band_name = "VHF_L"; -- band_select = tun->VHF_L; -- } else if (freq < tun->thresh2) { -- band_name = "VHF_H"; -- band_select = tun->VHF_H; -- } else { -- band_name = "UHF"; -- band_select = tun->UHF; -- } -- printk(KERN_DEBUG "wis-sony-tuner: tuning to frequency %d.%04d (%s)\n", -- freq / 16, (freq % 16) * 625, band_name); -- n = freq + tun->IFPCoff; -- -- buffer[0] = n >> 8; -- buffer[1] = n & 0xff; -- buffer[2] = tun->config; -- buffer[3] = band_select; -- i2c_master_send(client, buffer, 4); -- -- return 0; --} -- --static int mpx_write(struct i2c_client *client, int dev, int addr, int val) --{ -- u8 buffer[5]; -- struct i2c_msg msg; -- -- buffer[0] = dev; -- buffer[1] = addr >> 8; -- buffer[2] = addr & 0xff; -- buffer[3] = val >> 8; -- buffer[4] = val & 0xff; -- msg.addr = MPX_I2C_ADDR; -- msg.flags = 0; -- msg.len = 5; -- msg.buf = buffer; -- i2c_transfer(client->adapter, &msg, 1); -- return 0; --} -- --/* -- * MPX register values for the BTF-PG472Z: -- * -- * FM_ NICAM_ SCART_ -- * MODUS SOURCE ACB PRESCAL PRESCAL PRESCAL SYSTEM VOLUME -- * 10/0030 12/0008 12/0013 12/000E 12/0010 12/0000 10/0020 12/0000 -- * --------------------------------------------------------------- -- * Auto 1003 0020 0100 2603 5000 XXXX 0001 7500 -- * -- * B/G -- * Mono 1003 0020 0100 2603 5000 XXXX 0003 7500 -- * A2 1003 0020 0100 2601 5000 XXXX 0003 7500 -- * NICAM 1003 0120 0100 2603 5000 XXXX 0008 7500 -- * -- * I -- * Mono 1003 0020 0100 2603 7900 XXXX 000A 7500 -- * NICAM 1003 0120 0100 2603 7900 XXXX 000A 7500 -- * -- * D/K -- * Mono 1003 0020 0100 2603 5000 XXXX 0004 7500 -- * A2-1 1003 0020 0100 2601 5000 XXXX 0004 7500 -- * A2-2 1003 0020 0100 2601 5000 XXXX 0005 7500 -- * A2-3 1003 0020 0100 2601 5000 XXXX 0007 7500 -- * NICAM 1003 0120 0100 2603 5000 XXXX 000B 7500 -- * -- * L/L' -- * Mono 0003 0200 0100 7C03 5000 2200 0009 7500 -- * NICAM 0003 0120 0100 7C03 5000 XXXX 0009 7500 -- * -- * M -- * Mono 1003 0200 0100 2B03 5000 2B00 0002 7500 -- * -- * For Asia, replace the 0x26XX in FM_PRESCALE with 0x14XX. -- * -- * Bilingual selection in A2/NICAM: -- * -- * High byte of SOURCE Left chan Right chan -- * 0x01 MAIN SUB -- * 0x03 MAIN MAIN -- * 0x04 SUB SUB -- * -- * Force mono in NICAM by setting the high byte of SOURCE to 0x02 (L/L') or -- * 0x00 (all other bands). Force mono in A2 with FMONO_A2: -- * -- * FMONO_A2 -- * 10/0022 -- * -------- -- * Forced mono ON 07F0 -- * Forced mono OFF 0190 -- */ -- --static struct { -- enum { AUD_MONO, AUD_A2, AUD_NICAM, AUD_NICAM_L } audio_mode; -- u16 modus; -- u16 source; -- u16 acb; -- u16 fm_prescale; -- u16 nicam_prescale; -- u16 scart_prescale; -- u16 system; -- u16 volume; --} mpx_audio_modes[] = { -- /* Auto */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603, -- 0x5000, 0x0000, 0x0001, 0x7500 }, -- /* B/G Mono */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603, -- 0x5000, 0x0000, 0x0003, 0x7500 }, -- /* B/G A2 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601, -- 0x5000, 0x0000, 0x0003, 0x7500 }, -- /* B/G NICAM */ { AUD_NICAM, 0x1003, 0x0120, 0x0100, 0x2603, -- 0x5000, 0x0000, 0x0008, 0x7500 }, -- /* I Mono */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603, -- 0x7900, 0x0000, 0x000A, 0x7500 }, -- /* I NICAM */ { AUD_NICAM, 0x1003, 0x0120, 0x0100, 0x2603, -- 0x7900, 0x0000, 0x000A, 0x7500 }, -- /* D/K Mono */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603, -- 0x5000, 0x0000, 0x0004, 0x7500 }, -- /* D/K A2-1 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601, -- 0x5000, 0x0000, 0x0004, 0x7500 }, -- /* D/K A2-2 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601, -- 0x5000, 0x0000, 0x0005, 0x7500 }, -- /* D/K A2-3 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601, -- 0x5000, 0x0000, 0x0007, 0x7500 }, -- /* D/K NICAM */ { AUD_NICAM, 0x1003, 0x0120, 0x0100, 0x2603, -- 0x5000, 0x0000, 0x000B, 0x7500 }, -- /* L/L' Mono */ { AUD_MONO, 0x0003, 0x0200, 0x0100, 0x7C03, -- 0x5000, 0x2200, 0x0009, 0x7500 }, -- /* L/L' NICAM */{ AUD_NICAM_L, 0x0003, 0x0120, 0x0100, 0x7C03, -- 0x5000, 0x0000, 0x0009, 0x7500 }, --}; -- --#define MPX_NUM_MODES ARRAY_SIZE(mpx_audio_modes) -- --static int mpx_setup(struct i2c_client *client) --{ -- struct wis_sony_tuner *t = i2c_get_clientdata(client); -- u16 source = 0; -- u8 buffer[3]; -- struct i2c_msg msg; -- -- /* reset MPX */ -- buffer[0] = 0x00; -- buffer[1] = 0x80; -- buffer[2] = 0x00; -- msg.addr = MPX_I2C_ADDR; -- msg.flags = 0; -- msg.len = 3; -- msg.buf = buffer; -- i2c_transfer(client->adapter, &msg, 1); -- buffer[1] = 0x00; -- i2c_transfer(client->adapter, &msg, 1); -- -- if (mpx_audio_modes[t->mpxmode].audio_mode != AUD_MONO) { -- switch (t->audmode) { -- case V4L2_TUNER_MODE_MONO: -- switch (mpx_audio_modes[t->mpxmode].audio_mode) { -- case AUD_A2: -- source = mpx_audio_modes[t->mpxmode].source; -- break; -- case AUD_NICAM: -- source = 0x0000; -- break; -- case AUD_NICAM_L: -- source = 0x0200; -- break; -- default: -- break; -- } -- break; -- case V4L2_TUNER_MODE_STEREO: -- source = mpx_audio_modes[t->mpxmode].source; -- break; -- case V4L2_TUNER_MODE_LANG1: -- source = 0x0300; -- break; -- case V4L2_TUNER_MODE_LANG2: -- source = 0x0400; -- break; -- } -- source |= mpx_audio_modes[t->mpxmode].source & 0x00ff; -- } else -- source = mpx_audio_modes[t->mpxmode].source; -- -- mpx_write(client, 0x10, 0x0030, mpx_audio_modes[t->mpxmode].modus); -- mpx_write(client, 0x12, 0x0008, source); -- mpx_write(client, 0x12, 0x0013, mpx_audio_modes[t->mpxmode].acb); -- mpx_write(client, 0x12, 0x000e, -- mpx_audio_modes[t->mpxmode].fm_prescale); -- mpx_write(client, 0x12, 0x0010, -- mpx_audio_modes[t->mpxmode].nicam_prescale); -- mpx_write(client, 0x12, 0x000d, -- mpx_audio_modes[t->mpxmode].scart_prescale); -- mpx_write(client, 0x10, 0x0020, mpx_audio_modes[t->mpxmode].system); -- mpx_write(client, 0x12, 0x0000, mpx_audio_modes[t->mpxmode].volume); -- if (mpx_audio_modes[t->mpxmode].audio_mode == AUD_A2) -- mpx_write(client, 0x10, 0x0022, -- t->audmode == V4L2_TUNER_MODE_MONO ? 0x07f0 : 0x0190); -- --#ifdef MPX_DEBUG -- { -- u8 buf1[3], buf2[2]; -- struct i2c_msg msgs[2]; -- -- printk(KERN_DEBUG "wis-sony-tuner: MPX registers: %04x %04x " -- "%04x %04x %04x %04x %04x %04x\n", -- mpx_audio_modes[t->mpxmode].modus, -- source, -- mpx_audio_modes[t->mpxmode].acb, -- mpx_audio_modes[t->mpxmode].fm_prescale, -- mpx_audio_modes[t->mpxmode].nicam_prescale, -- mpx_audio_modes[t->mpxmode].scart_prescale, -- mpx_audio_modes[t->mpxmode].system, -- mpx_audio_modes[t->mpxmode].volume); -- buf1[0] = 0x11; -- buf1[1] = 0x00; -- buf1[2] = 0x7e; -- msgs[0].addr = MPX_I2C_ADDR; -- msgs[0].flags = 0; -- msgs[0].len = 3; -- msgs[0].buf = buf1; -- msgs[1].addr = MPX_I2C_ADDR; -- msgs[1].flags = I2C_M_RD; -- msgs[1].len = 2; -- msgs[1].buf = buf2; -- i2c_transfer(client->adapter, msgs, 2); -- printk(KERN_DEBUG "wis-sony-tuner: MPX system: %02x%02x\n", -- buf2[0], buf2[1]); -- buf1[0] = 0x11; -- buf1[1] = 0x02; -- buf1[2] = 0x00; -- i2c_transfer(client->adapter, msgs, 2); -- printk(KERN_DEBUG "wis-sony-tuner: MPX status: %02x%02x\n", -- buf2[0], buf2[1]); -- } --#endif -- return 0; --} -- --/* -- * IF configuration values for the BTF-PG472Z: -- * -- * B/G: 0x94 0x70 0x49 -- * I: 0x14 0x70 0x4a -- * D/K: 0x14 0x70 0x4b -- * L: 0x04 0x70 0x4b -- * L': 0x44 0x70 0x53 -- * M: 0x50 0x30 0x4c -- */ -- --static int set_if(struct i2c_client *client) --{ -- struct wis_sony_tuner *t = i2c_get_clientdata(client); -- u8 buffer[4]; -- struct i2c_msg msg; -- int default_mpx_mode = 0; -- -- /* configure IF */ -- buffer[0] = 0; -- if (t->std & V4L2_STD_PAL_BG) { -- buffer[1] = 0x94; -- buffer[2] = 0x70; -- buffer[3] = 0x49; -- default_mpx_mode = 1; -- } else if (t->std & V4L2_STD_PAL_I) { -- buffer[1] = 0x14; -- buffer[2] = 0x70; -- buffer[3] = 0x4a; -- default_mpx_mode = 4; -- } else if (t->std & V4L2_STD_PAL_DK) { -- buffer[1] = 0x14; -- buffer[2] = 0x70; -- buffer[3] = 0x4b; -- default_mpx_mode = 6; -- } else if (t->std & V4L2_STD_SECAM_L) { -- buffer[1] = 0x04; -- buffer[2] = 0x70; -- buffer[3] = 0x4b; -- default_mpx_mode = 11; -- } -- msg.addr = IF_I2C_ADDR; -- msg.flags = 0; -- msg.len = 4; -- msg.buf = buffer; -- i2c_transfer(client->adapter, &msg, 1); -- -- /* Select MPX mode if not forced by the user */ -- if (force_mpx_mode >= 0 && force_mpx_mode < MPX_NUM_MODES) -- t->mpxmode = force_mpx_mode; -- else -- t->mpxmode = default_mpx_mode; -- printk(KERN_DEBUG "wis-sony-tuner: setting MPX to mode %d\n", -- t->mpxmode); -- mpx_setup(client); -- -- return 0; --} -- --static int tuner_command(struct i2c_client *client, unsigned int cmd, void *arg) --{ -- struct wis_sony_tuner *t = i2c_get_clientdata(client); -- -- switch (cmd) { --#if 0 --#ifdef TUNER_SET_TYPE_ADDR -- case TUNER_SET_TYPE_ADDR: -- { -- struct tuner_setup *tun_setup = arg; -- int *type = &tun_setup->type; --#else -- case TUNER_SET_TYPE: -- { -- int *type = arg; --#endif -- -- if (t->type >= 0) { -- if (t->type != *type) -- printk(KERN_ERR "wis-sony-tuner: type already " -- "set to %d, ignoring request for %d\n", -- t->type, *type); -- break; -- } -- t->type = *type; -- switch (t->type) { -- case TUNER_SONY_BTF_PG472Z: -- switch (force_band_str[0]) { -- case 'b': -- case 'B': -- case 'g': -- case 'G': -- printk(KERN_INFO "wis-sony-tuner: forcing " -- "tuner to PAL-B/G bands\n"); -- force_band = V4L2_STD_PAL_BG; -- break; -- case 'i': -- case 'I': -- printk(KERN_INFO "wis-sony-tuner: forcing " -- "tuner to PAL-I band\n"); -- force_band = V4L2_STD_PAL_I; -- break; -- case 'd': -- case 'D': -- case 'k': -- case 'K': -- printk(KERN_INFO "wis-sony-tuner: forcing " -- "tuner to PAL-D/K bands\n"); -- force_band = V4L2_STD_PAL_I; -- break; -- case 'l': -- case 'L': -- printk(KERN_INFO "wis-sony-tuner: forcing " -- "tuner to SECAM-L band\n"); -- force_band = V4L2_STD_SECAM_L; -- break; -- default: -- force_band = 0; -- break; -- } -- if (force_band) -- t->std = force_band; -- else -- t->std = V4L2_STD_PAL_BG; -- set_if(client); -- break; -- case TUNER_SONY_BTF_PK467Z: -- t->std = V4L2_STD_NTSC_M_JP; -- break; -- case TUNER_SONY_BTF_PB463Z: -- t->std = V4L2_STD_NTSC_M; -- break; -- default: -- printk(KERN_ERR "wis-sony-tuner: tuner type %d is not " -- "supported by this module\n", *type); -- break; -- } -- if (type >= 0) -- printk(KERN_INFO -- "wis-sony-tuner: type set to %d (%s)\n", -- t->type, sony_tuners[t->type - 200].name); -- break; -- } --#endif -- case VIDIOC_G_FREQUENCY: -- { -- struct v4l2_frequency *f = arg; -- -- f->frequency = t->freq; -- break; -- } -- case VIDIOC_S_FREQUENCY: -- { -- struct v4l2_frequency *f = arg; -- -- t->freq = f->frequency; -- set_freq(client, t->freq); -- break; -- } -- case VIDIOC_ENUMSTD: -- { -- struct v4l2_standard *std = arg; -- -- switch (t->type) { -- case TUNER_SONY_BTF_PG472Z: -- switch (std->index) { -- case 0: -- v4l2_video_std_construct(std, -- V4L2_STD_PAL_BG, "PAL-B/G"); -- break; -- case 1: -- v4l2_video_std_construct(std, -- V4L2_STD_PAL_I, "PAL-I"); -- break; -- case 2: -- v4l2_video_std_construct(std, -- V4L2_STD_PAL_DK, "PAL-D/K"); -- break; -- case 3: -- v4l2_video_std_construct(std, -- V4L2_STD_SECAM_L, "SECAM-L"); -- break; -- default: -- std->id = 0; /* hack to indicate EINVAL */ -- break; -- } -- break; -- case TUNER_SONY_BTF_PK467Z: -- if (std->index != 0) { -- std->id = 0; /* hack to indicate EINVAL */ -- break; -- } -- v4l2_video_std_construct(std, -- V4L2_STD_NTSC_M_JP, "NTSC-J"); -- break; -- case TUNER_SONY_BTF_PB463Z: -- if (std->index != 0) { -- std->id = 0; /* hack to indicate EINVAL */ -- break; -- } -- v4l2_video_std_construct(std, V4L2_STD_NTSC_M, "NTSC"); -- break; -- } -- break; -- } -- case VIDIOC_G_STD: -- { -- v4l2_std_id *std = arg; -- -- *std = t->std; -- break; -- } -- case VIDIOC_S_STD: -- { -- v4l2_std_id *std = arg; -- v4l2_std_id old = t->std; -- -- switch (t->type) { -- case TUNER_SONY_BTF_PG472Z: -- if (force_band && (*std & force_band) != *std && -- *std != V4L2_STD_PAL && -- *std != V4L2_STD_SECAM) { -- printk(KERN_DEBUG "wis-sony-tuner: ignoring " -- "requested TV standard in " -- "favor of force_band value\n"); -- t->std = force_band; -- } else if (*std & V4L2_STD_PAL_BG) { /* default */ -- t->std = V4L2_STD_PAL_BG; -- } else if (*std & V4L2_STD_PAL_I) { -- t->std = V4L2_STD_PAL_I; -- } else if (*std & V4L2_STD_PAL_DK) { -- t->std = V4L2_STD_PAL_DK; -- } else if (*std & V4L2_STD_SECAM_L) { -- t->std = V4L2_STD_SECAM_L; -- } else { -- printk(KERN_ERR "wis-sony-tuner: TV standard " -- "not supported\n"); -- *std = 0; /* hack to indicate EINVAL */ -- break; -- } -- if (old != t->std) -- set_if(client); -- break; -- case TUNER_SONY_BTF_PK467Z: -- if (!(*std & V4L2_STD_NTSC_M_JP)) { -- printk(KERN_ERR "wis-sony-tuner: TV standard " -- "not supported\n"); -- *std = 0; /* hack to indicate EINVAL */ -- } -- break; -- case TUNER_SONY_BTF_PB463Z: -- if (!(*std & V4L2_STD_NTSC_M)) { -- printk(KERN_ERR "wis-sony-tuner: TV standard " -- "not supported\n"); -- *std = 0; /* hack to indicate EINVAL */ -- } -- break; -- } -- break; -- } -- case VIDIOC_QUERYSTD: -- { -- v4l2_std_id *std = arg; -- -- switch (t->type) { -- case TUNER_SONY_BTF_PG472Z: -- if (force_band) -- *std = force_band; -- else -- *std = V4L2_STD_PAL_BG | V4L2_STD_PAL_I | -- V4L2_STD_PAL_DK | V4L2_STD_SECAM_L; -- break; -- case TUNER_SONY_BTF_PK467Z: -- *std = V4L2_STD_NTSC_M_JP; -- break; -- case TUNER_SONY_BTF_PB463Z: -- *std = V4L2_STD_NTSC_M; -- break; -- } -- break; -- } -- case VIDIOC_G_TUNER: -- { -- struct v4l2_tuner *tun = arg; -- -- memset(tun, 0, sizeof(*tun)); -- strcpy(tun->name, "Television"); -- tun->type = V4L2_TUNER_ANALOG_TV; -- tun->rangelow = 0UL; /* does anything use these? */ -- tun->rangehigh = 0xffffffffUL; -- switch (t->type) { -- case TUNER_SONY_BTF_PG472Z: -- tun->capability = V4L2_TUNER_CAP_NORM | -- V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LANG1 | -- V4L2_TUNER_CAP_LANG2; -- tun->rxsubchans = V4L2_TUNER_SUB_MONO | -- V4L2_TUNER_SUB_STEREO | V4L2_TUNER_SUB_LANG1 | -- V4L2_TUNER_SUB_LANG2; -- break; -- case TUNER_SONY_BTF_PK467Z: -- case TUNER_SONY_BTF_PB463Z: -- tun->capability = V4L2_TUNER_CAP_STEREO; -- tun->rxsubchans = V4L2_TUNER_SUB_MONO | -- V4L2_TUNER_SUB_STEREO; -- break; -- } -- tun->audmode = t->audmode; -- return 0; -- } -- case VIDIOC_S_TUNER: -- { -- struct v4l2_tuner *tun = arg; -- -- switch (t->type) { -- case TUNER_SONY_BTF_PG472Z: -- if (tun->audmode != t->audmode) { -- t->audmode = tun->audmode; -- mpx_setup(client); -- } -- break; -- case TUNER_SONY_BTF_PK467Z: -- case TUNER_SONY_BTF_PB463Z: -- break; -- } -- return 0; -- } -- default: -- break; -- } -- return 0; --} -- --static int wis_sony_tuner_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- struct wis_sony_tuner *t; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_I2C_BLOCK)) -- return -ENODEV; -- -- t = kmalloc(sizeof(struct wis_sony_tuner), GFP_KERNEL); -- if (t == NULL) -- return -ENOMEM; -- -- t->type = -1; -- t->freq = 0; -- t->mpxmode = 0; -- t->audmode = V4L2_TUNER_MODE_STEREO; -- i2c_set_clientdata(client, t); -- -- printk(KERN_DEBUG -- "wis-sony-tuner: initializing tuner at address %d on %s\n", -- client->addr, adapter->name); -- -- return 0; --} -- --static int wis_sony_tuner_remove(struct i2c_client *client) --{ -- struct wis_sony_tuner *t = i2c_get_clientdata(client); -- -- i2c_set_clientdata(client, NULL); -- kfree(t); -- return 0; --} -- --static struct i2c_device_id wis_sony_tuner_id[] = { -- { "wis_sony_tuner", 0 }, -- { } --}; -- --static struct i2c_driver wis_sony_tuner_driver = { -- .driver = { -- .name = "WIS Sony TV Tuner I2C driver", -- }, -- .probe = wis_sony_tuner_probe, -- .remove = wis_sony_tuner_remove, -- .command = tuner_command, -- .id_table = wis_sony_tuner_id, --}; -- --static int __init wis_sony_tuner_init(void) --{ -- return i2c_add_driver(&wis_sony_tuner_driver); --} -- --static void __exit wis_sony_tuner_cleanup(void) --{ -- i2c_del_driver(&wis_sony_tuner_driver); --} -- --module_init(wis_sony_tuner_init); --module_exit(wis_sony_tuner_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-tw2804.c -+++ /dev/null -@@ -1,358 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <linux/ioctl.h> -- --#include "wis-i2c.h" -- --struct wis_tw2804 { -- int channel; -- int norm; -- int brightness; -- int contrast; -- int saturation; -- int hue; --}; -- --static u8 global_registers[] = --{ -- 0x39, 0x00, -- 0x3a, 0xff, -- 0x3b, 0x84, -- 0x3c, 0x80, -- 0x3d, 0x80, -- 0x3e, 0x82, -- 0x3f, 0x82, -- 0xff, 0xff, /* Terminator (reg 0xff does not exist) */ --}; -- --static u8 channel_registers[] = --{ -- 0x01, 0xc4, -- 0x02, 0xa5, -- 0x03, 0x20, -- 0x04, 0xd0, -- 0x05, 0x20, -- 0x06, 0xd0, -- 0x07, 0x88, -- 0x08, 0x20, -- 0x09, 0x07, -- 0x0a, 0xf0, -- 0x0b, 0x07, -- 0x0c, 0xf0, -- 0x0d, 0x40, -- 0x0e, 0xd2, -- 0x0f, 0x80, -- 0x10, 0x80, -- 0x11, 0x80, -- 0x12, 0x80, -- 0x13, 0x1f, -- 0x14, 0x00, -- 0x15, 0x00, -- 0x16, 0x00, -- 0x17, 0x00, -- 0x18, 0xff, -- 0x19, 0xff, -- 0x1a, 0xff, -- 0x1b, 0xff, -- 0x1c, 0xff, -- 0x1d, 0xff, -- 0x1e, 0xff, -- 0x1f, 0xff, -- 0x20, 0x07, -- 0x21, 0x07, -- 0x22, 0x00, -- 0x23, 0x91, -- 0x24, 0x51, -- 0x25, 0x03, -- 0x26, 0x00, -- 0x27, 0x00, -- 0x28, 0x00, -- 0x29, 0x00, -- 0x2a, 0x00, -- 0x2b, 0x00, -- 0x2c, 0x00, -- 0x2d, 0x00, -- 0x2e, 0x00, -- 0x2f, 0x00, -- 0x30, 0x00, -- 0x31, 0x00, -- 0x32, 0x00, -- 0x33, 0x00, -- 0x34, 0x00, -- 0x35, 0x00, -- 0x36, 0x00, -- 0x37, 0x00, -- 0xff, 0xff, /* Terminator (reg 0xff does not exist) */ --}; -- --static int write_reg(struct i2c_client *client, u8 reg, u8 value, int channel) --{ -- return i2c_smbus_write_byte_data(client, reg | (channel << 6), value); --} -- --static int write_regs(struct i2c_client *client, u8 *regs, int channel) --{ -- int i; -- -- for (i = 0; regs[i] != 0xff; i += 2) -- if (i2c_smbus_write_byte_data(client, -- regs[i] | (channel << 6), regs[i + 1]) < 0) -- return -1; -- return 0; --} -- --static int wis_tw2804_command(struct i2c_client *client, -- unsigned int cmd, void *arg) --{ -- struct wis_tw2804 *dec = i2c_get_clientdata(client); -- -- if (cmd == DECODER_SET_CHANNEL) { -- int *input = arg; -- -- if (*input < 0 || *input > 3) { -- printk(KERN_ERR "wis-tw2804: channel %d is not " -- "between 0 and 3!\n", *input); -- return 0; -- } -- dec->channel = *input; -- printk(KERN_DEBUG "wis-tw2804: initializing TW2804 " -- "channel %d\n", dec->channel); -- if (dec->channel == 0 && -- write_regs(client, global_registers, 0) < 0) { -- printk(KERN_ERR "wis-tw2804: error initializing " -- "TW2804 global registers\n"); -- return 0; -- } -- if (write_regs(client, channel_registers, dec->channel) < 0) { -- printk(KERN_ERR "wis-tw2804: error initializing " -- "TW2804 channel %d\n", dec->channel); -- return 0; -- } -- return 0; -- } -- -- if (dec->channel < 0) { -- printk(KERN_DEBUG "wis-tw2804: ignoring command %08x until " -- "channel number is set\n", cmd); -- return 0; -- } -- -- switch (cmd) { -- case VIDIOC_S_STD: -- { -- v4l2_std_id *input = arg; -- u8 regs[] = { -- 0x01, *input & V4L2_STD_NTSC ? 0xc4 : 0x84, -- 0x09, *input & V4L2_STD_NTSC ? 0x07 : 0x04, -- 0x0a, *input & V4L2_STD_NTSC ? 0xf0 : 0x20, -- 0x0b, *input & V4L2_STD_NTSC ? 0x07 : 0x04, -- 0x0c, *input & V4L2_STD_NTSC ? 0xf0 : 0x20, -- 0x0d, *input & V4L2_STD_NTSC ? 0x40 : 0x4a, -- 0x16, *input & V4L2_STD_NTSC ? 0x00 : 0x40, -- 0x17, *input & V4L2_STD_NTSC ? 0x00 : 0x40, -- 0x20, *input & V4L2_STD_NTSC ? 0x07 : 0x0f, -- 0x21, *input & V4L2_STD_NTSC ? 0x07 : 0x0f, -- 0xff, 0xff, -- }; -- write_regs(client, regs, dec->channel); -- dec->norm = *input; -- break; -- } -- case VIDIOC_QUERYCTRL: -- { -- struct v4l2_queryctrl *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Brightness", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 128; -- ctrl->flags = 0; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Contrast", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 128; -- ctrl->flags = 0; -- break; -- case V4L2_CID_SATURATION: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Saturation", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 128; -- ctrl->flags = 0; -- break; -- case V4L2_CID_HUE: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Hue", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 128; -- ctrl->flags = 0; -- break; -- } -- break; -- } -- case VIDIOC_S_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- if (ctrl->value > 255) -- dec->brightness = 255; -- else if (ctrl->value < 0) -- dec->brightness = 0; -- else -- dec->brightness = ctrl->value; -- write_reg(client, 0x12, dec->brightness, dec->channel); -- break; -- case V4L2_CID_CONTRAST: -- if (ctrl->value > 255) -- dec->contrast = 255; -- else if (ctrl->value < 0) -- dec->contrast = 0; -- else -- dec->contrast = ctrl->value; -- write_reg(client, 0x11, dec->contrast, dec->channel); -- break; -- case V4L2_CID_SATURATION: -- if (ctrl->value > 255) -- dec->saturation = 255; -- else if (ctrl->value < 0) -- dec->saturation = 0; -- else -- dec->saturation = ctrl->value; -- write_reg(client, 0x10, dec->saturation, dec->channel); -- break; -- case V4L2_CID_HUE: -- if (ctrl->value > 255) -- dec->hue = 255; -- else if (ctrl->value < 0) -- dec->hue = 0; -- else -- dec->hue = ctrl->value; -- write_reg(client, 0x0f, dec->hue, dec->channel); -- break; -- } -- break; -- } -- case VIDIOC_G_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->value = dec->brightness; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->value = dec->contrast; -- break; -- case V4L2_CID_SATURATION: -- ctrl->value = dec->saturation; -- break; -- case V4L2_CID_HUE: -- ctrl->value = dec->hue; -- break; -- } -- break; -- } -- default: -- break; -- } -- return 0; --} -- --static int wis_tw2804_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- struct wis_tw2804 *dec; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) -- return -ENODEV; -- -- dec = kmalloc(sizeof(struct wis_tw2804), GFP_KERNEL); -- if (dec == NULL) -- return -ENOMEM; -- -- dec->channel = -1; -- dec->norm = V4L2_STD_NTSC; -- dec->brightness = 128; -- dec->contrast = 128; -- dec->saturation = 128; -- dec->hue = 128; -- i2c_set_clientdata(client, dec); -- -- printk(KERN_DEBUG "wis-tw2804: creating TW2804 at address %d on %s\n", -- client->addr, adapter->name); -- -- return 0; --} -- --static int wis_tw2804_remove(struct i2c_client *client) --{ -- struct wis_tw2804 *dec = i2c_get_clientdata(client); -- -- i2c_set_clientdata(client, NULL); -- kfree(dec); -- return 0; --} -- --static struct i2c_device_id wis_tw2804_id[] = { -- { "wis_tw2804", 0 }, -- { } --}; -- --static struct i2c_driver wis_tw2804_driver = { -- .driver = { -- .name = "WIS TW2804 I2C driver", -- }, -- .probe = wis_tw2804_probe, -- .remove = wis_tw2804_remove, -- .command = wis_tw2804_command, -- .id_table = wis_tw2804_id, --}; -- --static int __init wis_tw2804_init(void) --{ -- return i2c_add_driver(&wis_tw2804_driver); --} -- --static void __exit wis_tw2804_cleanup(void) --{ -- i2c_del_driver(&wis_tw2804_driver); --} -- --module_init(wis_tw2804_init); --module_exit(wis_tw2804_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-tw9903.c -+++ /dev/null -@@ -1,339 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <linux/ioctl.h> -- --#include "wis-i2c.h" -- --struct wis_tw9903 { -- int norm; -- int brightness; -- int contrast; -- int hue; --}; -- --static u8 initial_registers[] = --{ -- 0x02, 0x44, /* input 1, composite */ -- 0x03, 0x92, /* correct digital format */ -- 0x04, 0x00, -- 0x05, 0x80, /* or 0x00 for PAL */ -- 0x06, 0x40, /* second internal current reference */ -- 0x07, 0x02, /* window */ -- 0x08, 0x14, /* window */ -- 0x09, 0xf0, /* window */ -- 0x0a, 0x81, /* window */ -- 0x0b, 0xd0, /* window */ -- 0x0c, 0x8c, -- 0x0d, 0x00, /* scaling */ -- 0x0e, 0x11, /* scaling */ -- 0x0f, 0x00, /* scaling */ -- 0x10, 0x00, /* brightness */ -- 0x11, 0x60, /* contrast */ -- 0x12, 0x01, /* sharpness */ -- 0x13, 0x7f, /* U gain */ -- 0x14, 0x5a, /* V gain */ -- 0x15, 0x00, /* hue */ -- 0x16, 0xc3, /* sharpness */ -- 0x18, 0x00, -- 0x19, 0x58, /* vbi */ -- 0x1a, 0x80, -- 0x1c, 0x0f, /* video norm */ -- 0x1d, 0x7f, /* video norm */ -- 0x20, 0xa0, /* clamping gain (working 0x50) */ -- 0x21, 0x22, -- 0x22, 0xf0, -- 0x23, 0xfe, -- 0x24, 0x3c, -- 0x25, 0x38, -- 0x26, 0x44, -- 0x27, 0x20, -- 0x28, 0x00, -- 0x29, 0x15, -- 0x2a, 0xa0, -- 0x2b, 0x44, -- 0x2c, 0x37, -- 0x2d, 0x00, -- 0x2e, 0xa5, /* burst PLL control (working: a9) */ -- 0x2f, 0xe0, /* 0xea is blue test frame -- 0xe0 for normal */ -- 0x31, 0x00, -- 0x33, 0x22, -- 0x34, 0x11, -- 0x35, 0x35, -- 0x3b, 0x05, -- 0x06, 0xc0, /* reset device */ -- 0x00, 0x00, /* Terminator (reg 0x00 is read-only) */ --}; -- --static int write_reg(struct i2c_client *client, u8 reg, u8 value) --{ -- return i2c_smbus_write_byte_data(client, reg, value); --} -- --static int write_regs(struct i2c_client *client, u8 *regs) --{ -- int i; -- -- for (i = 0; regs[i] != 0x00; i += 2) -- if (i2c_smbus_write_byte_data(client, regs[i], regs[i + 1]) < 0) -- return -1; -- return 0; --} -- --static int wis_tw9903_command(struct i2c_client *client, -- unsigned int cmd, void *arg) --{ -- struct wis_tw9903 *dec = i2c_get_clientdata(client); -- -- switch (cmd) { -- case VIDIOC_S_INPUT: -- { -- int *input = arg; -- -- i2c_smbus_write_byte_data(client, 0x02, 0x40 | (*input << 1)); -- break; -- } --#if 0 /* The scaler on this thing seems to be horribly broken */ -- case DECODER_SET_RESOLUTION: -- { -- struct video_decoder_resolution *res = arg; -- /*int hscale = 256 * 720 / res->width;*/ -- int hscale = 256 * 720 / (res->width - (res->width > 704 ? 0 : 8)); -- int vscale = 256 * (dec->norm & V4L2_STD_NTSC ? 240 : 288) -- / res->height; -- u8 regs[] = { -- 0x0d, vscale & 0xff, -- 0x0f, hscale & 0xff, -- 0x0e, ((vscale & 0xf00) >> 4) | ((hscale & 0xf00) >> 8), -- 0x06, 0xc0, /* reset device */ -- 0, 0, -- }; -- printk(KERN_DEBUG "vscale is %04x, hscale is %04x\n", -- vscale, hscale); -- /*write_regs(client, regs);*/ -- break; -- } --#endif -- case VIDIOC_S_STD: -- { -- v4l2_std_id *input = arg; -- u8 regs[] = { -- 0x05, *input & V4L2_STD_NTSC ? 0x80 : 0x00, -- 0x07, *input & V4L2_STD_NTSC ? 0x02 : 0x12, -- 0x08, *input & V4L2_STD_NTSC ? 0x14 : 0x18, -- 0x09, *input & V4L2_STD_NTSC ? 0xf0 : 0x20, -- 0, 0, -- }; -- write_regs(client, regs); -- dec->norm = *input; -- break; -- } -- case VIDIOC_QUERYCTRL: -- { -- struct v4l2_queryctrl *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Brightness", sizeof(ctrl->name)); -- ctrl->minimum = -128; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 0x00; -- ctrl->flags = 0; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Contrast", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 255; -- ctrl->step = 1; -- ctrl->default_value = 0x60; -- ctrl->flags = 0; -- break; --#if 0 -- /* I don't understand how the Chroma Gain registers work... */ -- case V4L2_CID_SATURATION: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Saturation", sizeof(ctrl->name)); -- ctrl->minimum = 0; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 64; -- ctrl->flags = 0; -- break; --#endif -- case V4L2_CID_HUE: -- ctrl->type = V4L2_CTRL_TYPE_INTEGER; -- strncpy(ctrl->name, "Hue", sizeof(ctrl->name)); -- ctrl->minimum = -128; -- ctrl->maximum = 127; -- ctrl->step = 1; -- ctrl->default_value = 0; -- ctrl->flags = 0; -- break; -- } -- break; -- } -- case VIDIOC_S_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- if (ctrl->value > 127) -- dec->brightness = 127; -- else if (ctrl->value < -128) -- dec->brightness = -128; -- else -- dec->brightness = ctrl->value; -- write_reg(client, 0x10, dec->brightness); -- break; -- case V4L2_CID_CONTRAST: -- if (ctrl->value > 255) -- dec->contrast = 255; -- else if (ctrl->value < 0) -- dec->contrast = 0; -- else -- dec->contrast = ctrl->value; -- write_reg(client, 0x11, dec->contrast); -- break; --#if 0 -- case V4L2_CID_SATURATION: -- if (ctrl->value > 127) -- dec->saturation = 127; -- else if (ctrl->value < 0) -- dec->saturation = 0; -- else -- dec->saturation = ctrl->value; -- /*write_reg(client, 0x0c, dec->saturation);*/ -- break; --#endif -- case V4L2_CID_HUE: -- if (ctrl->value > 127) -- dec->hue = 127; -- else if (ctrl->value < -128) -- dec->hue = -128; -- else -- dec->hue = ctrl->value; -- write_reg(client, 0x15, dec->hue); -- break; -- } -- break; -- } -- case VIDIOC_G_CTRL: -- { -- struct v4l2_control *ctrl = arg; -- -- switch (ctrl->id) { -- case V4L2_CID_BRIGHTNESS: -- ctrl->value = dec->brightness; -- break; -- case V4L2_CID_CONTRAST: -- ctrl->value = dec->contrast; -- break; --#if 0 -- case V4L2_CID_SATURATION: -- ctrl->value = dec->saturation; -- break; --#endif -- case V4L2_CID_HUE: -- ctrl->value = dec->hue; -- break; -- } -- break; -- } -- default: -- break; -- } -- return 0; --} -- --static int wis_tw9903_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- struct wis_tw9903 *dec; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) -- return -ENODEV; -- -- dec = kmalloc(sizeof(struct wis_tw9903), GFP_KERNEL); -- if (dec == NULL) -- return -ENOMEM; -- -- dec->norm = V4L2_STD_NTSC; -- dec->brightness = 0; -- dec->contrast = 0x60; -- dec->hue = 0; -- i2c_set_clientdata(client, dec); -- -- printk(KERN_DEBUG -- "wis-tw9903: initializing TW9903 at address %d on %s\n", -- client->addr, adapter->name); -- -- if (write_regs(client, initial_registers) < 0) { -- printk(KERN_ERR "wis-tw9903: error initializing TW9903\n"); -- kfree(dec); -- return -ENODEV; -- } -- -- return 0; --} -- --static int wis_tw9903_remove(struct i2c_client *client) --{ -- struct wis_tw9903 *dec = i2c_get_clientdata(client); -- -- i2c_set_clientdata(client, NULL); -- kfree(dec); -- return 0; --} -- --static struct i2c_device_id wis_tw9903_id[] = { -- { "wis_tw9903", 0 }, -- { } --}; -- --static struct i2c_driver wis_tw9903_driver = { -- .driver = { -- .name = "WIS TW9903 I2C driver", -- }, -- .probe = wis_tw9903_probe, -- .remove = wis_tw9903_remove, -- .command = wis_tw9903_command, -- .id_table = wis_tw9903_id, --}; -- --static int __init wis_tw9903_init(void) --{ -- return i2c_add_driver(&wis_tw9903_driver); --} -- --static void __exit wis_tw9903_cleanup(void) --{ -- i2c_del_driver(&wis_tw9903_driver); --} -- --module_init(wis_tw9903_init); --module_exit(wis_tw9903_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/go7007/wis-uda1342.c -+++ /dev/null -@@ -1,113 +0,0 @@ --/* -- * Copyright (C) 2005-2006 Micronas USA Inc. -- * -- * This program is free software; you can redistribute it and/or modify -- * it under the terms of the GNU General Public License (Version 2) as -- * published by the Free Software Foundation. -- * -- * This program is distributed in the hope that it will be useful, -- * but WITHOUT ANY WARRANTY; without even the implied warranty of -- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the -- * GNU General Public License for more details. -- * -- * You should have received a copy of the GNU General Public License -- * along with this program; if not, write to the Free Software Foundation, -- * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. -- */ -- --#include <linux/module.h> --#include <linux/init.h> --#include <linux/i2c.h> --#include <linux/videodev2.h> --#include <media/tvaudio.h> --#include <media/v4l2-common.h> -- --#include "wis-i2c.h" -- --static int write_reg(struct i2c_client *client, int reg, int value) --{ -- /* UDA1342 wants MSB first, but SMBus sends LSB first */ -- i2c_smbus_write_word_data(client, reg, swab16(value)); -- return 0; --} -- --static int wis_uda1342_command(struct i2c_client *client, -- unsigned int cmd, void *arg) --{ -- switch (cmd) { -- case VIDIOC_S_AUDIO: -- { -- int *inp = arg; -- -- switch (*inp) { -- case TVAUDIO_INPUT_TUNER: -- write_reg(client, 0x00, 0x1441); /* select input 2 */ -- break; -- case TVAUDIO_INPUT_EXTERN: -- write_reg(client, 0x00, 0x1241); /* select input 1 */ -- break; -- default: -- printk(KERN_ERR "wis-uda1342: input %d not supported\n", -- *inp); -- break; -- } -- break; -- } -- default: -- break; -- } -- return 0; --} -- --static int wis_uda1342_probe(struct i2c_client *client, -- const struct i2c_device_id *id) --{ -- struct i2c_adapter *adapter = client->adapter; -- -- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA)) -- return -ENODEV; -- -- printk(KERN_DEBUG -- "wis-uda1342: initializing UDA1342 at address %d on %s\n", -- client->addr, adapter->name); -- -- write_reg(client, 0x00, 0x8000); /* reset registers */ -- write_reg(client, 0x00, 0x1241); /* select input 1 */ -- -- return 0; --} -- --static int wis_uda1342_remove(struct i2c_client *client) --{ -- return 0; --} -- --static struct i2c_device_id wis_uda1342_id[] = { -- { "wis_uda1342", 0 }, -- { } --}; -- --static struct i2c_driver wis_uda1342_driver = { -- .driver = { -- .name = "WIS UDA1342 I2C driver", -- }, -- .probe = wis_uda1342_probe, -- .remove = wis_uda1342_remove, -- .command = wis_uda1342_command, -- .id_table = wis_uda1342_id, --}; -- --static int __init wis_uda1342_init(void) --{ -- return i2c_add_driver(&wis_uda1342_driver); --} -- --static void __exit wis_uda1342_cleanup(void) --{ -- i2c_del_driver(&wis_uda1342_driver); --} -- --module_init(wis_uda1342_init); --module_exit(wis_uda1342_cleanup); -- --MODULE_LICENSE("GPL v2"); ---- a/drivers/staging/Kconfig -+++ b/drivers/staging/Kconfig -@@ -47,8 +47,6 @@ source "drivers/staging/slicoss/Kconfig" - - source "drivers/staging/sxg/Kconfig" - --source "drivers/staging/go7007/Kconfig" -- - source "drivers/staging/usbip/Kconfig" - - source "drivers/staging/winbond/Kconfig" ---- a/drivers/staging/Makefile -+++ b/drivers/staging/Makefile -@@ -6,7 +6,6 @@ obj-$(CONFIG_STAGING) += staging.o - obj-$(CONFIG_ET131X) += et131x/ - obj-$(CONFIG_SLICOSS) += slicoss/ - obj-$(CONFIG_SXG) += sxg/ --obj-$(CONFIG_VIDEO_GO7007) += go7007/ - obj-$(CONFIG_USB_IP_COMMON) += usbip/ - obj-$(CONFIG_W35UND) += winbond/ - obj-$(CONFIG_PRISM2_USB) += wlan-ng/ @@ -1 +1 @@ -2.6.31-rc9 +2.6.31 |