Fix FS#11539. Undo r23967 and use another way to achieve results for negative exponen...
[maemo-rb.git] / bootloader / ondavx747.c
blob2903b04252bcb274821c97718e67181f43e29f24
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
10 * Copyright (C) 2008 by Maurus Cuelenaere
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
22 #include "config.h"
23 #include "jz4740.h"
24 #include "backlight.h"
25 #include "font.h"
26 #include "lcd.h"
27 #include "file.h"
28 #include "usb.h"
29 #include "system.h"
30 #include "button.h"
31 #include "common.h"
32 #include "storage.h"
33 #include "disk.h"
34 #include "string.h"
35 #include "adc.h"
36 #include "version.h"
38 extern int show_logo(void);
39 extern void power_off(void);
41 static void show_splash(int timeout, const char *msg)
43 reset_screen();
44 lcd_putsxy( (LCD_WIDTH - (SYSFONT_WIDTH * strlen(msg))) / 2,
45 (LCD_HEIGHT - SYSFONT_HEIGHT) / 2, msg);
46 lcd_update();
48 sleep(timeout);
51 static void usb_mode(void)
53 int button;
55 /* Init USB */
56 usb_init();
57 usb_start_monitoring();
59 /* Wait for threads to connect */
60 show_splash(HZ/2, "Waiting for USB");
62 while (1)
64 button = button_get_w_tmo(HZ/2);
66 if (button == SYS_USB_CONNECTED)
67 break; /* Hit */
70 if (button == SYS_USB_CONNECTED)
72 /* Got the message - wait for disconnect */
73 show_splash(0, "Bootloader USB mode");
75 usb_acknowledge(SYS_USB_CONNECTED_ACK);
77 while (1)
79 button = button_get(true);
80 if (button == SYS_USB_DISCONNECTED)
82 usb_acknowledge(SYS_USB_DISCONNECTED_ACK);
83 break;
89 static int boot_of(void)
91 int fd, rc, len, i, checksum = 0;
92 void (*kernel_entry)(int, void*, void*);
94 printf("Mounting disk...");
95 rc = disk_mount_all();
96 if (rc <= 0)
97 error(EDISK, rc, true);
99 /* TODO: get this from the NAND flash instead of SD */
100 fd = open("/ccpmp.bin", O_RDONLY);
101 if(fd < 0)
102 return EFILE_NOT_FOUND;
104 lseek(fd, 4, SEEK_SET);
105 rc = read(fd, (char*)&len, 4); /* CPU is LE */
106 if(rc < 4)
107 return EREAD_IMAGE_FAILED;
109 len += 8;
110 printf("Reading %d bytes...", len);
112 lseek(fd, 0, SEEK_SET);
113 rc = read(fd, (void*)0x80004000, len);
114 if(rc < len)
115 return EREAD_IMAGE_FAILED;
117 close(fd);
119 for(i=0; i<len; i++)
120 checksum += ((unsigned char*)0x80004000)[i];
122 *((unsigned int*)0x80004000) = checksum;
124 printf("Starting the OF...");
126 /* OF requires all clocks on */
127 __cpm_start_all();
129 disable_interrupt();
130 __dcache_writeback_all();
131 __icache_invalidate_all();
133 for(i=8000; i>0; i--)
134 asm volatile("nop\n");
136 kernel_entry = (void*) 0x80004008;
137 kernel_entry(0, "Jan 10 2008", "15:34:42"); /* Reversed from the SPL */
139 return 0; /* Shouldn't happen */
142 static int boot_rockbox(void)
144 int rc;
145 void (*kernel_entry)(void);
147 printf("Mounting disk...");
148 rc = disk_mount_all();
149 if (rc <= 0)
150 error(EDISK,rc, true);
152 printf("Loading firmware...");
153 rc = load_firmware((unsigned char *)CONFIG_SDRAM_START, BOOTFILE, 0x400000);
154 if(rc < 0)
155 return rc;
156 else
158 printf("Starting Rockbox...");
159 adc_close(); /* Disable SADC, seems to fix the re-init Rockbox does */
161 disable_interrupt();
162 kernel_entry = (void*) CONFIG_SDRAM_START;
163 kernel_entry();
165 return 0; /* Shouldn't happen */
169 static void reset_configuration(void)
171 int rc;
173 rc = disk_mount_all();
174 if (rc <= 0)
175 error(EDISK,rc, true);
177 if(rename(ROCKBOX_DIR "/config.cfg", ROCKBOX_DIR "/config.old") == 0)
178 show_splash(HZ/2, "Configuration reset successfully!");
179 else
180 show_splash(HZ/2, "Couldn't reset configuration!");
183 #define RECT_X (LCD_WIDTH/8)
184 #define RECT_Y(i) (LCD_HEIGHT/20 + LCD_HEIGHT/10*i + RECT_HEIGHT*i)
185 #define RECT_WIDTH (LCD_WIDTH*3/4)
186 #define RECT_HEIGHT (LCD_HEIGHT/ARRAYLEN(strings) - LCD_HEIGHT/10)
187 #define TEXT_X(i) (RECT_X + RECT_WIDTH/2 - strlen(strings[i])*SYSFONT_WIDTH/2)
188 #define TEXT_Y(i) (RECT_Y(i) + RECT_HEIGHT/2 - SYSFONT_HEIGHT/2)
189 static int boot_menu(void)
191 const char* strings[] = {"Boot Rockbox", "Boot OF", "USB mode", "Reset Rockbox configuration"};
192 int button, touch, poweroff_repeat = 0;
193 unsigned int i;
195 verbose = true;
196 adc_init();
198 redraw:
199 lcd_clear_display();
200 for(i=0; i<ARRAYLEN(strings); i++)
202 lcd_drawrect(RECT_X, RECT_Y(i), RECT_WIDTH, RECT_HEIGHT);
203 lcd_putsxy(TEXT_X(i), TEXT_Y(i), strings[i]);
205 lcd_update();
207 while(1)
209 button = button_get_w_tmo(HZ/4);
210 if(button & BUTTON_TOUCHSCREEN)
212 touch = button_get_data();
213 unsigned int x = touch & 0xFFFF, y = touch >> 16;
214 int found = -1;
215 for(i=0; i<ARRAYLEN(strings); i++)
217 if(x > RECT_X && x < RECT_X+RECT_WIDTH &&
218 y > RECT_Y(i) && y < RECT_Y(i)+RECT_HEIGHT)
220 found = i;
221 break;
225 switch(found)
227 case 0:
228 reset_screen();
229 boot_rockbox();
230 break;
231 case 1:
232 reset_screen();
233 boot_of();
234 break;
235 case 2:
236 usb_mode();
237 break;
238 case 3:
239 reset_configuration();
240 break;
243 if(found != -1)
244 goto redraw;
246 else if(button & BUTTON_POWER)
248 if(poweroff_repeat++ > 8)
249 power_off();
251 else
252 poweroff_repeat = 0;
256 int main(void)
258 int rc;
259 #ifdef HAVE_TOUCHSCREEN
260 int dummy;
261 #endif
263 kernel_init();
264 lcd_init();
265 font_init();
266 lcd_setfont(FONT_SYSFIXED);
267 button_init();
268 backlight_init();
270 show_logo();
272 rc = storage_init();
273 if(rc)
274 error(EATA, rc, true);
276 /* Don't mount the disks yet, there could be file system/partition errors
277 which are fixable in USB mode */
279 #ifdef HAVE_TOUCHSCREEN
280 rc = button_read_device(&dummy);
281 #else
282 rc = button_read_device();
283 #endif
285 if(rc)
286 verbose = true;
288 #ifdef BUTTON_VOL_UP
289 if(rc & BUTTON_VOL_UP ||
290 #endif
291 #ifdef BUTTON_POWER
292 rc & BUTTON_POWER ||
293 #endif
295 rc = boot_menu();
297 if(verbose)
298 reset_screen();
299 printf(MODEL_NAME" Rockbox Bootloader");
300 printf("Version " RBVERSION);
302 #ifdef HAS_BUTTON_HOLD
303 if(button_hold())
304 rc = boot_of();
305 else
306 #endif
307 rc = boot_rockbox();
309 if(rc < 0)
310 printf("Error: %s", strerror(rc));
312 /* Halt */
313 while (1)
314 core_idle();
316 return 0;