drivers/media/video/ivtv/ivtv-firmware.c - maze/linux - Git at Google

 /*
     ivtv firmware functions.
     Copyright (C) 2003-2004  Kevin Thayer <nufan_wfk at yahoo.com>
     Copyright (C) 2004  Chris Kennedy <c@groovy.org>
     Copyright (C) 2005-2007  Hans Verkuil <hverkuil@xs4all.nl>

     This program is free software; you can redistribute it and/or modify
     it under the terms of the GNU General Public License as published by
     the Free Software Foundation; either version 2 of the License, or
     (at your option) any later version.

     This program is distributed in the hope that it will be useful,
     but WITHOUT ANY WARRANTY; without even the implied warranty of
     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     GNU General Public License for more details.

     You should have received a copy of the GNU General Public License
     along with this program; if not, write to the Free Software
     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  */

 #include "ivtv-driver.h"
 #include "ivtv-mailbox.h"
 #include "ivtv-firmware.h"
 #include "ivtv-yuv.h"
 #include "ivtv-ioctl.h"
 #include "ivtv-cards.h"
 #include <linux/firmware.h>
 #include <media/saa7127.h>

 #define IVTV_MASK_SPU_ENABLE 		0xFFFFFFFE
 #define IVTV_MASK_VPU_ENABLE15 		0xFFFFFFF6
 #define IVTV_MASK_VPU_ENABLE16 		0xFFFFFFFB
 #define IVTV_CMD_VDM_STOP 		0x00000000
 #define IVTV_CMD_AO_STOP 		0x00000005
 #define IVTV_CMD_APU_PING 		0x00000000
 #define IVTV_CMD_VPU_STOP15 		0xFFFFFFFE
 #define IVTV_CMD_VPU_STOP16 		0xFFFFFFEE
 #define IVTV_CMD_HW_BLOCKS_RST 		0xFFFFFFFF
 #define IVTV_CMD_SPU_STOP 		0x00000001
 #define IVTV_CMD_SDRAM_PRECHARGE_INIT 	0x0000001A
 #define IVTV_CMD_SDRAM_REFRESH_INIT 	0x80000640
 #define IVTV_SDRAM_SLEEPTIME 		600

 #define IVTV_DECODE_INIT_MPEG_FILENAME 	"v4l-cx2341x-init.mpg"
 #define IVTV_DECODE_INIT_MPEG_SIZE 	(152*1024)

 /* Encoder/decoder firmware sizes */
 #define IVTV_FW_ENC_SIZE 		(376836)
 #define IVTV_FW_DEC_SIZE 		(256*1024)

 static int load_fw_direct(const char *fn, volatile u8 __iomem *mem, struct ivtv *itv, long size)
 {
 	const struct firmware *fw = NULL;
 	int retries = 3;

 retry:
 	if (retries && request_firmware(&fw, fn, &itv->pdev->dev) == 0) {
 		int i;
 		volatile u32 __iomem *dst = (volatile u32 __iomem *)mem;
 		const u32 *src = (const u32 *)fw->data;

 		if (fw->size != size) {
 			/* Due to race conditions in firmware loading (esp. with udev <0.95)
 			   the wrong file was sometimes loaded. So we check filesizes to
 			   see if at least the right-sized file was loaded. If not, then we
 			   retry. */
 			IVTV_INFO("Retry: file loaded was not %s (expected size %ld, got %zd)\n", fn, size, fw->size);
 			release_firmware(fw);
 			retries--;
 			goto retry;
 		}
 		for (i = 0; i < fw->size; i += 4) {
 			/* no need for endianness conversion on the ppc */
 			__raw_writel(*src, dst);
 			dst++;
 			src++;
 		}
 		IVTV_INFO("Loaded %s firmware (%zd bytes)\n", fn, fw->size);
 		release_firmware(fw);
 		return size;
 	}
 	IVTV_ERR("Unable to open firmware %s (must be %ld bytes)\n", fn, size);
 	IVTV_ERR("Did you put the firmware in the hotplug firmware directory?\n");
 	return -ENOMEM;
 }

 void ivtv_halt_firmware(struct ivtv *itv)
 {
 	IVTV_DEBUG_INFO("Preparing for firmware halt.\n");
 	if (itv->has_cx23415 && itv->dec_mbox.mbox)
 		ivtv_vapi(itv, CX2341X_DEC_HALT_FW, 0);
 	if (itv->enc_mbox.mbox)
 		ivtv_vapi(itv, CX2341X_ENC_HALT_FW, 0);

 	ivtv_msleep_timeout(10, 0);
 	itv->enc_mbox.mbox = itv->dec_mbox.mbox = NULL;

 	IVTV_DEBUG_INFO("Stopping VDM\n");
 	write_reg(IVTV_CMD_VDM_STOP, IVTV_REG_VDM);

 	IVTV_DEBUG_INFO("Stopping AO\n");
 	write_reg(IVTV_CMD_AO_STOP, IVTV_REG_AO);

 	IVTV_DEBUG_INFO("pinging (?) APU\n");
 	write_reg(IVTV_CMD_APU_PING, IVTV_REG_APU);

 	IVTV_DEBUG_INFO("Stopping VPU\n");
 	if (!itv->has_cx23415)
 		write_reg(IVTV_CMD_VPU_STOP16, IVTV_REG_VPU);
 	else
 		write_reg(IVTV_CMD_VPU_STOP15, IVTV_REG_VPU);

 	IVTV_DEBUG_INFO("Resetting Hw Blocks\n");
 	write_reg(IVTV_CMD_HW_BLOCKS_RST, IVTV_REG_HW_BLOCKS);

 	IVTV_DEBUG_INFO("Stopping SPU\n");
 	write_reg(IVTV_CMD_SPU_STOP, IVTV_REG_SPU);

 	ivtv_msleep_timeout(10, 0);

 	IVTV_DEBUG_INFO("init Encoder SDRAM pre-charge\n");
 	write_reg(IVTV_CMD_SDRAM_PRECHARGE_INIT, IVTV_REG_ENC_SDRAM_PRECHARGE);

 	IVTV_DEBUG_INFO("init Encoder SDRAM refresh to 1us\n");
 	write_reg(IVTV_CMD_SDRAM_REFRESH_INIT, IVTV_REG_ENC_SDRAM_REFRESH);

 	if (itv->has_cx23415) {
 		IVTV_DEBUG_INFO("init Decoder SDRAM pre-charge\n");
 		write_reg(IVTV_CMD_SDRAM_PRECHARGE_INIT, IVTV_REG_DEC_SDRAM_PRECHARGE);

 		IVTV_DEBUG_INFO("init Decoder SDRAM refresh to 1us\n");
 		write_reg(IVTV_CMD_SDRAM_REFRESH_INIT, IVTV_REG_DEC_SDRAM_REFRESH);
 	}

 	IVTV_DEBUG_INFO("Sleeping for %dms\n", IVTV_SDRAM_SLEEPTIME);
 	ivtv_msleep_timeout(IVTV_SDRAM_SLEEPTIME, 0);
 }

 void ivtv_firmware_versions(struct ivtv *itv)
 {
 	u32 data[CX2341X_MBOX_MAX_DATA];

 	/* Encoder */
 	ivtv_vapi_result(itv, data, CX2341X_ENC_GET_VERSION, 0);
 	IVTV_INFO("Encoder revision: 0x%08x\n", data[0]);

 	if (data[0] != 0x02060039)
 		IVTV_WARN("Recommended firmware version is 0x02060039.\n");

 	if (itv->has_cx23415) {
 		/* Decoder */
 		ivtv_vapi_result(itv, data, CX2341X_DEC_GET_VERSION, 0);
 		IVTV_INFO("Decoder revision: 0x%08x\n", data[0]);
 	}
 }

 static int ivtv_firmware_copy(struct ivtv *itv)
 {
 	IVTV_DEBUG_INFO("Loading encoder image\n");
 	if (load_fw_direct(CX2341X_FIRM_ENC_FILENAME,
 		   itv->enc_mem, itv, IVTV_FW_ENC_SIZE) != IVTV_FW_ENC_SIZE) {
 		IVTV_DEBUG_WARN("failed loading encoder firmware\n");
 		return -3;
 	}
 	if (!itv->has_cx23415)
 		return 0;

 	IVTV_DEBUG_INFO("Loading decoder image\n");
 	if (load_fw_direct(CX2341X_FIRM_DEC_FILENAME,
 		   itv->dec_mem, itv, IVTV_FW_DEC_SIZE) != IVTV_FW_DEC_SIZE) {
 		IVTV_DEBUG_WARN("failed loading decoder firmware\n");
 		return -1;
 	}
 	return 0;
 }

 static volatile struct ivtv_mailbox __iomem *ivtv_search_mailbox(const volatile u8 __iomem *mem, u32 size)
 {
 	int i;

 	/* mailbox is preceeded by a 16 byte 'magic cookie' starting at a 256-byte
 	   address boundary */
 	for (i = 0; i < size; i += 0x100) {
 		if (readl(mem + i)      == 0x12345678 &&
 		    readl(mem + i + 4)  == 0x34567812 &&
 		    readl(mem + i + 8)  == 0x56781234 &&
 		    readl(mem + i + 12) == 0x78123456) {
 			return (volatile struct ivtv_mailbox __iomem *)(mem + i + 16);
 		}
 	}
 	return NULL;
 }

 int ivtv_firmware_init(struct ivtv *itv)
 {
 	int err;

 	ivtv_halt_firmware(itv);

 	/* load firmware */
 	err = ivtv_firmware_copy(itv);
 	if (err) {
 		IVTV_DEBUG_WARN("Error %d loading firmware\n", err);
 		return err;
 	}

 	/* start firmware */
 	write_reg(read_reg(IVTV_REG_SPU) & IVTV_MASK_SPU_ENABLE, IVTV_REG_SPU);
 	ivtv_msleep_timeout(100, 0);
 	if (itv->has_cx23415)
 		write_reg(read_reg(IVTV_REG_VPU) & IVTV_MASK_VPU_ENABLE15, IVTV_REG_VPU);
 	else
 		write_reg(read_reg(IVTV_REG_VPU) & IVTV_MASK_VPU_ENABLE16, IVTV_REG_VPU);
 	ivtv_msleep_timeout(100, 0);

 	/* find mailboxes and ping firmware */
 	itv->enc_mbox.mbox = ivtv_search_mailbox(itv->enc_mem, IVTV_ENCODER_SIZE);
 	if (itv->enc_mbox.mbox == NULL)
 		IVTV_ERR("Encoder mailbox not found\n");
 	else if (ivtv_vapi(itv, CX2341X_ENC_PING_FW, 0)) {
 		IVTV_ERR("Encoder firmware dead!\n");
 		itv->enc_mbox.mbox = NULL;
 	}
 	if (itv->enc_mbox.mbox == NULL)
 		return -ENODEV;

 	if (!itv->has_cx23415)
 		return 0;

 	itv->dec_mbox.mbox = ivtv_search_mailbox(itv->dec_mem, IVTV_DECODER_SIZE);
 	if (itv->dec_mbox.mbox == NULL) {
 		IVTV_ERR("Decoder mailbox not found\n");
 	} else if (itv->has_cx23415 && ivtv_vapi(itv, CX2341X_DEC_PING_FW, 0)) {
 		IVTV_ERR("Decoder firmware dead!\n");
 		itv->dec_mbox.mbox = NULL;
 	} else {
 		/* Firmware okay, so check yuv output filter table */
 		ivtv_yuv_filter_check(itv);
 	}
 	return itv->dec_mbox.mbox ? 0 : -ENODEV;
 }

 void ivtv_init_mpeg_decoder(struct ivtv *itv)
 {
 	u32 data[CX2341X_MBOX_MAX_DATA];
 	long readbytes;
 	volatile u8 __iomem *mem_offset;

 	data[0] = 0;
 	data[1] = itv->cxhdl.width;	/* YUV source width */
 	data[2] = itv->cxhdl.height;
 	data[3] = itv->cxhdl.audio_properties;	/* Audio settings to use,
 							   bitmap. see docs. */
 	if (ivtv_api(itv, CX2341X_DEC_SET_DECODER_SOURCE, 4, data)) {
 		IVTV_ERR("ivtv_init_mpeg_decoder failed to set decoder source\n");
 		return;
 	}

 	if (ivtv_vapi(itv, CX2341X_DEC_START_PLAYBACK, 2, 0, 1) != 0) {
 		IVTV_ERR("ivtv_init_mpeg_decoder failed to start playback\n");
 		return;
 	}
 	ivtv_api_get_data(&itv->dec_mbox, IVTV_MBOX_DMA, 2, data);
 	mem_offset = itv->dec_mem + data[1];

 	if ((readbytes = load_fw_direct(IVTV_DECODE_INIT_MPEG_FILENAME,
 		mem_offset, itv, IVTV_DECODE_INIT_MPEG_SIZE)) <= 0) {
 		IVTV_DEBUG_WARN("failed to read mpeg decoder initialisation file %s\n",
 				IVTV_DECODE_INIT_MPEG_FILENAME);
 	} else {
 		ivtv_vapi(itv, CX2341X_DEC_SCHED_DMA_FROM_HOST, 3, 0, readbytes, 0);
 		ivtv_msleep_timeout(100, 0);
 	}
 	ivtv_vapi(itv, CX2341X_DEC_STOP_PLAYBACK, 4, 0, 0, 0, 1);
 }

 /* Try to restart the card & restore previous settings */
 int ivtv_firmware_restart(struct ivtv *itv)
 {
 	int rc = 0;
 	v4l2_std_id std;
 	struct ivtv_open_id fh;
 	fh.itv = itv;

 	if (itv->v4l2_cap & V4L2_CAP_VIDEO_OUTPUT)
 		/* Display test image during restart */
 		ivtv_call_hw(itv, IVTV_HW_SAA7127, video, s_routing,
 		    SAA7127_INPUT_TYPE_TEST_IMAGE,
 		    itv->card->video_outputs[itv->active_output].video_output,
 		    0);

 	mutex_lock(&itv->udma.lock);

 	rc = ivtv_firmware_init(itv);
 	if (rc) {
 		mutex_unlock(&itv->udma.lock);
 		return rc;
 	}

 	/* Allow settings to reload */
 	ivtv_mailbox_cache_invalidate(itv);

 	/* Restore video standard */
 	std = itv->std;
 	itv->std = 0;
 	ivtv_s_std(NULL, &fh, &std);

 	if (itv->v4l2_cap & V4L2_CAP_VIDEO_OUTPUT) {
 		ivtv_init_mpeg_decoder(itv);

 		/* Restore framebuffer if active */
 		if (itv->ivtvfb_restore)
 			itv->ivtvfb_restore(itv);

 		/* Restore alpha settings */
 		ivtv_set_osd_alpha(itv);

 		/* Restore normal output */
 		ivtv_call_hw(itv, IVTV_HW_SAA7127, video, s_routing,
 		    SAA7127_INPUT_TYPE_NORMAL,
 		    itv->card->video_outputs[itv->active_output].video_output,
 		    0);
 	}

 	mutex_unlock(&itv->udma.lock);
 	return rc;
 }

 /* Check firmware running state. The checks fall through
    allowing multiple failures to be logged. */
 int ivtv_firmware_check(struct ivtv *itv, char *where)
 {
 	int res = 0;

 	/* Check encoder is still running */
 	if (ivtv_vapi(itv, CX2341X_ENC_PING_FW, 0) < 0) {
 		IVTV_WARN("Encoder has died : %s\n", where);
 		res = -1;
 	}

 	/* Also check audio. Only check if not in use & encoder is okay */
 	if (!res && !atomic_read(&itv->capturing) &&
 	    (!atomic_read(&itv->decoding) ||
 	     (atomic_read(&itv->decoding) < 2 && test_bit(IVTV_F_I_DEC_YUV,
 							     &itv->i_flags)))) {

 		if (ivtv_vapi(itv, CX2341X_ENC_MISC, 1, 12) < 0) {
 			IVTV_WARN("Audio has died (Encoder OK) : %s\n", where);
 			res = -2;
 		}
 	}

 	if (itv->v4l2_cap & V4L2_CAP_VIDEO_OUTPUT) {
 		/* Second audio check. Skip if audio already failed */
 		if (res != -2 && read_dec(0x100) != read_dec(0x104)) {
 			/* Wait & try again to be certain. */
 			ivtv_msleep_timeout(14, 0);
 			if (read_dec(0x100) != read_dec(0x104)) {
 				IVTV_WARN("Audio has died (Decoder) : %s\n",
 					  where);
 				res = -1;
 			}
 		}

 		/* Check decoder is still running */
 		if (ivtv_vapi(itv, CX2341X_DEC_PING_FW, 0) < 0) {
 			IVTV_WARN("Decoder has died : %s\n", where);
 			res = -1;
 		}
 	}

 	/* If something failed & currently idle, try to reload */
 	if (res && !atomic_read(&itv->capturing) &&
 						!atomic_read(&itv->decoding)) {
 		IVTV_INFO("Detected in %s that firmware had failed - "
 			  "Reloading\n", where);
 		res = ivtv_firmware_restart(itv);
 		/*
 		 * Even if restarted ok, still signal a problem had occured.
 		 * The caller can come through this function again to check
 		 * if things are really ok after the restart.
 		 */
 		if (!res) {
 			IVTV_INFO("Firmware restart okay\n");
 			res = -EAGAIN;
 		} else {
 			IVTV_INFO("Firmware restart failed\n");
 		}
 	} else if (res) {
 		res = -EIO;
 	}

 	return res;
 }
	/*
	ivtv firmware functions.
	Copyright (C) 2003-2004 Kevin Thayer <nufan_wfk at yahoo.com>
	Copyright (C) 2004 Chris Kennedy <c@groovy.org>
	Copyright (C) 2005-2007 Hans Verkuil <hverkuil@xs4all.nl>

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the Free Software
	Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	*/

	#include "ivtv-driver.h"
	#include "ivtv-mailbox.h"
	#include "ivtv-firmware.h"
	#include "ivtv-yuv.h"
	#include "ivtv-ioctl.h"
	#include "ivtv-cards.h"
	#include <linux/firmware.h>
	#include <media/saa7127.h>

	#define IVTV_MASK_SPU_ENABLE 0xFFFFFFFE
	#define IVTV_MASK_VPU_ENABLE15 0xFFFFFFF6
	#define IVTV_MASK_VPU_ENABLE16 0xFFFFFFFB
	#define IVTV_CMD_VDM_STOP 0x00000000
	#define IVTV_CMD_AO_STOP 0x00000005
	#define IVTV_CMD_APU_PING 0x00000000
	#define IVTV_CMD_VPU_STOP15 0xFFFFFFFE
	#define IVTV_CMD_VPU_STOP16 0xFFFFFFEE
	#define IVTV_CMD_HW_BLOCKS_RST 0xFFFFFFFF
	#define IVTV_CMD_SPU_STOP 0x00000001
	#define IVTV_CMD_SDRAM_PRECHARGE_INIT 0x0000001A
	#define IVTV_CMD_SDRAM_REFRESH_INIT 0x80000640
	#define IVTV_SDRAM_SLEEPTIME 600

	#define IVTV_DECODE_INIT_MPEG_FILENAME "v4l-cx2341x-init.mpg"
	#define IVTV_DECODE_INIT_MPEG_SIZE (152*1024)

	/* Encoder/decoder firmware sizes */
	#define IVTV_FW_ENC_SIZE (376836)
	#define IVTV_FW_DEC_SIZE (256*1024)

	static int load_fw_direct(const char fn, volatile u8 __iomem mem, struct ivtv *itv, long size)
	{
	const struct firmware *fw = NULL;
	int retries = 3;

	retry:
	if (retries && request_firmware(&fw, fn, &itv->pdev->dev) == 0) {
	int i;
	volatile u32 __iomem dst = (volatile u32 __iomem )mem;
	const u32 src = (const u32 )fw->data;

	if (fw->size != size) {
	/* Due to race conditions in firmware loading (esp. with udev <0.95)
	the wrong file was sometimes loaded. So we check filesizes to
	see if at least the right-sized file was loaded. If not, then we
	retry. */
	IVTV_INFO("Retry: file loaded was not %s (expected size %ld, got %zd)\n", fn, size, fw->size);
	release_firmware(fw);
	retries--;
	goto retry;
	}
	for (i = 0; i < fw->size; i += 4) {
	/* no need for endianness conversion on the ppc */
	__raw_writel(*src, dst);
	dst++;
	src++;
	}
	IVTV_INFO("Loaded %s firmware (%zd bytes)\n", fn, fw->size);
	release_firmware(fw);
	return size;
	}
	IVTV_ERR("Unable to open firmware %s (must be %ld bytes)\n", fn, size);
	IVTV_ERR("Did you put the firmware in the hotplug firmware directory?\n");
	return -ENOMEM;
	}

	void ivtv_halt_firmware(struct ivtv *itv)
	{
	IVTV_DEBUG_INFO("Preparing for firmware halt.\n");
	if (itv->has_cx23415 && itv->dec_mbox.mbox)
	ivtv_vapi(itv, CX2341X_DEC_HALT_FW, 0);
	if (itv->enc_mbox.mbox)
	ivtv_vapi(itv, CX2341X_ENC_HALT_FW, 0);

	ivtv_msleep_timeout(10, 0);
	itv->enc_mbox.mbox = itv->dec_mbox.mbox = NULL;

	IVTV_DEBUG_INFO("Stopping VDM\n");
	write_reg(IVTV_CMD_VDM_STOP, IVTV_REG_VDM);

	IVTV_DEBUG_INFO("Stopping AO\n");
	write_reg(IVTV_CMD_AO_STOP, IVTV_REG_AO);

	IVTV_DEBUG_INFO("pinging (?) APU\n");
	write_reg(IVTV_CMD_APU_PING, IVTV_REG_APU);

	IVTV_DEBUG_INFO("Stopping VPU\n");
	if (!itv->has_cx23415)
	write_reg(IVTV_CMD_VPU_STOP16, IVTV_REG_VPU);
	else
	write_reg(IVTV_CMD_VPU_STOP15, IVTV_REG_VPU);

	IVTV_DEBUG_INFO("Resetting Hw Blocks\n");
	write_reg(IVTV_CMD_HW_BLOCKS_RST, IVTV_REG_HW_BLOCKS);

	IVTV_DEBUG_INFO("Stopping SPU\n");
	write_reg(IVTV_CMD_SPU_STOP, IVTV_REG_SPU);

	ivtv_msleep_timeout(10, 0);

	IVTV_DEBUG_INFO("init Encoder SDRAM pre-charge\n");
	write_reg(IVTV_CMD_SDRAM_PRECHARGE_INIT, IVTV_REG_ENC_SDRAM_PRECHARGE);

	IVTV_DEBUG_INFO("init Encoder SDRAM refresh to 1us\n");
	write_reg(IVTV_CMD_SDRAM_REFRESH_INIT, IVTV_REG_ENC_SDRAM_REFRESH);

	if (itv->has_cx23415) {
	IVTV_DEBUG_INFO("init Decoder SDRAM pre-charge\n");
	write_reg(IVTV_CMD_SDRAM_PRECHARGE_INIT, IVTV_REG_DEC_SDRAM_PRECHARGE);

	IVTV_DEBUG_INFO("init Decoder SDRAM refresh to 1us\n");
	write_reg(IVTV_CMD_SDRAM_REFRESH_INIT, IVTV_REG_DEC_SDRAM_REFRESH);
	}

	IVTV_DEBUG_INFO("Sleeping for %dms\n", IVTV_SDRAM_SLEEPTIME);
	ivtv_msleep_timeout(IVTV_SDRAM_SLEEPTIME, 0);
	}

	void ivtv_firmware_versions(struct ivtv *itv)
	{
	u32 data[CX2341X_MBOX_MAX_DATA];

	/* Encoder */
	ivtv_vapi_result(itv, data, CX2341X_ENC_GET_VERSION, 0);
	IVTV_INFO("Encoder revision: 0x%08x\n", data[0]);

	if (data[0] != 0x02060039)
	IVTV_WARN("Recommended firmware version is 0x02060039.\n");

	if (itv->has_cx23415) {
	/* Decoder */
	ivtv_vapi_result(itv, data, CX2341X_DEC_GET_VERSION, 0);
	IVTV_INFO("Decoder revision: 0x%08x\n", data[0]);
	}
	}

	static int ivtv_firmware_copy(struct ivtv *itv)
	{
	IVTV_DEBUG_INFO("Loading encoder image\n");
	if (load_fw_direct(CX2341X_FIRM_ENC_FILENAME,
	itv->enc_mem, itv, IVTV_FW_ENC_SIZE) != IVTV_FW_ENC_SIZE) {
	IVTV_DEBUG_WARN("failed loading encoder firmware\n");
	return -3;
	}
	if (!itv->has_cx23415)
	return 0;

	IVTV_DEBUG_INFO("Loading decoder image\n");
	if (load_fw_direct(CX2341X_FIRM_DEC_FILENAME,
	itv->dec_mem, itv, IVTV_FW_DEC_SIZE) != IVTV_FW_DEC_SIZE) {
	IVTV_DEBUG_WARN("failed loading decoder firmware\n");
	return -1;
	}
	return 0;
	}

	static volatile struct ivtv_mailbox __iomem ivtv_search_mailbox(const volatile u8 __iomem mem, u32 size)
	{
	int i;

	/* mailbox is preceeded by a 16 byte 'magic cookie' starting at a 256-byte
	address boundary */
	for (i = 0; i < size; i += 0x100) {
	if (readl(mem + i) == 0x12345678 &&
	readl(mem + i + 4) == 0x34567812 &&
	readl(mem + i + 8) == 0x56781234 &&
	readl(mem + i + 12) == 0x78123456) {
	return (volatile struct ivtv_mailbox __iomem *)(mem + i + 16);
	}
	}
	return NULL;
	}

	int ivtv_firmware_init(struct ivtv *itv)
	{
	int err;

	ivtv_halt_firmware(itv);

	/* load firmware */
	err = ivtv_firmware_copy(itv);
	if (err) {
	IVTV_DEBUG_WARN("Error %d loading firmware\n", err);
	return err;
	}

	/* start firmware */
	write_reg(read_reg(IVTV_REG_SPU) & IVTV_MASK_SPU_ENABLE, IVTV_REG_SPU);
	ivtv_msleep_timeout(100, 0);
	if (itv->has_cx23415)
	write_reg(read_reg(IVTV_REG_VPU) & IVTV_MASK_VPU_ENABLE15, IVTV_REG_VPU);
	else
	write_reg(read_reg(IVTV_REG_VPU) & IVTV_MASK_VPU_ENABLE16, IVTV_REG_VPU);
	ivtv_msleep_timeout(100, 0);

	/* find mailboxes and ping firmware */
	itv->enc_mbox.mbox = ivtv_search_mailbox(itv->enc_mem, IVTV_ENCODER_SIZE);
	if (itv->enc_mbox.mbox == NULL)
	IVTV_ERR("Encoder mailbox not found\n");
	else if (ivtv_vapi(itv, CX2341X_ENC_PING_FW, 0)) {
	IVTV_ERR("Encoder firmware dead!\n");
	itv->enc_mbox.mbox = NULL;
	}
	if (itv->enc_mbox.mbox == NULL)
	return -ENODEV;

	if (!itv->has_cx23415)
	return 0;

	itv->dec_mbox.mbox = ivtv_search_mailbox(itv->dec_mem, IVTV_DECODER_SIZE);
	if (itv->dec_mbox.mbox == NULL) {
	IVTV_ERR("Decoder mailbox not found\n");
	} else if (itv->has_cx23415 && ivtv_vapi(itv, CX2341X_DEC_PING_FW, 0)) {
	IVTV_ERR("Decoder firmware dead!\n");
	itv->dec_mbox.mbox = NULL;
	} else {
	/* Firmware okay, so check yuv output filter table */
	ivtv_yuv_filter_check(itv);
	}
	return itv->dec_mbox.mbox ? 0 : -ENODEV;
	}

	void ivtv_init_mpeg_decoder(struct ivtv *itv)
	{
	u32 data[CX2341X_MBOX_MAX_DATA];
	long readbytes;
	volatile u8 __iomem *mem_offset;

	data[0] = 0;
	data[1] = itv->cxhdl.width; /* YUV source width */
	data[2] = itv->cxhdl.height;
	data[3] = itv->cxhdl.audio_properties; /* Audio settings to use,
	bitmap. see docs. */
	if (ivtv_api(itv, CX2341X_DEC_SET_DECODER_SOURCE, 4, data)) {
	IVTV_ERR("ivtv_init_mpeg_decoder failed to set decoder source\n");
	return;
	}

	if (ivtv_vapi(itv, CX2341X_DEC_START_PLAYBACK, 2, 0, 1) != 0) {
	IVTV_ERR("ivtv_init_mpeg_decoder failed to start playback\n");
	return;
	}
	ivtv_api_get_data(&itv->dec_mbox, IVTV_MBOX_DMA, 2, data);
	mem_offset = itv->dec_mem + data[1];

	if ((readbytes = load_fw_direct(IVTV_DECODE_INIT_MPEG_FILENAME,
	mem_offset, itv, IVTV_DECODE_INIT_MPEG_SIZE)) <= 0) {
	IVTV_DEBUG_WARN("failed to read mpeg decoder initialisation file %s\n",
	IVTV_DECODE_INIT_MPEG_FILENAME);
	} else {
	ivtv_vapi(itv, CX2341X_DEC_SCHED_DMA_FROM_HOST, 3, 0, readbytes, 0);
	ivtv_msleep_timeout(100, 0);
	}
	ivtv_vapi(itv, CX2341X_DEC_STOP_PLAYBACK, 4, 0, 0, 0, 1);
	}

	/* Try to restart the card & restore previous settings */
	int ivtv_firmware_restart(struct ivtv *itv)
	{
	int rc = 0;
	v4l2_std_id std;
	struct ivtv_open_id fh;
	fh.itv = itv;

	if (itv->v4l2_cap & V4L2_CAP_VIDEO_OUTPUT)
	/* Display test image during restart */
	ivtv_call_hw(itv, IVTV_HW_SAA7127, video, s_routing,
	SAA7127_INPUT_TYPE_TEST_IMAGE,
	itv->card->video_outputs[itv->active_output].video_output,
	0);

	mutex_lock(&itv->udma.lock);

	rc = ivtv_firmware_init(itv);
	if (rc) {
	mutex_unlock(&itv->udma.lock);
	return rc;
	}

	/* Allow settings to reload */
	ivtv_mailbox_cache_invalidate(itv);

	/* Restore video standard */
	std = itv->std;
	itv->std = 0;
	ivtv_s_std(NULL, &fh, &std);

	if (itv->v4l2_cap & V4L2_CAP_VIDEO_OUTPUT) {
	ivtv_init_mpeg_decoder(itv);

	/* Restore framebuffer if active */
	if (itv->ivtvfb_restore)
	itv->ivtvfb_restore(itv);

	/* Restore alpha settings */
	ivtv_set_osd_alpha(itv);

	/* Restore normal output */
	ivtv_call_hw(itv, IVTV_HW_SAA7127, video, s_routing,
	SAA7127_INPUT_TYPE_NORMAL,
	itv->card->video_outputs[itv->active_output].video_output,
	0);
	}

	mutex_unlock(&itv->udma.lock);
	return rc;
	}

	/* Check firmware running state. The checks fall through
	allowing multiple failures to be logged. */
	int ivtv_firmware_check(struct ivtv itv, char where)
	{
	int res = 0;

	/* Check encoder is still running */
	if (ivtv_vapi(itv, CX2341X_ENC_PING_FW, 0) < 0) {
	IVTV_WARN("Encoder has died : %s\n", where);
	res = -1;
	}

	/* Also check audio. Only check if not in use & encoder is okay */
	if (!res && !atomic_read(&itv->capturing) &&
	(!atomic_read(&itv->decoding) \|\|
	(atomic_read(&itv->decoding) < 2 && test_bit(IVTV_F_I_DEC_YUV,
	&itv->i_flags)))) {

	if (ivtv_vapi(itv, CX2341X_ENC_MISC, 1, 12) < 0) {
	IVTV_WARN("Audio has died (Encoder OK) : %s\n", where);
	res = -2;
	}
	}

	if (itv->v4l2_cap & V4L2_CAP_VIDEO_OUTPUT) {
	/* Second audio check. Skip if audio already failed */
	if (res != -2 && read_dec(0x100) != read_dec(0x104)) {
	/* Wait & try again to be certain. */
	ivtv_msleep_timeout(14, 0);
	if (read_dec(0x100) != read_dec(0x104)) {
	IVTV_WARN("Audio has died (Decoder) : %s\n",
	where);
	res = -1;
	}
	}

	/* Check decoder is still running */
	if (ivtv_vapi(itv, CX2341X_DEC_PING_FW, 0) < 0) {
	IVTV_WARN("Decoder has died : %s\n", where);
	res = -1;
	}
	}

	/* If something failed & currently idle, try to reload */
	if (res && !atomic_read(&itv->capturing) &&
	!atomic_read(&itv->decoding)) {
	IVTV_INFO("Detected in %s that firmware had failed - "
	"Reloading\n", where);
	res = ivtv_firmware_restart(itv);
	/*
	* Even if restarted ok, still signal a problem had occured.
	* The caller can come through this function again to check
	* if things are really ok after the restart.
	*/
	if (!res) {
	IVTV_INFO("Firmware restart okay\n");
	res = -EAGAIN;
	} else {
	IVTV_INFO("Firmware restart failed\n");
	}
	} else if (res) {
	res = -EIO;
	}

	return res;
	}