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 <asm/ic/sc520_defs.h> */
  31
  32 #include "config.h"
  33 #include "hardware.h"
  34 #include <asm/ic/sc520.h>
  35
  36 .text
  37 .section .start16, "ax"
  38 .code16
  39 .globl board_init16
  40 board_init16:
  41         /* Alias MMCR to 0xdf000 */
  42         movw    $0xfffc, %dx
  43         movl    $0x800df0cb, %eax
  44         outl    %eax, %dx
  45
  46         /* Set ds to point to MMCR alias */
  47         movw    $0xdf00, %ax
  48         movw    %ax, %ds
  49
  50         /* Map PAR for Boot Flash (BOOTCS, 512kB @ 0x380000000) */
  51         movl    $(SC520_PAR14 - SC520_MMCR_BASE), %edi
  52         movl    $CONFIG_SYS_SC520_BOOTCS_PAR, %eax
  53         movl    %eax, (%di)
  54
  55         /* Map PAR for LED, Hex Switches (GPCS6, 20 Bytes @ 0x1000) */
  56         movl    $(SC520_PAR15 - SC520_MMCR_BASE), %edi
  57         movl    $CONFIG_SYS_SC520_LLIO_PAR, %eax
  58         movl    %eax, (%di)
  59
  60         /* Disabe MMCR alias */
  61         movw    $0xfffc, %dx
  62         movl    $0x000000cb, %eax
  63         outl    %eax, %dx
  64
  65         jmp     board_init16_ret
  66
  67 .section .bios, "ax"
  68 .code16
  69 .globl realmode_reset
  70 .hidden realmode_reset
  71 .type realmode_reset, @function
  72 realmode_reset:
  73         /* Alias MMCR to 0xdf000 */
  74         movw    $0xfffc, %dx
  75         movl    $0x800df0cb, %eax
  76         outl    %eax, %dx
  77
  78         /* Set ds to point to MMCR alias */
  79         movw    $0xdf00, %ax
  80         movw    %ax, %ds
  81
  82         /* issue software reset thorugh MMCR */
  83         movl    $0xd72, %edi
  84         movb    $0x01, %al
  85         movb    %al, (%di)
  86
  87 1:      hlt
  88         jmp     1