Remove unecessary casting
[maemo-rb.git] / bootloader / imx233.c
blob548bb3686f8ea952210979cda38dfcab8b17d12b
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
10 * Copyright (C) 2011 by amaury Pouly
12 * Based on Rockbox iriver bootloader by Linus Nielsen Feltzing
13 * and the ipodlinux bootloader by Daniel Palffy and Bernard Leach
15 * This program is free software; you can redistribute it and/or
16 * modify it under the terms of the GNU General Public License
17 * as published by the Free Software Foundation; either version 2
18 * of the License, or (at your option) any later version.
20 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
21 * KIND, either express or implied.
23 ****************************************************************************/
25 #include <stdio.h>
26 #include <system.h>
27 #include <inttypes.h>
28 #include "config.h"
29 #include "gcc_extensions.h"
30 #include "lcd.h"
31 #include "backlight.h"
32 #include "button-target.h"
33 #include "common.h"
34 #include "storage.h"
35 #include "disk.h"
36 #include "panic.h"
37 #include "power.h"
38 #include "system-target.h"
39 #include "fmradio_i2c.h"
41 #include "usb.h"
42 #include "usb-target.h"
44 #include "clkctrl-imx233.h"
46 #ifdef HAVE_BOOTLOADER_USB_MODE
47 static void usb_mode(int connect_timeout)
49 int button;
51 usb_init();
52 usb_start_monitoring();
54 /* Wait for threads to connect or cable is pulled */
55 printf("USB: Connecting");
57 long end_tick = current_tick + connect_timeout;
59 while(1)
61 button = button_get_w_tmo(HZ/10);
63 if(button == SYS_USB_CONNECTED)
64 break; /* Hit */
66 if(TIME_AFTER(current_tick, end_tick))
68 /* Timed out waiting for the connect - will happen when connected
69 * to a charger through the USB port */
70 printf("USB: Timed out");
71 break;
74 if(!usb_plugged())
75 break; /* Cable pulled */
78 if(button == SYS_USB_CONNECTED)
80 /* Got the message - wait for disconnect */
81 printf("Bootloader USB mode");
83 usb_acknowledge(SYS_USB_CONNECTED_ACK);
85 while(1)
87 button = button_get_w_tmo(HZ/2);
88 if(button == SYS_USB_DISCONNECTED)
89 break;
93 /* Put drivers initialized for USB connection into a known state */
94 usb_close();
96 #else /* !HAVE_BOOTLOADER_USB_MODE */
97 static void usb_mode(int connect_timeout)
99 (void) connect_timeout;
101 #endif /* HAVE_BOOTLOADER_USB_MODE */
103 void main(uint32_t arg) NORETURN_ATTR;
104 void main(uint32_t arg)
106 unsigned char* loadbuffer;
107 int buffer_size;
108 void(*kernel_entry)(void);
109 int ret;
111 system_init();
112 kernel_init();
114 power_init();
115 enable_irq();
117 lcd_init();
118 lcd_clear_display();
119 lcd_update();
121 backlight_init();
123 button_init();
125 //button_debug_screen();
126 printf("arg=%x", arg);
128 #ifdef SANSA_FUZEPLUS
129 extern void imx233_mmc_disable_window(void);
130 if(arg == 0xfee1dead)
132 printf("Disable MMC window.");
133 imx233_mmc_disable_window();
135 #endif
137 ret = storage_init();
138 if(ret < 0)
139 error(EATA, ret, true);
141 /* NOTE: allow disk_init and disk_mount_all to fail since we can do USB after.
142 * We need this order to determine the correct logical sector size */
143 while(!disk_init(IF_MV(0)))
144 printf("disk_init failed!");
146 if((ret = disk_mount_all()) <= 0)
147 error(EDISK, ret, false);
149 if(usb_plugged())
150 usb_mode(HZ);
152 printf("Loading firmware");
154 loadbuffer = (unsigned char*)DRAM_ORIG; /* DRAM */
155 buffer_size = (int)(loadbuffer + DRAM_SIZE - TTB_SIZE);
157 while((ret = load_firmware(loadbuffer, BOOTFILE, buffer_size)) < 0)
159 error(EBOOTFILE, ret, true);
162 kernel_entry = (void*) loadbuffer;
163 cpucache_invalidate();
164 printf("Executing");
165 kernel_entry();
166 printf("ERR: Failed to boot");
168 /* never returns */
169 while(1) ;