2 * (C) Copyright 2007 Schindler Lift Inc.
3 * (C) Copyright 2007 DENX Software Engineering
5 * Author: Michel Marti <mma@objectxp.com>
6 * Adapted for U-Boot 1.2 by Piotr Kruszynski <ppk@semihalf.com>:
8 * - bugfix for overwriting bootargs by user
10 * SPDX-License-Identifier: GPL-2.0+
22 extern long do_fat_read(const char *, void *, unsigned long, int);
23 extern int do_fat_fsload(cmd_tbl_t *, int, int, char * const []);
25 static int load_rescue_image(ulong);
27 void cm5200_fwupdate(void)
33 char * const argv[3] = { "bootm", ka, NULL };
35 /* Check if rescue system is disabled... */
36 if (getenv("norescue")) {
37 printf(LOG_PREFIX "Rescue System disabled.\n");
41 /* Check if we have a USB storage device and load image */
42 if (load_rescue_image(LOAD_ADDR))
45 bcmd = find_cmd("bootm");
49 sprintf(ka, "%lx", (ulong)LOAD_ADDR);
51 /* prepare our bootargs */
52 rsargs = getenv("rs-args");
56 tmp = malloc(strlen(rsargs+1));
58 printf(LOG_PREFIX "Memory allocation failed\n");
65 setenv("bootargs", rsargs);
70 printf(LOG_PREFIX "Starting update system (bootargs=%s)...\n", rsargs);
71 do_bootm(bcmd, 0, 2, argv);
74 static int load_rescue_image(ulong addr)
76 disk_partition_t info;
85 char * const argv[6] = { "fatload", "usb", dev, addr_str, nxri, NULL };
86 block_dev_desc_t *stor_dev = NULL;
89 /* Get name of firmware directory */
90 tmp = getenv("fw-dir");
92 /* Copy it into fwdir */
93 strncpy(fwdir, tmp ? tmp : FW_DIR, sizeof(fwdir));
94 fwdir[sizeof(fwdir) - 1] = 0; /* Terminate string */
96 printf(LOG_PREFIX "Checking for firmware image directory '%s' on USB"
97 " storage...\n", fwdir);
102 /* Check for storage device */
103 if (usb_stor_scan(1) != 0) {
108 /* Detect storage device */
109 for (devno = 0; devno < USB_MAX_STOR_DEV; devno++) {
110 stor_dev = usb_stor_get_dev(devno);
111 if (stor_dev->type != DEV_TYPE_UNKNOWN)
114 if (!stor_dev || stor_dev->type == DEV_TYPE_UNKNOWN) {
115 printf(LOG_PREFIX "No valid storage device found...\n");
120 /* Detect partition */
121 for (partno = -1, i = 0; i < 6; i++) {
122 if (get_partition_info(stor_dev, i, &info) == 0) {
123 if (fat_register_device(stor_dev, i) == 0) {
124 /* Check if rescue image is present */
125 FW_DEBUG("Looking for firmware directory '%s'"
126 " on partition %d\n", fwdir, i);
127 if (do_fat_read(fwdir, NULL, 0, LS_NO) == -1) {
128 FW_DEBUG("No NX rescue image on "
129 "partition %d.\n", i);
133 FW_DEBUG("Partition %d contains "
134 "firmware directory\n", partno);
144 printf(LOG_PREFIX "Error: No valid (FAT) partition "
148 printf(LOG_PREFIX "Error: No NX rescue image on FAT "
152 printf(LOG_PREFIX "Error: Failed with code %d\n",
159 /* Load the rescue image */
160 bcmd = find_cmd("fatload");
162 printf(LOG_PREFIX "Error - 'fatload' command not present.\n");
167 tmp = getenv("nx-rescue-image");
168 sprintf(nxri, "%s/%s", fwdir, tmp ? tmp : RESCUE_IMAGE);
169 sprintf(dev, "%d:%d", devno, partno);
170 sprintf(addr_str, "%lx", addr);
172 FW_DEBUG("fat_fsload device='%s', addr='%s', file: %s\n",
173 dev, addr_str, nxri);
175 if (do_fat_fsload(bcmd, 0, 5, argv) != 0) {