1c942fddfSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2b285192aSMauro Carvalho Chehab /*
3b285192aSMauro Carvalho Chehab * Driver for the NXP SAA7164 PCIe bridge
4b285192aSMauro Carvalho Chehab *
563a412ecSSteven Toth * Copyright (c) 2010-2015 Steven Toth <stoth@kernellabs.com>
6b285192aSMauro Carvalho Chehab */
7b285192aSMauro Carvalho Chehab
8b285192aSMauro Carvalho Chehab #include <linux/firmware.h>
9b285192aSMauro Carvalho Chehab #include <linux/slab.h>
10b285192aSMauro Carvalho Chehab
11b285192aSMauro Carvalho Chehab #include "saa7164.h"
12b285192aSMauro Carvalho Chehab
13b285192aSMauro Carvalho Chehab #define SAA7164_REV2_FIRMWARE "NXP7164-2010-03-10.1.fw"
14b285192aSMauro Carvalho Chehab #define SAA7164_REV2_FIRMWARE_SIZE 4019072
15b285192aSMauro Carvalho Chehab
16b285192aSMauro Carvalho Chehab #define SAA7164_REV3_FIRMWARE "NXP7164-2010-03-10.1.fw"
17b285192aSMauro Carvalho Chehab #define SAA7164_REV3_FIRMWARE_SIZE 4019072
18b285192aSMauro Carvalho Chehab
19b285192aSMauro Carvalho Chehab struct fw_header {
20b285192aSMauro Carvalho Chehab u32 firmwaresize;
21b285192aSMauro Carvalho Chehab u32 bslsize;
22b285192aSMauro Carvalho Chehab u32 reserved;
23b285192aSMauro Carvalho Chehab u32 version;
24b285192aSMauro Carvalho Chehab };
25b285192aSMauro Carvalho Chehab
saa7164_dl_wait_ack(struct saa7164_dev * dev,u32 reg)265faf7db8SMauro Carvalho Chehab static int saa7164_dl_wait_ack(struct saa7164_dev *dev, u32 reg)
27b285192aSMauro Carvalho Chehab {
28b285192aSMauro Carvalho Chehab u32 timeout = SAA_DEVICE_TIMEOUT;
29b285192aSMauro Carvalho Chehab while ((saa7164_readl(reg) & 0x01) == 0) {
30b285192aSMauro Carvalho Chehab timeout -= 10;
31b285192aSMauro Carvalho Chehab if (timeout == 0) {
32b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() timeout (no d/l ack)\n",
33b285192aSMauro Carvalho Chehab __func__);
34b285192aSMauro Carvalho Chehab return -EBUSY;
35b285192aSMauro Carvalho Chehab }
36b285192aSMauro Carvalho Chehab msleep(100);
37b285192aSMauro Carvalho Chehab }
38b285192aSMauro Carvalho Chehab
39b285192aSMauro Carvalho Chehab return 0;
40b285192aSMauro Carvalho Chehab }
41b285192aSMauro Carvalho Chehab
saa7164_dl_wait_clr(struct saa7164_dev * dev,u32 reg)425faf7db8SMauro Carvalho Chehab static int saa7164_dl_wait_clr(struct saa7164_dev *dev, u32 reg)
43b285192aSMauro Carvalho Chehab {
44b285192aSMauro Carvalho Chehab u32 timeout = SAA_DEVICE_TIMEOUT;
45b285192aSMauro Carvalho Chehab while (saa7164_readl(reg) & 0x01) {
46b285192aSMauro Carvalho Chehab timeout -= 10;
47b285192aSMauro Carvalho Chehab if (timeout == 0) {
48b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() timeout (no d/l clr)\n",
49b285192aSMauro Carvalho Chehab __func__);
50b285192aSMauro Carvalho Chehab return -EBUSY;
51b285192aSMauro Carvalho Chehab }
52b285192aSMauro Carvalho Chehab msleep(100);
53b285192aSMauro Carvalho Chehab }
54b285192aSMauro Carvalho Chehab
55b285192aSMauro Carvalho Chehab return 0;
56b285192aSMauro Carvalho Chehab }
57b285192aSMauro Carvalho Chehab
58b285192aSMauro Carvalho Chehab /* TODO: move dlflags into dev-> and change to write/readl/b */
59b285192aSMauro Carvalho Chehab /* TODO: Excessive levels of debug */
saa7164_downloadimage(struct saa7164_dev * dev,u8 * src,u32 srcsize,u32 dlflags,u8 __iomem * dst,u32 dstsize)605faf7db8SMauro Carvalho Chehab static int saa7164_downloadimage(struct saa7164_dev *dev, u8 *src, u32 srcsize,
61065e1477SHans Verkuil u32 dlflags, u8 __iomem *dst, u32 dstsize)
62b285192aSMauro Carvalho Chehab {
63b285192aSMauro Carvalho Chehab u32 reg, timeout, offset;
64b285192aSMauro Carvalho Chehab u8 *srcbuf = NULL;
65b285192aSMauro Carvalho Chehab int ret;
66b285192aSMauro Carvalho Chehab
67b285192aSMauro Carvalho Chehab u32 dlflag = dlflags;
68b285192aSMauro Carvalho Chehab u32 dlflag_ack = dlflag + 4;
69b285192aSMauro Carvalho Chehab u32 drflag = dlflag_ack + 4;
70b285192aSMauro Carvalho Chehab u32 drflag_ack = drflag + 4;
71b285192aSMauro Carvalho Chehab u32 bleflag = drflag_ack + 4;
72b285192aSMauro Carvalho Chehab
73b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW,
74b285192aSMauro Carvalho Chehab "%s(image=%p, size=%d, flags=0x%x, dst=%p, dstsize=0x%x)\n",
75b285192aSMauro Carvalho Chehab __func__, src, srcsize, dlflags, dst, dstsize);
76b285192aSMauro Carvalho Chehab
77b285192aSMauro Carvalho Chehab if ((src == NULL) || (dst == NULL)) {
78b285192aSMauro Carvalho Chehab ret = -EIO;
79b285192aSMauro Carvalho Chehab goto out;
80b285192aSMauro Carvalho Chehab }
81b285192aSMauro Carvalho Chehab
82b285192aSMauro Carvalho Chehab srcbuf = kzalloc(4 * 1048576, GFP_KERNEL);
83b285192aSMauro Carvalho Chehab if (NULL == srcbuf) {
84b285192aSMauro Carvalho Chehab ret = -ENOMEM;
85b285192aSMauro Carvalho Chehab goto out;
86b285192aSMauro Carvalho Chehab }
87b285192aSMauro Carvalho Chehab
88b285192aSMauro Carvalho Chehab if (srcsize > (4*1048576)) {
89b285192aSMauro Carvalho Chehab ret = -ENOMEM;
90b285192aSMauro Carvalho Chehab goto out;
91b285192aSMauro Carvalho Chehab }
92b285192aSMauro Carvalho Chehab
93b285192aSMauro Carvalho Chehab memcpy(srcbuf, src, srcsize);
94b285192aSMauro Carvalho Chehab
95b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() dlflag = 0x%x\n", __func__, dlflag);
96b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() dlflag_ack = 0x%x\n", __func__, dlflag_ack);
97b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() drflag = 0x%x\n", __func__, drflag);
98b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() drflag_ack = 0x%x\n", __func__, drflag_ack);
99b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() bleflag = 0x%x\n", __func__, bleflag);
100b285192aSMauro Carvalho Chehab
101b285192aSMauro Carvalho Chehab reg = saa7164_readl(dlflag);
102b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() dlflag (0x%x)= 0x%x\n", __func__, dlflag, reg);
103b285192aSMauro Carvalho Chehab if (reg == 1)
104b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW,
105b285192aSMauro Carvalho Chehab "%s() Download flag already set, please reboot\n",
106b285192aSMauro Carvalho Chehab __func__);
107b285192aSMauro Carvalho Chehab
108b285192aSMauro Carvalho Chehab /* Indicate download start */
109b285192aSMauro Carvalho Chehab saa7164_writel(dlflag, 1);
110b285192aSMauro Carvalho Chehab ret = saa7164_dl_wait_ack(dev, dlflag_ack);
111b285192aSMauro Carvalho Chehab if (ret < 0)
112b285192aSMauro Carvalho Chehab goto out;
113b285192aSMauro Carvalho Chehab
114b285192aSMauro Carvalho Chehab /* Ack download start, then wait for wait */
115b285192aSMauro Carvalho Chehab saa7164_writel(dlflag, 0);
116b285192aSMauro Carvalho Chehab ret = saa7164_dl_wait_clr(dev, dlflag_ack);
117b285192aSMauro Carvalho Chehab if (ret < 0)
118b285192aSMauro Carvalho Chehab goto out;
119b285192aSMauro Carvalho Chehab
120b285192aSMauro Carvalho Chehab /* Deal with the raw firmware, in the appropriate chunk size */
121b285192aSMauro Carvalho Chehab for (offset = 0; srcsize > dstsize;
122b285192aSMauro Carvalho Chehab srcsize -= dstsize, offset += dstsize) {
123b285192aSMauro Carvalho Chehab
124b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() memcpy %d\n", __func__, dstsize);
125065e1477SHans Verkuil memcpy_toio(dst, srcbuf + offset, dstsize);
126b285192aSMauro Carvalho Chehab
127b285192aSMauro Carvalho Chehab /* Flag the data as ready */
128b285192aSMauro Carvalho Chehab saa7164_writel(drflag, 1);
129b285192aSMauro Carvalho Chehab ret = saa7164_dl_wait_ack(dev, drflag_ack);
130b285192aSMauro Carvalho Chehab if (ret < 0)
131b285192aSMauro Carvalho Chehab goto out;
132b285192aSMauro Carvalho Chehab
133b285192aSMauro Carvalho Chehab /* Wait for indication data was received */
134b285192aSMauro Carvalho Chehab saa7164_writel(drflag, 0);
135b285192aSMauro Carvalho Chehab ret = saa7164_dl_wait_clr(dev, drflag_ack);
136b285192aSMauro Carvalho Chehab if (ret < 0)
137b285192aSMauro Carvalho Chehab goto out;
138b285192aSMauro Carvalho Chehab
139b285192aSMauro Carvalho Chehab }
140b285192aSMauro Carvalho Chehab
141b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() memcpy(l) %d\n", __func__, dstsize);
142b285192aSMauro Carvalho Chehab /* Write last block to the device */
143065e1477SHans Verkuil memcpy_toio(dst, srcbuf+offset, srcsize);
144b285192aSMauro Carvalho Chehab
145b285192aSMauro Carvalho Chehab /* Flag the data as ready */
146b285192aSMauro Carvalho Chehab saa7164_writel(drflag, 1);
147b285192aSMauro Carvalho Chehab ret = saa7164_dl_wait_ack(dev, drflag_ack);
148b285192aSMauro Carvalho Chehab if (ret < 0)
149b285192aSMauro Carvalho Chehab goto out;
150b285192aSMauro Carvalho Chehab
151b285192aSMauro Carvalho Chehab saa7164_writel(drflag, 0);
152b285192aSMauro Carvalho Chehab timeout = 0;
153b285192aSMauro Carvalho Chehab while (saa7164_readl(bleflag) != SAA_DEVICE_IMAGE_BOOTING) {
154b285192aSMauro Carvalho Chehab if (saa7164_readl(bleflag) & SAA_DEVICE_IMAGE_CORRUPT) {
155b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() image corrupt\n", __func__);
156b285192aSMauro Carvalho Chehab ret = -EBUSY;
157b285192aSMauro Carvalho Chehab goto out;
158b285192aSMauro Carvalho Chehab }
159b285192aSMauro Carvalho Chehab
160b285192aSMauro Carvalho Chehab if (saa7164_readl(bleflag) & SAA_DEVICE_MEMORY_CORRUPT) {
161b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() device memory corrupt\n",
162b285192aSMauro Carvalho Chehab __func__);
163b285192aSMauro Carvalho Chehab ret = -EBUSY;
164b285192aSMauro Carvalho Chehab goto out;
165b285192aSMauro Carvalho Chehab }
166b285192aSMauro Carvalho Chehab
167b285192aSMauro Carvalho Chehab msleep(10); /* Checkpatch throws a < 20ms warning */
168b285192aSMauro Carvalho Chehab if (timeout++ > 60)
169b285192aSMauro Carvalho Chehab break;
170b285192aSMauro Carvalho Chehab }
171b285192aSMauro Carvalho Chehab
172b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() Image downloaded, booting...\n", __func__);
173b285192aSMauro Carvalho Chehab
174b285192aSMauro Carvalho Chehab ret = saa7164_dl_wait_clr(dev, drflag_ack);
175b285192aSMauro Carvalho Chehab if (ret < 0)
176b285192aSMauro Carvalho Chehab goto out;
177b285192aSMauro Carvalho Chehab
178b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() Image booted successfully.\n", __func__);
179b285192aSMauro Carvalho Chehab ret = 0;
180b285192aSMauro Carvalho Chehab
181b285192aSMauro Carvalho Chehab out:
182b285192aSMauro Carvalho Chehab kfree(srcbuf);
183b285192aSMauro Carvalho Chehab return ret;
184b285192aSMauro Carvalho Chehab }
185b285192aSMauro Carvalho Chehab
186b285192aSMauro Carvalho Chehab /* TODO: Excessive debug */
187b285192aSMauro Carvalho Chehab /* Load the firmware. Optionally it can be in ROM or newer versions
188b285192aSMauro Carvalho Chehab * can be on disk, saving the expense of the ROM hardware. */
saa7164_downloadfirmware(struct saa7164_dev * dev)189b285192aSMauro Carvalho Chehab int saa7164_downloadfirmware(struct saa7164_dev *dev)
190b285192aSMauro Carvalho Chehab {
191b285192aSMauro Carvalho Chehab /* u32 second_timeout = 60 * SAA_DEVICE_TIMEOUT; */
192b285192aSMauro Carvalho Chehab u32 tmp, filesize, version, err_flags, first_timeout, fwlength;
193b285192aSMauro Carvalho Chehab u32 second_timeout, updatebootloader = 1, bootloadersize = 0;
194b285192aSMauro Carvalho Chehab const struct firmware *fw = NULL;
195b285192aSMauro Carvalho Chehab struct fw_header *hdr, *boothdr = NULL, *fwhdr;
196b285192aSMauro Carvalho Chehab u32 bootloaderversion = 0, fwloadersize;
197b285192aSMauro Carvalho Chehab u8 *bootloaderoffset = NULL, *fwloaderoffset;
198b285192aSMauro Carvalho Chehab char *fwname;
199b285192aSMauro Carvalho Chehab int ret;
200b285192aSMauro Carvalho Chehab
201b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s()\n", __func__);
202b285192aSMauro Carvalho Chehab
203b285192aSMauro Carvalho Chehab if (saa7164_boards[dev->board].chiprev == SAA7164_CHIP_REV2) {
204b285192aSMauro Carvalho Chehab fwname = SAA7164_REV2_FIRMWARE;
205b285192aSMauro Carvalho Chehab fwlength = SAA7164_REV2_FIRMWARE_SIZE;
206b285192aSMauro Carvalho Chehab } else {
207b285192aSMauro Carvalho Chehab fwname = SAA7164_REV3_FIRMWARE;
208b285192aSMauro Carvalho Chehab fwlength = SAA7164_REV3_FIRMWARE_SIZE;
209b285192aSMauro Carvalho Chehab }
210b285192aSMauro Carvalho Chehab
211b285192aSMauro Carvalho Chehab version = saa7164_getcurrentfirmwareversion(dev);
212b285192aSMauro Carvalho Chehab
213b285192aSMauro Carvalho Chehab if (version == 0x00) {
214b285192aSMauro Carvalho Chehab
215b285192aSMauro Carvalho Chehab second_timeout = 100;
216b285192aSMauro Carvalho Chehab first_timeout = 100;
217b285192aSMauro Carvalho Chehab err_flags = saa7164_readl(SAA_BOOTLOADERERROR_FLAGS);
218b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() err_flags = %x\n",
219b285192aSMauro Carvalho Chehab __func__, err_flags);
220b285192aSMauro Carvalho Chehab
221b285192aSMauro Carvalho Chehab while (err_flags != SAA_DEVICE_IMAGE_BOOTING) {
222b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() err_flags = %x\n",
223b285192aSMauro Carvalho Chehab __func__, err_flags);
224b285192aSMauro Carvalho Chehab msleep(10); /* Checkpatch throws a < 20ms warning */
225b285192aSMauro Carvalho Chehab
226b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_IMAGE_CORRUPT) {
227b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() firmware corrupt\n",
228b285192aSMauro Carvalho Chehab __func__);
229b285192aSMauro Carvalho Chehab break;
230b285192aSMauro Carvalho Chehab }
231b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_MEMORY_CORRUPT) {
232b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() device memory corrupt\n",
233b285192aSMauro Carvalho Chehab __func__);
234b285192aSMauro Carvalho Chehab break;
235b285192aSMauro Carvalho Chehab }
236b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_NO_IMAGE) {
237b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() no first image\n",
238b285192aSMauro Carvalho Chehab __func__);
239b285192aSMauro Carvalho Chehab break;
240b285192aSMauro Carvalho Chehab }
241b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_IMAGE_SEARCHING) {
242b285192aSMauro Carvalho Chehab first_timeout -= 10;
243b285192aSMauro Carvalho Chehab if (first_timeout == 0) {
244b285192aSMauro Carvalho Chehab printk(KERN_ERR
245b285192aSMauro Carvalho Chehab "%s() no first image\n",
246b285192aSMauro Carvalho Chehab __func__);
247b285192aSMauro Carvalho Chehab break;
248b285192aSMauro Carvalho Chehab }
249b285192aSMauro Carvalho Chehab } else if (err_flags & SAA_DEVICE_IMAGE_LOADING) {
250b285192aSMauro Carvalho Chehab second_timeout -= 10;
251b285192aSMauro Carvalho Chehab if (second_timeout == 0) {
252b285192aSMauro Carvalho Chehab printk(KERN_ERR
253b285192aSMauro Carvalho Chehab "%s() FW load time exceeded\n",
254b285192aSMauro Carvalho Chehab __func__);
255b285192aSMauro Carvalho Chehab break;
256b285192aSMauro Carvalho Chehab }
257b285192aSMauro Carvalho Chehab } else {
258b285192aSMauro Carvalho Chehab second_timeout -= 10;
259b285192aSMauro Carvalho Chehab if (second_timeout == 0) {
260b285192aSMauro Carvalho Chehab printk(KERN_ERR
261b285192aSMauro Carvalho Chehab "%s() Unknown bootloader flags 0x%x\n",
262b285192aSMauro Carvalho Chehab __func__, err_flags);
263b285192aSMauro Carvalho Chehab break;
264b285192aSMauro Carvalho Chehab }
265b285192aSMauro Carvalho Chehab }
266b285192aSMauro Carvalho Chehab
267b285192aSMauro Carvalho Chehab err_flags = saa7164_readl(SAA_BOOTLOADERERROR_FLAGS);
268b285192aSMauro Carvalho Chehab } /* While != Booting */
269b285192aSMauro Carvalho Chehab
270b285192aSMauro Carvalho Chehab if (err_flags == SAA_DEVICE_IMAGE_BOOTING) {
271b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() Loader 1 has loaded.\n",
272b285192aSMauro Carvalho Chehab __func__);
273b285192aSMauro Carvalho Chehab first_timeout = SAA_DEVICE_TIMEOUT;
274b285192aSMauro Carvalho Chehab second_timeout = 100;
275b285192aSMauro Carvalho Chehab
276b285192aSMauro Carvalho Chehab err_flags = saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS);
277b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() err_flags2 = %x\n",
278b285192aSMauro Carvalho Chehab __func__, err_flags);
279b285192aSMauro Carvalho Chehab while (err_flags != SAA_DEVICE_IMAGE_BOOTING) {
280b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() err_flags2 = %x\n",
281b285192aSMauro Carvalho Chehab __func__, err_flags);
282b285192aSMauro Carvalho Chehab msleep(10); /* Checkpatch throws a < 20ms warning */
283b285192aSMauro Carvalho Chehab
284b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_IMAGE_CORRUPT) {
285b285192aSMauro Carvalho Chehab printk(KERN_ERR
286b285192aSMauro Carvalho Chehab "%s() firmware corrupt\n",
287b285192aSMauro Carvalho Chehab __func__);
288b285192aSMauro Carvalho Chehab break;
289b285192aSMauro Carvalho Chehab }
290b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_MEMORY_CORRUPT) {
291b285192aSMauro Carvalho Chehab printk(KERN_ERR
292b285192aSMauro Carvalho Chehab "%s() device memory corrupt\n",
293b285192aSMauro Carvalho Chehab __func__);
294b285192aSMauro Carvalho Chehab break;
295b285192aSMauro Carvalho Chehab }
296b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_NO_IMAGE) {
297ca80fbcdSColin Ian King printk(KERN_ERR "%s() no second image\n",
298b285192aSMauro Carvalho Chehab __func__);
299b285192aSMauro Carvalho Chehab break;
300b285192aSMauro Carvalho Chehab }
301b285192aSMauro Carvalho Chehab if (err_flags & SAA_DEVICE_IMAGE_SEARCHING) {
302b285192aSMauro Carvalho Chehab first_timeout -= 10;
303b285192aSMauro Carvalho Chehab if (first_timeout == 0) {
304b285192aSMauro Carvalho Chehab printk(KERN_ERR
305b285192aSMauro Carvalho Chehab "%s() no second image\n",
306b285192aSMauro Carvalho Chehab __func__);
307b285192aSMauro Carvalho Chehab break;
308b285192aSMauro Carvalho Chehab }
309b285192aSMauro Carvalho Chehab } else if (err_flags &
310b285192aSMauro Carvalho Chehab SAA_DEVICE_IMAGE_LOADING) {
311b285192aSMauro Carvalho Chehab second_timeout -= 10;
312b285192aSMauro Carvalho Chehab if (second_timeout == 0) {
313b285192aSMauro Carvalho Chehab printk(KERN_ERR
314b285192aSMauro Carvalho Chehab "%s() FW load time exceeded\n",
315b285192aSMauro Carvalho Chehab __func__);
316b285192aSMauro Carvalho Chehab break;
317b285192aSMauro Carvalho Chehab }
318b285192aSMauro Carvalho Chehab } else {
319b285192aSMauro Carvalho Chehab second_timeout -= 10;
320b285192aSMauro Carvalho Chehab if (second_timeout == 0) {
321b285192aSMauro Carvalho Chehab printk(KERN_ERR
322b285192aSMauro Carvalho Chehab "%s() Unknown bootloader flags 0x%x\n",
323b285192aSMauro Carvalho Chehab __func__, err_flags);
324b285192aSMauro Carvalho Chehab break;
325b285192aSMauro Carvalho Chehab }
326b285192aSMauro Carvalho Chehab }
327b285192aSMauro Carvalho Chehab
328b285192aSMauro Carvalho Chehab err_flags =
329b285192aSMauro Carvalho Chehab saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS);
330b285192aSMauro Carvalho Chehab } /* err_flags != SAA_DEVICE_IMAGE_BOOTING */
331b285192aSMauro Carvalho Chehab
332b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() Loader flags 1:0x%x 2:0x%x.\n",
333b285192aSMauro Carvalho Chehab __func__,
334b285192aSMauro Carvalho Chehab saa7164_readl(SAA_BOOTLOADERERROR_FLAGS),
335b285192aSMauro Carvalho Chehab saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS));
336b285192aSMauro Carvalho Chehab
337b285192aSMauro Carvalho Chehab } /* err_flags == SAA_DEVICE_IMAGE_BOOTING */
338b285192aSMauro Carvalho Chehab
339b285192aSMauro Carvalho Chehab /* It's possible for both firmwares to have booted,
340b285192aSMauro Carvalho Chehab * but that doesn't mean they've finished booting yet.
341b285192aSMauro Carvalho Chehab */
342b285192aSMauro Carvalho Chehab if ((saa7164_readl(SAA_BOOTLOADERERROR_FLAGS) ==
343b285192aSMauro Carvalho Chehab SAA_DEVICE_IMAGE_BOOTING) &&
344b285192aSMauro Carvalho Chehab (saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS) ==
345b285192aSMauro Carvalho Chehab SAA_DEVICE_IMAGE_BOOTING)) {
346b285192aSMauro Carvalho Chehab
347b285192aSMauro Carvalho Chehab
348b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "%s() Loader 2 has loaded.\n",
349b285192aSMauro Carvalho Chehab __func__);
350b285192aSMauro Carvalho Chehab
351b285192aSMauro Carvalho Chehab first_timeout = SAA_DEVICE_TIMEOUT;
352b285192aSMauro Carvalho Chehab while (first_timeout) {
353b285192aSMauro Carvalho Chehab msleep(10); /* Checkpatch throws a < 20ms warning */
354b285192aSMauro Carvalho Chehab
355b285192aSMauro Carvalho Chehab version =
356b285192aSMauro Carvalho Chehab saa7164_getcurrentfirmwareversion(dev);
357b285192aSMauro Carvalho Chehab if (version) {
358b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW,
359b285192aSMauro Carvalho Chehab "%s() All f/w loaded successfully\n",
360b285192aSMauro Carvalho Chehab __func__);
361b285192aSMauro Carvalho Chehab break;
362b285192aSMauro Carvalho Chehab } else {
363b285192aSMauro Carvalho Chehab first_timeout -= 10;
364b285192aSMauro Carvalho Chehab if (first_timeout == 0) {
365b285192aSMauro Carvalho Chehab printk(KERN_ERR
366b285192aSMauro Carvalho Chehab "%s() FW did not boot\n",
367b285192aSMauro Carvalho Chehab __func__);
368b285192aSMauro Carvalho Chehab break;
369b285192aSMauro Carvalho Chehab }
370b285192aSMauro Carvalho Chehab }
371b285192aSMauro Carvalho Chehab }
372b285192aSMauro Carvalho Chehab }
373b285192aSMauro Carvalho Chehab version = saa7164_getcurrentfirmwareversion(dev);
374b285192aSMauro Carvalho Chehab } /* version == 0 */
375b285192aSMauro Carvalho Chehab
376b285192aSMauro Carvalho Chehab /* Has the firmware really booted? */
377b285192aSMauro Carvalho Chehab if ((saa7164_readl(SAA_BOOTLOADERERROR_FLAGS) ==
378b285192aSMauro Carvalho Chehab SAA_DEVICE_IMAGE_BOOTING) &&
379b285192aSMauro Carvalho Chehab (saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS) ==
380b285192aSMauro Carvalho Chehab SAA_DEVICE_IMAGE_BOOTING) && (version == 0)) {
381b285192aSMauro Carvalho Chehab
382b285192aSMauro Carvalho Chehab printk(KERN_ERR
383b285192aSMauro Carvalho Chehab "%s() The firmware hung, probably bad firmware\n",
384b285192aSMauro Carvalho Chehab __func__);
385b285192aSMauro Carvalho Chehab
386b285192aSMauro Carvalho Chehab /* Tell the second stage loader we have a deadlock */
387b285192aSMauro Carvalho Chehab saa7164_writel(SAA_DEVICE_DEADLOCK_DETECTED_OFFSET,
388b285192aSMauro Carvalho Chehab SAA_DEVICE_DEADLOCK_DETECTED);
389b285192aSMauro Carvalho Chehab
390b285192aSMauro Carvalho Chehab saa7164_getfirmwarestatus(dev);
391b285192aSMauro Carvalho Chehab
392b285192aSMauro Carvalho Chehab return -ENOMEM;
393b285192aSMauro Carvalho Chehab }
394b285192aSMauro Carvalho Chehab
395b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "Device has Firmware Version %d.%d.%d.%d\n",
396b285192aSMauro Carvalho Chehab (version & 0x0000fc00) >> 10,
397b285192aSMauro Carvalho Chehab (version & 0x000003e0) >> 5,
398b285192aSMauro Carvalho Chehab (version & 0x0000001f),
399b285192aSMauro Carvalho Chehab (version & 0xffff0000) >> 16);
400b285192aSMauro Carvalho Chehab
40116790554SMauro Carvalho Chehab /* Load the firmware from the disk if required */
402b285192aSMauro Carvalho Chehab if (version == 0) {
403b285192aSMauro Carvalho Chehab
404b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() Waiting for firmware upload (%s)\n",
405b285192aSMauro Carvalho Chehab __func__, fwname);
406b285192aSMauro Carvalho Chehab
407b285192aSMauro Carvalho Chehab ret = request_firmware(&fw, fwname, &dev->pci->dev);
408b285192aSMauro Carvalho Chehab if (ret) {
40924f711c1SMauro Carvalho Chehab printk(KERN_ERR "%s() Upload failed. (file not found?)\n",
41024f711c1SMauro Carvalho Chehab __func__);
411b285192aSMauro Carvalho Chehab return -ENOMEM;
412b285192aSMauro Carvalho Chehab }
413b285192aSMauro Carvalho Chehab
4145b5e0928SAlexey Dobriyan printk(KERN_INFO "%s() firmware read %zu bytes.\n",
415b285192aSMauro Carvalho Chehab __func__, fw->size);
416b285192aSMauro Carvalho Chehab
417b285192aSMauro Carvalho Chehab if (fw->size != fwlength) {
4180cc4655cSBrad Love printk(KERN_ERR "saa7164: firmware incorrect size %zu != %u\n",
4190cc4655cSBrad Love fw->size, fwlength);
420b285192aSMauro Carvalho Chehab ret = -ENOMEM;
421b285192aSMauro Carvalho Chehab goto out;
422b285192aSMauro Carvalho Chehab }
423b285192aSMauro Carvalho Chehab
424b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() firmware loaded.\n", __func__);
425b285192aSMauro Carvalho Chehab
426b285192aSMauro Carvalho Chehab hdr = (struct fw_header *)fw->data;
427b285192aSMauro Carvalho Chehab printk(KERN_INFO "Firmware file header part 1:\n");
428b285192aSMauro Carvalho Chehab printk(KERN_INFO " .FirmwareSize = 0x%x\n", hdr->firmwaresize);
429b285192aSMauro Carvalho Chehab printk(KERN_INFO " .BSLSize = 0x%x\n", hdr->bslsize);
430b285192aSMauro Carvalho Chehab printk(KERN_INFO " .Reserved = 0x%x\n", hdr->reserved);
431b285192aSMauro Carvalho Chehab printk(KERN_INFO " .Version = 0x%x\n", hdr->version);
432b285192aSMauro Carvalho Chehab
433b285192aSMauro Carvalho Chehab /* Retrieve bootloader if reqd */
434b285192aSMauro Carvalho Chehab if ((hdr->firmwaresize == 0) && (hdr->bslsize == 0))
435b285192aSMauro Carvalho Chehab /* Second bootloader in the firmware file */
436b285192aSMauro Carvalho Chehab filesize = hdr->reserved * 16;
437b285192aSMauro Carvalho Chehab else
438b285192aSMauro Carvalho Chehab filesize = (hdr->firmwaresize + hdr->bslsize) *
439b285192aSMauro Carvalho Chehab 16 + sizeof(struct fw_header);
440b285192aSMauro Carvalho Chehab
441b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() SecBootLoader.FileSize = %d\n",
442b285192aSMauro Carvalho Chehab __func__, filesize);
443b285192aSMauro Carvalho Chehab
444b285192aSMauro Carvalho Chehab /* Get bootloader (if reqd) and firmware header */
445b285192aSMauro Carvalho Chehab if ((hdr->firmwaresize == 0) && (hdr->bslsize == 0)) {
446b285192aSMauro Carvalho Chehab /* Second boot loader is required */
447b285192aSMauro Carvalho Chehab
448b285192aSMauro Carvalho Chehab /* Get the loader header */
449b285192aSMauro Carvalho Chehab boothdr = (struct fw_header *)(fw->data +
450b285192aSMauro Carvalho Chehab sizeof(struct fw_header));
451b285192aSMauro Carvalho Chehab
452b285192aSMauro Carvalho Chehab bootloaderversion =
453b285192aSMauro Carvalho Chehab saa7164_readl(SAA_DEVICE_2ND_VERSION);
454b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "Onboard BootLoader:\n");
455b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "->Flag 0x%x\n",
456b285192aSMauro Carvalho Chehab saa7164_readl(SAA_BOOTLOADERERROR_FLAGS));
457b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "->Ack 0x%x\n",
458b285192aSMauro Carvalho Chehab saa7164_readl(SAA_DATAREADY_FLAG_ACK));
459b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "->FW Version 0x%x\n", version);
460b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "->Loader Version 0x%x\n",
461b285192aSMauro Carvalho Chehab bootloaderversion);
462b285192aSMauro Carvalho Chehab
463b285192aSMauro Carvalho Chehab if ((saa7164_readl(SAA_BOOTLOADERERROR_FLAGS) ==
464b285192aSMauro Carvalho Chehab 0x03) && (saa7164_readl(SAA_DATAREADY_FLAG_ACK)
465b285192aSMauro Carvalho Chehab == 0x00) && (version == 0x00)) {
466b285192aSMauro Carvalho Chehab
46724f711c1SMauro Carvalho Chehab dprintk(DBGLVL_FW, "BootLoader version in rom %d.%d.%d.%d\n",
468b285192aSMauro Carvalho Chehab (bootloaderversion & 0x0000fc00) >> 10,
469b285192aSMauro Carvalho Chehab (bootloaderversion & 0x000003e0) >> 5,
470b285192aSMauro Carvalho Chehab (bootloaderversion & 0x0000001f),
471b285192aSMauro Carvalho Chehab (bootloaderversion & 0xffff0000) >> 16
472b285192aSMauro Carvalho Chehab );
47324f711c1SMauro Carvalho Chehab dprintk(DBGLVL_FW, "BootLoader version in file %d.%d.%d.%d\n",
474b285192aSMauro Carvalho Chehab (boothdr->version & 0x0000fc00) >> 10,
475b285192aSMauro Carvalho Chehab (boothdr->version & 0x000003e0) >> 5,
476b285192aSMauro Carvalho Chehab (boothdr->version & 0x0000001f),
477b285192aSMauro Carvalho Chehab (boothdr->version & 0xffff0000) >> 16
478b285192aSMauro Carvalho Chehab );
479b285192aSMauro Carvalho Chehab
480b285192aSMauro Carvalho Chehab if (bootloaderversion == boothdr->version)
481b285192aSMauro Carvalho Chehab updatebootloader = 0;
482b285192aSMauro Carvalho Chehab }
483b285192aSMauro Carvalho Chehab
484b285192aSMauro Carvalho Chehab /* Calculate offset to firmware header */
485b285192aSMauro Carvalho Chehab tmp = (boothdr->firmwaresize + boothdr->bslsize) * 16 +
486b285192aSMauro Carvalho Chehab (sizeof(struct fw_header) +
487b285192aSMauro Carvalho Chehab sizeof(struct fw_header));
488b285192aSMauro Carvalho Chehab
489b285192aSMauro Carvalho Chehab fwhdr = (struct fw_header *)(fw->data+tmp);
490b285192aSMauro Carvalho Chehab } else {
491b285192aSMauro Carvalho Chehab /* No second boot loader */
492b285192aSMauro Carvalho Chehab fwhdr = hdr;
493b285192aSMauro Carvalho Chehab }
494b285192aSMauro Carvalho Chehab
495b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "Firmware version in file %d.%d.%d.%d\n",
496b285192aSMauro Carvalho Chehab (fwhdr->version & 0x0000fc00) >> 10,
497b285192aSMauro Carvalho Chehab (fwhdr->version & 0x000003e0) >> 5,
498b285192aSMauro Carvalho Chehab (fwhdr->version & 0x0000001f),
499b285192aSMauro Carvalho Chehab (fwhdr->version & 0xffff0000) >> 16
500b285192aSMauro Carvalho Chehab );
501b285192aSMauro Carvalho Chehab
502b285192aSMauro Carvalho Chehab if (version == fwhdr->version) {
503b285192aSMauro Carvalho Chehab /* No download, firmware already on board */
504b285192aSMauro Carvalho Chehab ret = 0;
505b285192aSMauro Carvalho Chehab goto out;
506b285192aSMauro Carvalho Chehab }
507b285192aSMauro Carvalho Chehab
508b285192aSMauro Carvalho Chehab if ((hdr->firmwaresize == 0) && (hdr->bslsize == 0)) {
509b285192aSMauro Carvalho Chehab if (updatebootloader) {
510b285192aSMauro Carvalho Chehab /* Get ready to upload the bootloader */
511b285192aSMauro Carvalho Chehab bootloadersize = (boothdr->firmwaresize +
512b285192aSMauro Carvalho Chehab boothdr->bslsize) * 16 +
513b285192aSMauro Carvalho Chehab sizeof(struct fw_header);
514b285192aSMauro Carvalho Chehab
515b285192aSMauro Carvalho Chehab bootloaderoffset = (u8 *)(fw->data +
516b285192aSMauro Carvalho Chehab sizeof(struct fw_header));
517b285192aSMauro Carvalho Chehab
518b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW, "bootloader d/l starts.\n");
519b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() FirmwareSize = 0x%x\n",
520b285192aSMauro Carvalho Chehab __func__, boothdr->firmwaresize);
521b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() BSLSize = 0x%x\n",
522b285192aSMauro Carvalho Chehab __func__, boothdr->bslsize);
523b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() Reserved = 0x%x\n",
524b285192aSMauro Carvalho Chehab __func__, boothdr->reserved);
525b285192aSMauro Carvalho Chehab printk(KERN_INFO "%s() Version = 0x%x\n",
526b285192aSMauro Carvalho Chehab __func__, boothdr->version);
527b285192aSMauro Carvalho Chehab ret = saa7164_downloadimage(
528b285192aSMauro Carvalho Chehab dev,
529b285192aSMauro Carvalho Chehab bootloaderoffset,
530b285192aSMauro Carvalho Chehab bootloadersize,
531b285192aSMauro Carvalho Chehab SAA_DOWNLOAD_FLAGS,
532b285192aSMauro Carvalho Chehab dev->bmmio + SAA_DEVICE_DOWNLOAD_OFFSET,
533b285192aSMauro Carvalho Chehab SAA_DEVICE_BUFFERBLOCKSIZE);
534b285192aSMauro Carvalho Chehab if (ret < 0) {
535b285192aSMauro Carvalho Chehab printk(KERN_ERR
536b285192aSMauro Carvalho Chehab "bootloader d/l has failed\n");
537b285192aSMauro Carvalho Chehab goto out;
538b285192aSMauro Carvalho Chehab }
539b285192aSMauro Carvalho Chehab dprintk(DBGLVL_FW,
540b285192aSMauro Carvalho Chehab "bootloader download complete.\n");
541b285192aSMauro Carvalho Chehab
542b285192aSMauro Carvalho Chehab }
543b285192aSMauro Carvalho Chehab
544b285192aSMauro Carvalho Chehab printk(KERN_ERR "starting firmware download(2)\n");
545b285192aSMauro Carvalho Chehab bootloadersize = (boothdr->firmwaresize +
546b285192aSMauro Carvalho Chehab boothdr->bslsize) * 16 +
547b285192aSMauro Carvalho Chehab sizeof(struct fw_header);
548b285192aSMauro Carvalho Chehab
549b285192aSMauro Carvalho Chehab bootloaderoffset =
550b285192aSMauro Carvalho Chehab (u8 *)(fw->data + sizeof(struct fw_header));
551b285192aSMauro Carvalho Chehab
552b285192aSMauro Carvalho Chehab fwloaderoffset = bootloaderoffset + bootloadersize;
553b285192aSMauro Carvalho Chehab
554b285192aSMauro Carvalho Chehab /* TODO: fix this bounds overrun here with old f/ws */
555b285192aSMauro Carvalho Chehab fwloadersize = (fwhdr->firmwaresize + fwhdr->bslsize) *
556b285192aSMauro Carvalho Chehab 16 + sizeof(struct fw_header);
557b285192aSMauro Carvalho Chehab
558b285192aSMauro Carvalho Chehab ret = saa7164_downloadimage(
559b285192aSMauro Carvalho Chehab dev,
560b285192aSMauro Carvalho Chehab fwloaderoffset,
561b285192aSMauro Carvalho Chehab fwloadersize,
562b285192aSMauro Carvalho Chehab SAA_DEVICE_2ND_DOWNLOADFLAG_OFFSET,
563b285192aSMauro Carvalho Chehab dev->bmmio + SAA_DEVICE_2ND_DOWNLOAD_OFFSET,
564b285192aSMauro Carvalho Chehab SAA_DEVICE_2ND_BUFFERBLOCKSIZE);
565b285192aSMauro Carvalho Chehab if (ret < 0) {
566b285192aSMauro Carvalho Chehab printk(KERN_ERR "firmware download failed\n");
567b285192aSMauro Carvalho Chehab goto out;
568b285192aSMauro Carvalho Chehab }
569b285192aSMauro Carvalho Chehab printk(KERN_ERR "firmware download complete.\n");
570b285192aSMauro Carvalho Chehab
571b285192aSMauro Carvalho Chehab } else {
572b285192aSMauro Carvalho Chehab
573b285192aSMauro Carvalho Chehab /* No bootloader update reqd, download firmware only */
574b285192aSMauro Carvalho Chehab printk(KERN_ERR "starting firmware download(3)\n");
575b285192aSMauro Carvalho Chehab
576b285192aSMauro Carvalho Chehab ret = saa7164_downloadimage(
577b285192aSMauro Carvalho Chehab dev,
578b285192aSMauro Carvalho Chehab (u8 *)fw->data,
579b285192aSMauro Carvalho Chehab fw->size,
580b285192aSMauro Carvalho Chehab SAA_DOWNLOAD_FLAGS,
581b285192aSMauro Carvalho Chehab dev->bmmio + SAA_DEVICE_DOWNLOAD_OFFSET,
582b285192aSMauro Carvalho Chehab SAA_DEVICE_BUFFERBLOCKSIZE);
583b285192aSMauro Carvalho Chehab if (ret < 0) {
584b285192aSMauro Carvalho Chehab printk(KERN_ERR "firmware download failed\n");
585b285192aSMauro Carvalho Chehab goto out;
586b285192aSMauro Carvalho Chehab }
587b285192aSMauro Carvalho Chehab printk(KERN_ERR "firmware download complete.\n");
588b285192aSMauro Carvalho Chehab }
589b285192aSMauro Carvalho Chehab }
590b285192aSMauro Carvalho Chehab
591b285192aSMauro Carvalho Chehab dev->firmwareloaded = 1;
592b285192aSMauro Carvalho Chehab ret = 0;
593b285192aSMauro Carvalho Chehab
594b285192aSMauro Carvalho Chehab out:
595b285192aSMauro Carvalho Chehab release_firmware(fw);
596b285192aSMauro Carvalho Chehab return ret;
597b285192aSMauro Carvalho Chehab }
598