dev_<level> calls take less code than dev_printk(KERN_<LEVEL> and reducing object size is good. Coalesce multiline formats for easier grep. Coalesce segmented single line formats too. Signed-off-by: Joe Perches <joe@perches.com> Signed-off-by: Takashi Iwai <tiwai@suse.de>
		
			
				
	
	
		
			144 lines
		
	
	
	
		
			4.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			144 lines
		
	
	
	
		
			4.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
/***********************************************************************/
 | 
						|
/**
 | 
						|
 | 
						|
    AudioScience HPI driver
 | 
						|
    Copyright (C) 1997-2011  AudioScience Inc. <support@audioscience.com>
 | 
						|
 | 
						|
    This program is free software; you can redistribute it and/or modify
 | 
						|
    it under the terms of version 2 of the GNU General Public License 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
 | 
						|
 | 
						|
\file
 | 
						|
Functions for reading DSP code using
 | 
						|
hotplug firmware loader from individual dsp code files
 | 
						|
*/
 | 
						|
/***********************************************************************/
 | 
						|
#define SOURCEFILE_NAME "hpidspcd.c"
 | 
						|
#include "hpidspcd.h"
 | 
						|
#include "hpidebug.h"
 | 
						|
#include "hpi_version.h"
 | 
						|
 | 
						|
struct dsp_code_private {
 | 
						|
	/**  Firmware descriptor */
 | 
						|
	const struct firmware *firmware;
 | 
						|
	struct pci_dev *dev;
 | 
						|
};
 | 
						|
 | 
						|
/*-------------------------------------------------------------------*/
 | 
						|
short hpi_dsp_code_open(u32 adapter, void *os_data, struct dsp_code *dsp_code,
 | 
						|
	u32 *os_error_code)
 | 
						|
{
 | 
						|
	const struct firmware *firmware;
 | 
						|
	struct pci_dev *dev = os_data;
 | 
						|
	struct code_header header;
 | 
						|
	char fw_name[20];
 | 
						|
	short err_ret = HPI_ERROR_DSP_FILE_NOT_FOUND;
 | 
						|
	int err;
 | 
						|
 | 
						|
	sprintf(fw_name, "asihpi/dsp%04x.bin", adapter);
 | 
						|
 | 
						|
	err = request_firmware(&firmware, fw_name, &dev->dev);
 | 
						|
 | 
						|
	if (err || !firmware) {
 | 
						|
		dev_err(&dev->dev, "%d, request_firmware failed for %s\n",
 | 
						|
			err, fw_name);
 | 
						|
		goto error1;
 | 
						|
	}
 | 
						|
	if (firmware->size < sizeof(header)) {
 | 
						|
		dev_err(&dev->dev, "Header size too small %s\n", fw_name);
 | 
						|
		goto error2;
 | 
						|
	}
 | 
						|
	memcpy(&header, firmware->data, sizeof(header));
 | 
						|
 | 
						|
	if ((header.type != 0x45444F43) ||	/* "CODE" */
 | 
						|
		(header.adapter != adapter)
 | 
						|
		|| (header.size != firmware->size)) {
 | 
						|
		dev_err(&dev->dev,
 | 
						|
			"Invalid firmware header size %d != file %zd\n",
 | 
						|
			header.size, firmware->size);
 | 
						|
		goto error2;
 | 
						|
	}
 | 
						|
 | 
						|
	if ((header.version >> 9) != (HPI_VER >> 9)) {
 | 
						|
		/* Consider even and subsequent odd minor versions to be compatible */
 | 
						|
		dev_err(&dev->dev, "Incompatible firmware version DSP image %X != Driver %X\n",
 | 
						|
			header.version, HPI_VER);
 | 
						|
		goto error2;
 | 
						|
	}
 | 
						|
 | 
						|
	if (header.version != HPI_VER) {
 | 
						|
		dev_info(&dev->dev,
 | 
						|
			 "Firmware: release version mismatch  DSP image %X != Driver %X\n",
 | 
						|
			 header.version, HPI_VER);
 | 
						|
	}
 | 
						|
 | 
						|
	HPI_DEBUG_LOG(DEBUG, "dsp code %s opened\n", fw_name);
 | 
						|
	dsp_code->pvt = kmalloc(sizeof(*dsp_code->pvt), GFP_KERNEL);
 | 
						|
	if (!dsp_code->pvt) {
 | 
						|
		err_ret = HPI_ERROR_MEMORY_ALLOC;
 | 
						|
		goto error2;
 | 
						|
	}
 | 
						|
 | 
						|
	dsp_code->pvt->dev = dev;
 | 
						|
	dsp_code->pvt->firmware = firmware;
 | 
						|
	dsp_code->header = header;
 | 
						|
	dsp_code->block_length = header.size / sizeof(u32);
 | 
						|
	dsp_code->word_count = sizeof(header) / sizeof(u32);
 | 
						|
	return 0;
 | 
						|
 | 
						|
error2:
 | 
						|
	release_firmware(firmware);
 | 
						|
error1:
 | 
						|
	dsp_code->block_length = 0;
 | 
						|
	return err_ret;
 | 
						|
}
 | 
						|
 | 
						|
/*-------------------------------------------------------------------*/
 | 
						|
void hpi_dsp_code_close(struct dsp_code *dsp_code)
 | 
						|
{
 | 
						|
	HPI_DEBUG_LOG(DEBUG, "dsp code closed\n");
 | 
						|
	release_firmware(dsp_code->pvt->firmware);
 | 
						|
	kfree(dsp_code->pvt);
 | 
						|
}
 | 
						|
 | 
						|
/*-------------------------------------------------------------------*/
 | 
						|
void hpi_dsp_code_rewind(struct dsp_code *dsp_code)
 | 
						|
{
 | 
						|
	/* Go back to start of  data, after header */
 | 
						|
	dsp_code->word_count = sizeof(struct code_header) / sizeof(u32);
 | 
						|
}
 | 
						|
 | 
						|
/*-------------------------------------------------------------------*/
 | 
						|
short hpi_dsp_code_read_word(struct dsp_code *dsp_code, u32 *pword)
 | 
						|
{
 | 
						|
	if (dsp_code->word_count + 1 > dsp_code->block_length)
 | 
						|
		return HPI_ERROR_DSP_FILE_FORMAT;
 | 
						|
 | 
						|
	*pword = ((u32 *)(dsp_code->pvt->firmware->data))[dsp_code->
 | 
						|
		word_count];
 | 
						|
	dsp_code->word_count++;
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/*-------------------------------------------------------------------*/
 | 
						|
short hpi_dsp_code_read_block(size_t words_requested,
 | 
						|
	struct dsp_code *dsp_code, u32 **ppblock)
 | 
						|
{
 | 
						|
	if (dsp_code->word_count + words_requested > dsp_code->block_length)
 | 
						|
		return HPI_ERROR_DSP_FILE_FORMAT;
 | 
						|
 | 
						|
	*ppblock =
 | 
						|
		((u32 *)(dsp_code->pvt->firmware->data)) +
 | 
						|
		dsp_code->word_count;
 | 
						|
	dsp_code->word_count += words_requested;
 | 
						|
	return 0;
 | 
						|
}
 |