usb-drv-as3525v2.c: fix compilation (typo)
[kugel-rb.git] / bootloader / mpio_hd200.c
blob5b72dd32433dd3634e3cd7477daf1ed965cf1478
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id:$
10 * Copyright (C) 2010 Marcin Bukat
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 ****************************************************************************/
21 #include "config.h"
23 #include <stdlib.h>
24 #include <stdio.h>
25 #include "inttypes.h"
26 #include "string.h"
27 #include "cpu.h"
28 #include "system.h"
29 #include "lcd.h"
30 #include "kernel.h"
31 #include "thread.h"
32 #include "storage.h"
33 #include "usb.h"
34 #include "disk.h"
35 #include "font.h"
36 #include "adc.h"
37 #include "backlight.h"
38 #include "backlight-target.h"
39 #include "button.h"
40 #include "panic.h"
41 #include "power.h"
42 #include "powermgmt.h"
43 #include "file.h"
45 #include "common.h"
46 #include "version.h"
48 #include <stdarg.h>
50 /* Maximum allowed firmware image size. 10MB is more than enough */
51 #define MAX_LOADSIZE (10*1024*1024)
53 #define DRAM_START 0x31000000
55 #define BOOTMENU_TIMEOUT (10*HZ)
56 #define BOOTMENU_OPTIONS 3
58 #define EVENT_NONE 0x00
59 #define EVENT_ON 0x01
60 #define EVENT_AC 0x02
61 #define EVENT_USB 0x04
63 /* From common.c */
64 extern int line;
65 static const char *bootmenu_options[] = {
66 "Boot rockbox",
67 "Boot MPIO firmware",
68 "Shutdown"
71 enum option_t {
72 rockbox,
73 mpio_firmware,
74 shutdown
77 int usb_screen(void)
79 return 0;
82 static inline bool _charger_inserted(void)
84 return (GPIO1_READ & (1<<14)) ? false : true;
87 static inline bool _battery_full(void)
89 return (GPIO_READ & (1<<30)) ? true : false;
92 /* Reset the cookie for the crt0 crash check */
93 static inline void __reset_cookie(void)
95 asm(" move.l #0,%d0");
96 asm(" move.l %d0,0x10017ffc");
99 static void start_rockbox(void)
101 adc_close();
102 asm(" move.w #0x2700,%sr");
103 __reset_cookie();
104 asm(" move.l %0,%%d0" :: "i"(DRAM_START));
105 asm(" movec.l %d0,%vbr");
106 asm(" move.l %0,%%sp" :: "m"(*(int *)DRAM_START));
107 asm(" move.l %0,%%a0" :: "m"(*(int *)(DRAM_START+4)));
108 asm(" jmp (%a0)");
111 static void start_mpio_firmware(void)
113 asm(" move.w #0x2700,%sr");
114 __reset_cookie();
115 asm(" movec.l %d0,%vbr");
116 asm(" move.l 0,%sp");
117 asm(" jmp 8");
120 static void __reset(void)
122 asm(" move.w #0x2700,%sr");
123 __reset_cookie();
124 asm(" movec.l %d0,%vbr");
125 asm(" move.l (0), %sp");
126 asm(" movea.l (4),%a0");
127 asm(" jmp (%a0)");
130 static void __shutdown(void)
132 /* We need to gracefully spin down the disk to prevent clicks. */
133 if (ide_powered())
135 /* Make sure ATA has been initialized. */
136 storage_init();
138 /* And put the disk into sleep immediately. */
139 storage_sleepnow();
142 /* Backlight OFF */
143 _backlight_off();
144 __reset_cookie();
146 if (_charger_inserted())
148 /* reset instead of power_off() */
149 __reset();
151 else
153 power_off();
157 /* Print the battery voltage (and a warning message). */
158 static void check_battery(void)
161 int battery_voltage, batt_int, batt_frac;
163 battery_voltage = battery_adc_voltage();
164 batt_int = battery_voltage / 1000;
165 batt_frac = (battery_voltage % 1000) / 10;
167 printf("Battery: %d.%02dV", batt_int, batt_frac);
169 if (battery_voltage <= 3500)
171 printf("WARNING! BATTERY LOW!!");
172 sleep(HZ*2);
178 static void lcd_putstring_centered(const char *string)
180 int w,h;
181 font_getstringsize(string, &w, &h, FONT_SYSFIXED);
182 lcd_putsxy((LCD_WIDTH-w)/2, (LCD_HEIGHT-h)/2, string);
185 static void rb_boot(void)
187 int rc;
189 rc = storage_init();
190 if(rc)
192 printf("ATA error: %d", rc);
193 sleep(HZ*5);
194 return;
197 disk_init();
199 rc = disk_mount_all();
200 if (rc<=0)
202 printf("No partition found");
203 sleep(HZ*5);
204 return;
207 printf("Loading firmware");
209 rc = load_firmware((unsigned char *)DRAM_START,
210 BOOTFILE, MAX_LOADSIZE);
212 if (rc < EOK)
214 printf("Error!");
215 printf("Can't load " BOOTFILE ": ");
216 printf("Result: %s", strerror(rc));
217 sleep(HZ*5);
218 return;
221 start_rockbox();
224 static void bootmenu(void)
226 enum option_t i;
227 enum option_t option = rockbox;
228 int button;
229 const char select[] = "->";
230 long start_tick = current_tick;
232 /* backbone of menu */
233 /* run the loader */
234 printf("Rockbox boot loader");
235 printf("Ver: " RBVERSION);
237 check_battery();
239 printf("");
240 printf("=========================");
242 line += BOOTMENU_OPTIONS+2; /* skip lines */
244 printf("=========================");
245 printf("");
246 printf(" [FF] [PREV] to move ");
247 printf(" [PLAY] to confirm ");
249 /* content of menu and keys handling */
250 while (TIME_BEFORE(current_tick,start_tick + BOOTMENU_TIMEOUT))
252 /* Draw the menu. */
253 line = 6; /* move below header */
255 for (i=0;i<BOOTMENU_OPTIONS;i++)
257 if (i != option)
258 printf(" %s",bootmenu_options[i]);
259 else
260 printf("%s %s",select,bootmenu_options[i]);
263 line = 15;
265 printf("Time left: %ds",(BOOTMENU_TIMEOUT -
266 (current_tick - start_tick))/HZ);
268 lcd_update();
270 button = button_get_w_tmo(HZ);
272 switch (button)
274 case BUTTON_PREV:
275 if (option > rockbox)
276 option--;
277 else
278 option = shutdown;
279 break;
281 case BUTTON_NEXT:
282 if (option < shutdown)
283 option++;
284 else
285 option = rockbox;
286 break;
288 case BUTTON_PLAY:
289 case (BUTTON_PLAY|BUTTON_REC):
290 reset_screen();
292 switch (option)
294 case rockbox:
295 rb_boot();
296 break;
298 case mpio_firmware:
299 start_mpio_firmware();
300 break;
302 default:
303 return;
304 break;
308 /* timeout */
311 void main(void)
313 /* messages */
314 const char usb_connect_msg[] = "Bootloader USB mode";
315 const char charging_msg[] = "Charging...";
316 const char complete_msg[] = "Charging complete";
318 /* helper variable for messages */
319 bool blink_toggle = false;
321 int button;
322 unsigned int event = EVENT_NONE;
323 unsigned int last_event = EVENT_NONE;
325 power_init();
327 system_init();
328 kernel_init();
330 set_cpu_frequency(CPUFREQ_NORMAL);
331 coldfire_set_pllcr_audio_bits(DEFAULT_PLLCR_AUDIO_BITS);
333 enable_irq();
334 lcd_init();
336 /* only lowlevel functions no queue init */
337 _backlight_init();
338 _backlight_hw_on();
340 /* setup font system*/
341 font_init();
342 lcd_setfont(FONT_SYSFIXED);
344 /* buttons reading */
345 adc_init();
346 button_init();
348 usb_init();
349 cpu_idle_mode(true);
351 /* Handle wakeup event. Possibilities are:
352 * ON button (PLAY)
353 * USB insert
354 * AC charger plug
357 while(1)
359 /* read buttons */
360 event = EVENT_NONE;
361 button = button_get_w_tmo(HZ);
363 if ( button & BUTTON_PLAY )
364 event |= EVENT_ON;
366 if ( usb_detect() == USB_INSERTED )
367 event |= EVENT_USB;
369 if ( _charger_inserted() )
370 event |= EVENT_AC;
372 reset_screen();
373 switch (event)
375 case EVENT_ON:
376 case (EVENT_ON | EVENT_AC):
377 /* hold is handled in button driver */
378 cpu_idle_mode(false);
379 ide_power_enable(true);
381 if (button == (BUTTON_PLAY|BUTTON_REC))
382 bootmenu();
383 else
384 rb_boot();
386 break;
388 case EVENT_AC:
389 if (!(last_event & EVENT_AC))
391 /* high current charge */
392 or_l((1<<15),&GPIO_OUT);
393 and_l(~(1<<23), &GPIO_ENABLE);
396 /* USB unplug */
397 if (last_event & EVENT_USB)
399 usb_enable(false);
400 ide_power_enable(false);
403 if(!_battery_full())
405 if (blink_toggle)
406 lcd_putstring_centered(charging_msg);
408 blink_toggle = !blink_toggle;
410 else
412 lcd_putstring_centered(complete_msg);
414 check_battery();
415 break;
417 case EVENT_USB:
418 case (EVENT_USB | EVENT_AC):
419 if (!(last_event & EVENT_AC))
421 /* high current charge */
422 or_l((1<<15),&GPIO_OUT);
423 and_l(~(1<<23), &GPIO_ENABLE);
426 if (!(last_event & EVENT_USB))
428 /* init USB */
429 ide_power_enable(true);
430 sleep(HZ/20);
431 usb_enable(true);
434 line = 0;
436 if (blink_toggle)
437 lcd_putstring_centered(usb_connect_msg);
439 check_battery();
440 blink_toggle = !blink_toggle;
441 storage_spin();
442 break;
444 default:
445 /* spurious wakeup */
446 __shutdown();
447 break;
449 lcd_update();
450 last_event = event;
455 /* These functions are present in the firmware library, but we reimplement
456 them here because the originals do a lot more than we want */
457 void screen_dump(void)