Merge tag 'v3.3.7' into 3.3/master
[zen-stable.git] / sound / pci / asihpi / hpidspcd.c
blob456a758f04f6112ee7c75bf2a9c842cc711b70c3
1 /***********************************************************************/
2 /**
4 AudioScience HPI driver
5 Copyright (C) 1997-2011 AudioScience Inc. <support@audioscience.com>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of version 2 of the GNU General Public License as
9 published by the Free Software Foundation;
11 This program is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License
17 along with this program; if not, write to the Free Software
18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 \file
21 Functions for reading DSP code using
22 hotplug firmware loader from individual dsp code files
24 /***********************************************************************/
25 #define SOURCEFILE_NAME "hpidspcd.c"
26 #include "hpidspcd.h"
27 #include "hpidebug.h"
28 #include "hpi_version.h"
30 struct dsp_code_private {
31 /** Firmware descriptor */
32 const struct firmware *firmware;
33 struct pci_dev *dev;
36 /*-------------------------------------------------------------------*/
37 short hpi_dsp_code_open(u32 adapter, void *os_data, struct dsp_code *dsp_code,
38 u32 *os_error_code)
40 const struct firmware *firmware;
41 struct pci_dev *dev = os_data;
42 struct code_header header;
43 char fw_name[20];
44 short err_ret = HPI_ERROR_DSP_FILE_NOT_FOUND;
45 int err;
47 sprintf(fw_name, "asihpi/dsp%04x.bin", adapter);
49 err = request_firmware(&firmware, fw_name, &dev->dev);
51 if (err || !firmware) {
52 dev_printk(KERN_ERR, &dev->dev,
53 "%d, request_firmware failed for %s\n", err,
54 fw_name);
55 goto error1;
57 if (firmware->size < sizeof(header)) {
58 dev_printk(KERN_ERR, &dev->dev, "Header size too small %s\n",
59 fw_name);
60 goto error2;
62 memcpy(&header, firmware->data, sizeof(header));
64 if ((header.type != 0x45444F43) || /* "CODE" */
65 (header.adapter != adapter)
66 || (header.size != firmware->size)) {
67 dev_printk(KERN_ERR, &dev->dev,
68 "Invalid firmware header size %d != file %zd\n",
69 header.size, firmware->size);
70 goto error2;
73 if ((header.version >> 9) != (HPI_VER >> 9)) {
74 /* Consider even and subsequent odd minor versions to be compatible */
75 dev_printk(KERN_ERR, &dev->dev,
76 "Incompatible firmware version "
77 "DSP image %X != Driver %X\n", header.version,
78 HPI_VER);
79 goto error2;
82 if (header.version != HPI_VER) {
83 dev_printk(KERN_INFO, &dev->dev,
84 "Firmware: release version mismatch DSP image %X != Driver %X\n",
85 header.version, HPI_VER);
88 HPI_DEBUG_LOG(DEBUG, "dsp code %s opened\n", fw_name);
89 dsp_code->pvt = kmalloc(sizeof(*dsp_code->pvt), GFP_KERNEL);
90 if (!dsp_code->pvt) {
91 err_ret = HPI_ERROR_MEMORY_ALLOC;
92 goto error2;
95 dsp_code->pvt->dev = dev;
96 dsp_code->pvt->firmware = firmware;
97 dsp_code->header = header;
98 dsp_code->block_length = header.size / sizeof(u32);
99 dsp_code->word_count = sizeof(header) / sizeof(u32);
100 return 0;
102 error2:
103 release_firmware(firmware);
104 error1:
105 dsp_code->block_length = 0;
106 return err_ret;
109 /*-------------------------------------------------------------------*/
110 void hpi_dsp_code_close(struct dsp_code *dsp_code)
112 HPI_DEBUG_LOG(DEBUG, "dsp code closed\n");
113 release_firmware(dsp_code->pvt->firmware);
114 kfree(dsp_code->pvt);
117 /*-------------------------------------------------------------------*/
118 void hpi_dsp_code_rewind(struct dsp_code *dsp_code)
120 /* Go back to start of data, after header */
121 dsp_code->word_count = sizeof(struct code_header) / sizeof(u32);
124 /*-------------------------------------------------------------------*/
125 short hpi_dsp_code_read_word(struct dsp_code *dsp_code, u32 *pword)
127 if (dsp_code->word_count + 1 > dsp_code->block_length)
128 return HPI_ERROR_DSP_FILE_FORMAT;
130 *pword = ((u32 *)(dsp_code->pvt->firmware->data))[dsp_code->
131 word_count];
132 dsp_code->word_count++;
133 return 0;
136 /*-------------------------------------------------------------------*/
137 short hpi_dsp_code_read_block(size_t words_requested,
138 struct dsp_code *dsp_code, u32 **ppblock)
140 if (dsp_code->word_count + words_requested > dsp_code->block_length)
141 return HPI_ERROR_DSP_FILE_FORMAT;
143 *ppblock =
144 ((u32 *)(dsp_code->pvt->firmware->data)) +
145 dsp_code->word_count;
146 dsp_code->word_count += words_requested;
147 return 0;