2 * Driver for the NXP SAA7164 PCIe bridge
4 * Copyright (c) 2010-2015 Steven Toth <stoth@kernellabs.com>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
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
15 * GNU General Public License for more details.
18 #include <linux/firmware.h>
19 #include <linux/slab.h>
23 #define SAA7164_REV2_FIRMWARE "NXP7164-2010-03-10.1.fw"
24 #define SAA7164_REV2_FIRMWARE_SIZE 4019072
26 #define SAA7164_REV3_FIRMWARE "NXP7164-2010-03-10.1.fw"
27 #define SAA7164_REV3_FIRMWARE_SIZE 4019072
36 static int saa7164_dl_wait_ack(struct saa7164_dev
*dev
, u32 reg
)
38 u32 timeout
= SAA_DEVICE_TIMEOUT
;
39 while ((saa7164_readl(reg
) & 0x01) == 0) {
42 printk(KERN_ERR
"%s() timeout (no d/l ack)\n",
52 static int saa7164_dl_wait_clr(struct saa7164_dev
*dev
, u32 reg
)
54 u32 timeout
= SAA_DEVICE_TIMEOUT
;
55 while (saa7164_readl(reg
) & 0x01) {
58 printk(KERN_ERR
"%s() timeout (no d/l clr)\n",
68 /* TODO: move dlflags into dev-> and change to write/readl/b */
69 /* TODO: Excessive levels of debug */
70 static int saa7164_downloadimage(struct saa7164_dev
*dev
, u8
*src
, u32 srcsize
,
71 u32 dlflags
, u8 __iomem
*dst
, u32 dstsize
)
73 u32 reg
, timeout
, offset
;
78 u32 dlflag_ack
= dlflag
+ 4;
79 u32 drflag
= dlflag_ack
+ 4;
80 u32 drflag_ack
= drflag
+ 4;
81 u32 bleflag
= drflag_ack
+ 4;
84 "%s(image=%p, size=%d, flags=0x%x, dst=%p, dstsize=0x%x)\n",
85 __func__
, src
, srcsize
, dlflags
, dst
, dstsize
);
87 if ((src
== NULL
) || (dst
== NULL
)) {
92 srcbuf
= kzalloc(4 * 1048576, GFP_KERNEL
);
98 if (srcsize
> (4*1048576)) {
103 memcpy(srcbuf
, src
, srcsize
);
105 dprintk(DBGLVL_FW
, "%s() dlflag = 0x%x\n", __func__
, dlflag
);
106 dprintk(DBGLVL_FW
, "%s() dlflag_ack = 0x%x\n", __func__
, dlflag_ack
);
107 dprintk(DBGLVL_FW
, "%s() drflag = 0x%x\n", __func__
, drflag
);
108 dprintk(DBGLVL_FW
, "%s() drflag_ack = 0x%x\n", __func__
, drflag_ack
);
109 dprintk(DBGLVL_FW
, "%s() bleflag = 0x%x\n", __func__
, bleflag
);
111 reg
= saa7164_readl(dlflag
);
112 dprintk(DBGLVL_FW
, "%s() dlflag (0x%x)= 0x%x\n", __func__
, dlflag
, reg
);
115 "%s() Download flag already set, please reboot\n",
118 /* Indicate download start */
119 saa7164_writel(dlflag
, 1);
120 ret
= saa7164_dl_wait_ack(dev
, dlflag_ack
);
124 /* Ack download start, then wait for wait */
125 saa7164_writel(dlflag
, 0);
126 ret
= saa7164_dl_wait_clr(dev
, dlflag_ack
);
130 /* Deal with the raw firmware, in the appropriate chunk size */
131 for (offset
= 0; srcsize
> dstsize
;
132 srcsize
-= dstsize
, offset
+= dstsize
) {
134 dprintk(DBGLVL_FW
, "%s() memcpy %d\n", __func__
, dstsize
);
135 memcpy_toio(dst
, srcbuf
+ offset
, dstsize
);
137 /* Flag the data as ready */
138 saa7164_writel(drflag
, 1);
139 ret
= saa7164_dl_wait_ack(dev
, drflag_ack
);
143 /* Wait for indication data was received */
144 saa7164_writel(drflag
, 0);
145 ret
= saa7164_dl_wait_clr(dev
, drflag_ack
);
151 dprintk(DBGLVL_FW
, "%s() memcpy(l) %d\n", __func__
, dstsize
);
152 /* Write last block to the device */
153 memcpy_toio(dst
, srcbuf
+offset
, srcsize
);
155 /* Flag the data as ready */
156 saa7164_writel(drflag
, 1);
157 ret
= saa7164_dl_wait_ack(dev
, drflag_ack
);
161 saa7164_writel(drflag
, 0);
163 while (saa7164_readl(bleflag
) != SAA_DEVICE_IMAGE_BOOTING
) {
164 if (saa7164_readl(bleflag
) & SAA_DEVICE_IMAGE_CORRUPT
) {
165 printk(KERN_ERR
"%s() image corrupt\n", __func__
);
170 if (saa7164_readl(bleflag
) & SAA_DEVICE_MEMORY_CORRUPT
) {
171 printk(KERN_ERR
"%s() device memory corrupt\n",
177 msleep(10); /* Checkpatch throws a < 20ms warning */
182 printk(KERN_INFO
"%s() Image downloaded, booting...\n", __func__
);
184 ret
= saa7164_dl_wait_clr(dev
, drflag_ack
);
188 printk(KERN_INFO
"%s() Image booted successfully.\n", __func__
);
196 /* TODO: Excessive debug */
197 /* Load the firmware. Optionally it can be in ROM or newer versions
198 * can be on disk, saving the expense of the ROM hardware. */
199 int saa7164_downloadfirmware(struct saa7164_dev
*dev
)
201 /* u32 second_timeout = 60 * SAA_DEVICE_TIMEOUT; */
202 u32 tmp
, filesize
, version
, err_flags
, first_timeout
, fwlength
;
203 u32 second_timeout
, updatebootloader
= 1, bootloadersize
= 0;
204 const struct firmware
*fw
= NULL
;
205 struct fw_header
*hdr
, *boothdr
= NULL
, *fwhdr
;
206 u32 bootloaderversion
= 0, fwloadersize
;
207 u8
*bootloaderoffset
= NULL
, *fwloaderoffset
;
211 dprintk(DBGLVL_FW
, "%s()\n", __func__
);
213 if (saa7164_boards
[dev
->board
].chiprev
== SAA7164_CHIP_REV2
) {
214 fwname
= SAA7164_REV2_FIRMWARE
;
215 fwlength
= SAA7164_REV2_FIRMWARE_SIZE
;
217 fwname
= SAA7164_REV3_FIRMWARE
;
218 fwlength
= SAA7164_REV3_FIRMWARE_SIZE
;
221 version
= saa7164_getcurrentfirmwareversion(dev
);
223 if (version
== 0x00) {
225 second_timeout
= 100;
227 err_flags
= saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
);
228 dprintk(DBGLVL_FW
, "%s() err_flags = %x\n",
229 __func__
, err_flags
);
231 while (err_flags
!= SAA_DEVICE_IMAGE_BOOTING
) {
232 dprintk(DBGLVL_FW
, "%s() err_flags = %x\n",
233 __func__
, err_flags
);
234 msleep(10); /* Checkpatch throws a < 20ms warning */
236 if (err_flags
& SAA_DEVICE_IMAGE_CORRUPT
) {
237 printk(KERN_ERR
"%s() firmware corrupt\n",
241 if (err_flags
& SAA_DEVICE_MEMORY_CORRUPT
) {
242 printk(KERN_ERR
"%s() device memory corrupt\n",
246 if (err_flags
& SAA_DEVICE_NO_IMAGE
) {
247 printk(KERN_ERR
"%s() no first image\n",
251 if (err_flags
& SAA_DEVICE_IMAGE_SEARCHING
) {
253 if (first_timeout
== 0) {
255 "%s() no first image\n",
259 } else if (err_flags
& SAA_DEVICE_IMAGE_LOADING
) {
260 second_timeout
-= 10;
261 if (second_timeout
== 0) {
263 "%s() FW load time exceeded\n",
268 second_timeout
-= 10;
269 if (second_timeout
== 0) {
271 "%s() Unknown bootloader flags 0x%x\n",
272 __func__
, err_flags
);
277 err_flags
= saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
);
278 } /* While != Booting */
280 if (err_flags
== SAA_DEVICE_IMAGE_BOOTING
) {
281 dprintk(DBGLVL_FW
, "%s() Loader 1 has loaded.\n",
283 first_timeout
= SAA_DEVICE_TIMEOUT
;
284 second_timeout
= 60 * SAA_DEVICE_TIMEOUT
;
285 second_timeout
= 100;
287 err_flags
= saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS
);
288 dprintk(DBGLVL_FW
, "%s() err_flags2 = %x\n",
289 __func__
, err_flags
);
290 while (err_flags
!= SAA_DEVICE_IMAGE_BOOTING
) {
291 dprintk(DBGLVL_FW
, "%s() err_flags2 = %x\n",
292 __func__
, err_flags
);
293 msleep(10); /* Checkpatch throws a < 20ms warning */
295 if (err_flags
& SAA_DEVICE_IMAGE_CORRUPT
) {
297 "%s() firmware corrupt\n",
301 if (err_flags
& SAA_DEVICE_MEMORY_CORRUPT
) {
303 "%s() device memory corrupt\n",
307 if (err_flags
& SAA_DEVICE_NO_IMAGE
) {
308 printk(KERN_ERR
"%s() no second image\n",
312 if (err_flags
& SAA_DEVICE_IMAGE_SEARCHING
) {
314 if (first_timeout
== 0) {
316 "%s() no second image\n",
320 } else if (err_flags
&
321 SAA_DEVICE_IMAGE_LOADING
) {
322 second_timeout
-= 10;
323 if (second_timeout
== 0) {
325 "%s() FW load time exceeded\n",
330 second_timeout
-= 10;
331 if (second_timeout
== 0) {
333 "%s() Unknown bootloader flags 0x%x\n",
334 __func__
, err_flags
);
340 saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS
);
341 } /* err_flags != SAA_DEVICE_IMAGE_BOOTING */
343 dprintk(DBGLVL_FW
, "%s() Loader flags 1:0x%x 2:0x%x.\n",
345 saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
),
346 saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS
));
348 } /* err_flags == SAA_DEVICE_IMAGE_BOOTING */
350 /* It's possible for both firmwares to have booted,
351 * but that doesn't mean they've finished booting yet.
353 if ((saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
) ==
354 SAA_DEVICE_IMAGE_BOOTING
) &&
355 (saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS
) ==
356 SAA_DEVICE_IMAGE_BOOTING
)) {
359 dprintk(DBGLVL_FW
, "%s() Loader 2 has loaded.\n",
362 first_timeout
= SAA_DEVICE_TIMEOUT
;
363 while (first_timeout
) {
364 msleep(10); /* Checkpatch throws a < 20ms warning */
367 saa7164_getcurrentfirmwareversion(dev
);
370 "%s() All f/w loaded successfully\n",
375 if (first_timeout
== 0) {
377 "%s() FW did not boot\n",
384 version
= saa7164_getcurrentfirmwareversion(dev
);
387 /* Has the firmware really booted? */
388 if ((saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
) ==
389 SAA_DEVICE_IMAGE_BOOTING
) &&
390 (saa7164_readl(SAA_SECONDSTAGEERROR_FLAGS
) ==
391 SAA_DEVICE_IMAGE_BOOTING
) && (version
== 0)) {
394 "%s() The firmware hung, probably bad firmware\n",
397 /* Tell the second stage loader we have a deadlock */
398 saa7164_writel(SAA_DEVICE_DEADLOCK_DETECTED_OFFSET
,
399 SAA_DEVICE_DEADLOCK_DETECTED
);
401 saa7164_getfirmwarestatus(dev
);
406 dprintk(DBGLVL_FW
, "Device has Firmware Version %d.%d.%d.%d\n",
407 (version
& 0x0000fc00) >> 10,
408 (version
& 0x000003e0) >> 5,
409 (version
& 0x0000001f),
410 (version
& 0xffff0000) >> 16);
412 /* Load the firmwware from the disk if required */
415 printk(KERN_INFO
"%s() Waiting for firmware upload (%s)\n",
418 ret
= request_firmware(&fw
, fwname
, &dev
->pci
->dev
);
420 printk(KERN_ERR
"%s() Upload failed. (file not found?)\n",
425 printk(KERN_INFO
"%s() firmware read %zu bytes.\n",
428 if (fw
->size
!= fwlength
) {
429 printk(KERN_ERR
"saa7164: firmware incorrect size %zu != %u\n",
435 printk(KERN_INFO
"%s() firmware loaded.\n", __func__
);
437 hdr
= (struct fw_header
*)fw
->data
;
438 printk(KERN_INFO
"Firmware file header part 1:\n");
439 printk(KERN_INFO
" .FirmwareSize = 0x%x\n", hdr
->firmwaresize
);
440 printk(KERN_INFO
" .BSLSize = 0x%x\n", hdr
->bslsize
);
441 printk(KERN_INFO
" .Reserved = 0x%x\n", hdr
->reserved
);
442 printk(KERN_INFO
" .Version = 0x%x\n", hdr
->version
);
444 /* Retrieve bootloader if reqd */
445 if ((hdr
->firmwaresize
== 0) && (hdr
->bslsize
== 0))
446 /* Second bootloader in the firmware file */
447 filesize
= hdr
->reserved
* 16;
449 filesize
= (hdr
->firmwaresize
+ hdr
->bslsize
) *
450 16 + sizeof(struct fw_header
);
452 printk(KERN_INFO
"%s() SecBootLoader.FileSize = %d\n",
455 /* Get bootloader (if reqd) and firmware header */
456 if ((hdr
->firmwaresize
== 0) && (hdr
->bslsize
== 0)) {
457 /* Second boot loader is required */
459 /* Get the loader header */
460 boothdr
= (struct fw_header
*)(fw
->data
+
461 sizeof(struct fw_header
));
464 saa7164_readl(SAA_DEVICE_2ND_VERSION
);
465 dprintk(DBGLVL_FW
, "Onboard BootLoader:\n");
466 dprintk(DBGLVL_FW
, "->Flag 0x%x\n",
467 saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
));
468 dprintk(DBGLVL_FW
, "->Ack 0x%x\n",
469 saa7164_readl(SAA_DATAREADY_FLAG_ACK
));
470 dprintk(DBGLVL_FW
, "->FW Version 0x%x\n", version
);
471 dprintk(DBGLVL_FW
, "->Loader Version 0x%x\n",
474 if ((saa7164_readl(SAA_BOOTLOADERERROR_FLAGS
) ==
475 0x03) && (saa7164_readl(SAA_DATAREADY_FLAG_ACK
)
476 == 0x00) && (version
== 0x00)) {
478 dprintk(DBGLVL_FW
, "BootLoader version in rom %d.%d.%d.%d\n",
479 (bootloaderversion
& 0x0000fc00) >> 10,
480 (bootloaderversion
& 0x000003e0) >> 5,
481 (bootloaderversion
& 0x0000001f),
482 (bootloaderversion
& 0xffff0000) >> 16
484 dprintk(DBGLVL_FW
, "BootLoader version in file %d.%d.%d.%d\n",
485 (boothdr
->version
& 0x0000fc00) >> 10,
486 (boothdr
->version
& 0x000003e0) >> 5,
487 (boothdr
->version
& 0x0000001f),
488 (boothdr
->version
& 0xffff0000) >> 16
491 if (bootloaderversion
== boothdr
->version
)
492 updatebootloader
= 0;
495 /* Calculate offset to firmware header */
496 tmp
= (boothdr
->firmwaresize
+ boothdr
->bslsize
) * 16 +
497 (sizeof(struct fw_header
) +
498 sizeof(struct fw_header
));
500 fwhdr
= (struct fw_header
*)(fw
->data
+tmp
);
502 /* No second boot loader */
506 dprintk(DBGLVL_FW
, "Firmware version in file %d.%d.%d.%d\n",
507 (fwhdr
->version
& 0x0000fc00) >> 10,
508 (fwhdr
->version
& 0x000003e0) >> 5,
509 (fwhdr
->version
& 0x0000001f),
510 (fwhdr
->version
& 0xffff0000) >> 16
513 if (version
== fwhdr
->version
) {
514 /* No download, firmware already on board */
519 if ((hdr
->firmwaresize
== 0) && (hdr
->bslsize
== 0)) {
520 if (updatebootloader
) {
521 /* Get ready to upload the bootloader */
522 bootloadersize
= (boothdr
->firmwaresize
+
523 boothdr
->bslsize
) * 16 +
524 sizeof(struct fw_header
);
526 bootloaderoffset
= (u8
*)(fw
->data
+
527 sizeof(struct fw_header
));
529 dprintk(DBGLVL_FW
, "bootloader d/l starts.\n");
530 printk(KERN_INFO
"%s() FirmwareSize = 0x%x\n",
531 __func__
, boothdr
->firmwaresize
);
532 printk(KERN_INFO
"%s() BSLSize = 0x%x\n",
533 __func__
, boothdr
->bslsize
);
534 printk(KERN_INFO
"%s() Reserved = 0x%x\n",
535 __func__
, boothdr
->reserved
);
536 printk(KERN_INFO
"%s() Version = 0x%x\n",
537 __func__
, boothdr
->version
);
538 ret
= saa7164_downloadimage(
543 dev
->bmmio
+ SAA_DEVICE_DOWNLOAD_OFFSET
,
544 SAA_DEVICE_BUFFERBLOCKSIZE
);
547 "bootloader d/l has failed\n");
551 "bootloader download complete.\n");
555 printk(KERN_ERR
"starting firmware download(2)\n");
556 bootloadersize
= (boothdr
->firmwaresize
+
557 boothdr
->bslsize
) * 16 +
558 sizeof(struct fw_header
);
561 (u8
*)(fw
->data
+ sizeof(struct fw_header
));
563 fwloaderoffset
= bootloaderoffset
+ bootloadersize
;
565 /* TODO: fix this bounds overrun here with old f/ws */
566 fwloadersize
= (fwhdr
->firmwaresize
+ fwhdr
->bslsize
) *
567 16 + sizeof(struct fw_header
);
569 ret
= saa7164_downloadimage(
573 SAA_DEVICE_2ND_DOWNLOADFLAG_OFFSET
,
574 dev
->bmmio
+ SAA_DEVICE_2ND_DOWNLOAD_OFFSET
,
575 SAA_DEVICE_2ND_BUFFERBLOCKSIZE
);
577 printk(KERN_ERR
"firmware download failed\n");
580 printk(KERN_ERR
"firmware download complete.\n");
584 /* No bootloader update reqd, download firmware only */
585 printk(KERN_ERR
"starting firmware download(3)\n");
587 ret
= saa7164_downloadimage(
592 dev
->bmmio
+ SAA_DEVICE_DOWNLOAD_OFFSET
,
593 SAA_DEVICE_BUFFERBLOCKSIZE
);
595 printk(KERN_ERR
"firmware download failed\n");
598 printk(KERN_ERR
"firmware download complete.\n");
602 dev
->firmwareloaded
= 1;
606 release_firmware(fw
);