1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#define SOURCEFILE_NAME "hpidspcd.c"
23#include "hpidspcd.h"
24#include "hpidebug.h"
25#include "hpi_version.h"
26
27struct dsp_code_private {
28
29 const struct firmware *firmware;
30 struct pci_dev *dev;
31};
32
33
34short hpi_dsp_code_open(u32 adapter, void *os_data, struct dsp_code *dsp_code,
35 u32 *os_error_code)
36{
37 const struct firmware *firmware;
38 struct pci_dev *dev = os_data;
39 struct code_header header;
40 char fw_name[20];
41 short err_ret = HPI_ERROR_DSP_FILE_NOT_FOUND;
42 int err;
43
44 sprintf(fw_name, "asihpi/dsp%04x.bin", adapter);
45
46 err = request_firmware(&firmware, fw_name, &dev->dev);
47
48 if (err || !firmware) {
49 dev_err(&dev->dev, "%d, request_firmware failed for %s\n",
50 err, fw_name);
51 goto error1;
52 }
53 if (firmware->size < sizeof(header)) {
54 dev_err(&dev->dev, "Header size too small %s\n", fw_name);
55 goto error2;
56 }
57 memcpy(&header, firmware->data, sizeof(header));
58
59 if ((header.type != 0x45444F43) ||
60 (header.adapter != adapter)
61 || (header.size != firmware->size)) {
62 dev_err(&dev->dev,
63 "Invalid firmware header size %d != file %zd\n",
64 header.size, firmware->size);
65 goto error2;
66 }
67
68 if (HPI_VER_MAJOR(header.version) != HPI_VER_MAJOR(HPI_VER)) {
69
70 dev_err(&dev->dev,
71 "Incompatible firmware version DSP image %X != Driver %X\n",
72 header.version, HPI_VER);
73 goto error2;
74 }
75
76 if (header.version != HPI_VER) {
77 dev_warn(&dev->dev,
78 "Firmware version mismatch: DSP image %X != Driver %X\n",
79 header.version, HPI_VER);
80 }
81
82 HPI_DEBUG_LOG(DEBUG, "dsp code %s opened\n", fw_name);
83 dsp_code->pvt = kmalloc(sizeof(*dsp_code->pvt), GFP_KERNEL);
84 if (!dsp_code->pvt) {
85 err_ret = HPI_ERROR_MEMORY_ALLOC;
86 goto error2;
87 }
88
89 dsp_code->pvt->dev = dev;
90 dsp_code->pvt->firmware = firmware;
91 dsp_code->header = header;
92 dsp_code->block_length = header.size / sizeof(u32);
93 dsp_code->word_count = sizeof(header) / sizeof(u32);
94 return 0;
95
96error2:
97 release_firmware(firmware);
98error1:
99 dsp_code->block_length = 0;
100 return err_ret;
101}
102
103
104void hpi_dsp_code_close(struct dsp_code *dsp_code)
105{
106 HPI_DEBUG_LOG(DEBUG, "dsp code closed\n");
107 release_firmware(dsp_code->pvt->firmware);
108 kfree(dsp_code->pvt);
109}
110
111
112void hpi_dsp_code_rewind(struct dsp_code *dsp_code)
113{
114
115 dsp_code->word_count = sizeof(struct code_header) / sizeof(u32);
116}
117
118
119short hpi_dsp_code_read_word(struct dsp_code *dsp_code, u32 *pword)
120{
121 if (dsp_code->word_count + 1 > dsp_code->block_length)
122 return HPI_ERROR_DSP_FILE_FORMAT;
123
124 *pword = ((u32 *)(dsp_code->pvt->firmware->data))[dsp_code->
125 word_count];
126 dsp_code->word_count++;
127 return 0;
128}
129
130
131short hpi_dsp_code_read_block(size_t words_requested,
132 struct dsp_code *dsp_code, u32 **ppblock)
133{
134 if (dsp_code->word_count + words_requested > dsp_code->block_length)
135 return HPI_ERROR_DSP_FILE_FORMAT;
136
137 *ppblock =
138 ((u32 *)(dsp_code->pvt->firmware->data)) +
139 dsp_code->word_count;
140 dsp_code->word_count += words_requested;
141 return 0;
142}
143