bootloader/imx233.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2011 by amaury Pouly
  11  *
  12  * Based on Rockbox iriver bootloader by Linus Nielsen Feltzing
  13  * and the ipodlinux bootloader by Daniel Palffy and Bernard Leach
  14  *
  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.
  19  *
  20  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  21  * KIND, either express or implied.
  22  *
  23  ****************************************************************************/
  24
  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"
  40
  41 #include "usb.h"
  42 #include "usb-target.h"
  43
  44 extern char loadaddress[];
  45 extern char loadaddressend[];
  46
  47 #ifdef HAVE_BOOTLOADER_USB_MODE
  48 static void usb_mode(int connect_timeout)
  49 {
  50     int button;
  51
  52     usb_init();
  53     usb_start_monitoring();
  54
  55     /* Wait for threads to connect or cable is pulled */
  56     printf("USB: Connecting");
  57
  58     long end_tick = current_tick + connect_timeout;
  59
  60     while(1)
  61     {
  62         button = button_get_w_tmo(HZ/10);
  63
  64         if(button == SYS_USB_CONNECTED)
  65             break; /* Hit */
  66
  67         if(TIME_AFTER(current_tick, end_tick))
  68         {
  69             /* Timed out waiting for the connect - will happen when connected
  70              * to a charger through the USB port */
  71             printf("USB: Timed out");
  72             break;
  73         }
  74
  75         if(!usb_plugged())
  76             break; /* Cable pulled */
  77     }
  78
  79     if(button == SYS_USB_CONNECTED)
  80     {
  81         /* Got the message - wait for disconnect */
  82         printf("Bootloader USB mode");
  83
  84         usb_acknowledge(SYS_USB_CONNECTED_ACK);
  85
  86         while(1)
  87         {
  88             button = button_get_w_tmo(HZ/2);
  89             if(button == SYS_USB_DISCONNECTED)
  90                 break;
  91         }
  92     }
  93
  94     /* Put drivers initialized for USB connection into a known state */
  95     usb_close();
  96 }
  97 #else /* !HAVE_BOOTLOADER_USB_MODE */
  98 static void usb_mode(int connect_timeout)
  99 {
 100     (void) connect_timeout;
 101 }
 102 #endif /* HAVE_BOOTLOADER_USB_MODE */
 103
 104 void main(uint32_t arg, uint32_t addr) NORETURN_ATTR;
 105 void main(uint32_t arg, uint32_t addr)
 106 {
 107     unsigned char* loadbuffer;
 108     int buffer_size;
 109     void(*kernel_entry)(void);
 110     int ret;
 111
 112     system_init();
 113     kernel_init();
 114
 115     power_init();
 116     enable_irq();
 117
 118     lcd_init();
 119     lcd_clear_display();
 120     lcd_update();
 121
 122     backlight_init();
 123
 124     button_init();
 125
 126     //button_debug_screen();
 127     printf("arg=%x addr=%x", arg, addr);
 128
 129 #ifdef SANSA_FUZEPLUS
 130     extern void imx233_mmc_disable_window(void);
 131     if(arg == 0xfee1dead)
 132     {
 133         printf("Disable MMC window.");
 134         imx233_mmc_disable_window();
 135     }
 136 #endif
 137
 138     ret = storage_init();
 139     if(ret < 0)
 140         error(EATA, ret, true);
 141
 142     /* NOTE: allow disk_init and disk_mount_all to fail since we can do USB after.
 143      * We need this order to determine the correct logical sector size */
 144     while(!disk_init(IF_MV(0)))
 145         printf("disk_init failed!");
 146
 147     if((ret = disk_mount_all()) <= 0)
 148         error(EDISK, ret, false);
 149
 150     if(usb_plugged())
 151         usb_mode(HZ);
 152
 153     printf("Loading firmware");
 154
 155     loadbuffer = (unsigned char*)loadaddress;
 156     buffer_size = (int)(loadaddressend - loadaddress);
 157
 158     while((ret = load_firmware(loadbuffer, BOOTFILE, buffer_size)) < 0)
 159     {
 160         error(EBOOTFILE, ret, true);
 161     }
 162
 163     kernel_entry = (void*) loadbuffer;
 164     printf("Executing");
 165     disable_interrupt(IRQ_FIQ_STATUS);
 166     commit_discard_idcache();
 167     kernel_entry();
 168     printf("ERR: Failed to boot");
 169
 170     /* never returns */
 171     while(1) ;
 172 }