board/eNET/eNET_start16.S

   1 /*
   2  * (C) Copyright 2008
   3  * Graeme Russ, graeme.russ@gmail.com.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 /*
  25  * 16bit initialization code.
  26  * This code have to map the area of the boot flash
  27  * that is used by U-boot to its final destination.
  28  */
  29
  30 #include "config.h"
  31 #include "hardware.h"
  32 #include <asm/arch/sc520.h>
  33
  34 .text
  35 .section .start16, "ax"
  36 .code16
  37 .globl board_init16
  38 board_init16:
  39         /* Alias MMCR to 0xdf000 */
  40         movw    $0xfffc, %dx
  41         movl    $0x800df0cb, %eax
  42         outl    %eax, %dx
  43
  44         /* Set ds to point to MMCR alias */
  45         movw    $0xdf00, %ax
  46         movw    %ax, %ds
  47
  48         /* Map PAR for Boot Flash (BOOTCS, 512kB @ 0x380000000) */
  49         movl    $(SC520_PAR14 - SC520_MMCR_BASE), %edi
  50         movl    $CONFIG_SYS_SC520_BOOTCS_PAR, %eax
  51         movl    %eax, (%di)
  52
  53         /* Map PAR for LED, Hex Switches (GPCS6, 20 Bytes @ 0x1000) */
  54         movl    $(SC520_PAR15 - SC520_MMCR_BASE), %edi
  55         movl    $CONFIG_SYS_SC520_LLIO_PAR, %eax
  56         movl    %eax, (%di)
  57
  58         /* Disabe MMCR alias */
  59         movw    $0xfffc, %dx
  60         movl    $0x000000cb, %eax
  61         outl    %eax, %dx
  62
  63         jmp     board_init16_ret
  64
  65 .section .bios, "ax"
  66 .code16
  67 .globl realmode_reset
  68 .hidden realmode_reset
  69 .type realmode_reset, @function
  70 realmode_reset:
  71         /* Alias MMCR to 0xdf000 */
  72         movw    $0xfffc, %dx
  73         movl    $0x800df0cb, %eax
  74         outl    %eax, %dx
  75
  76         /* Set ds to point to MMCR alias */
  77         movw    $0xdf00, %ax
  78         movw    %ax, %ds
  79
  80         /* issue software reset thorugh MMCR */
  81         movl    $0xd72, %edi
  82         movb    $0x01, %al
  83         movb    %al, (%di)
  84
  85 1:      hlt
  86         jmp     1