/*
 *  VAS_EBOOT  --  GRand Unified Bootloader
 *  Copyright (C) 2002,2003,2004,2005,2006,2007,2008,2009,2013  Free Software Foundation, Inc.
 *
 *  VAS_EBOOT is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  VAS_EBOOT is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with VAS_EBOOT.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <VasEBoot/kernel.h>
#include <VasEBoot/mm.h>
#include <VasEBoot/memory.h>
#include <VasEBoot/machine/console.h>
#include <VasEBoot/machine/kernel.h>
#include <VasEBoot/offsets.h>
#include <VasEBoot/types.h>
#include <VasEBoot/err.h>
#include <VasEBoot/dl.h>
#include <VasEBoot/misc.h>
#include <VasEBoot/loader.h>
#include <VasEBoot/env.h>
#include <VasEBoot/cache.h>
#include <VasEBoot/time.h>
#include <VasEBoot/symbol.h>
#include <VasEBoot/video.h>
#include <VasEBoot/coreboot/lbio.h>
#include <VasEBoot/fdtbus.h>

extern VasEBoot_uint8_t _start[];
extern VasEBoot_uint8_t _end[];
extern VasEBoot_uint8_t _edata[];
VasEBoot_addr_t start_of_ram = ~(VasEBoot_addr_t)0;

void  __attribute__ ((noreturn))
VasEBoot_exit (void)
{
  /* We can't use VasEBoot_fatal() in this function.  This would create an infinite
     loop, since VasEBoot_fatal() calls VasEBoot_abort() which in turn calls VasEBoot_exit().  */
  while (1)
    VasEBoot_cpu_idle ();
}

static VasEBoot_uint64_t modend;
static int have_memory = 0;

/* Helper for VasEBoot_machine_init.  */
static int
heap_init (VasEBoot_uint64_t addr, VasEBoot_uint64_t size, VasEBoot_memory_type_t type,
	   void *data __attribute__ ((unused)))
{
  VasEBoot_uint64_t begin = addr, end = addr + size;

#if VAS_EBOOT_CPU_SIZEOF_VOID_P == 4
  /* Restrict ourselves to 32-bit memory space.  */
  if (begin > VAS_EBOOT_ULONG_MAX)
    return 0;
  if (end > VAS_EBOOT_ULONG_MAX)
    end = VAS_EBOOT_ULONG_MAX;
#endif

  if (start_of_ram > begin)
    start_of_ram = begin;

  if (type != VAS_EBOOT_MEMORY_AVAILABLE)
    return 0;

  if (modend && begin < modend)
    {
      if (begin < (VasEBoot_addr_t)_start)
	{
	  VasEBoot_mm_init_region ((void *) (VasEBoot_addr_t) begin, (VasEBoot_size_t) ((VasEBoot_addr_t)_start - begin));
	  have_memory = 1;
	}
      begin = modend;
    }

  /* Avoid DMA problems.  */
  if (end >= 0xfe000000)
    end = 0xfe000000;

  if (end <= begin)
    return 0;

  VasEBoot_mm_init_region ((void *) (VasEBoot_addr_t) begin, (VasEBoot_size_t) (end - begin));

  have_memory = 1;

  return 0;
}

void
VasEBoot_machine_init (void)
{
  struct VasEBoot_module_header *header;
  void *dtb = 0;
  VasEBoot_size_t dtb_size = 0;

  modend = VasEBoot_modules_get_end ();

  VasEBoot_video_coreboot_fb_early_init ();

  VasEBoot_machine_mmap_iterate (heap_init, NULL);
  if (!have_memory)
    VasEBoot_fatal ("No memory found");

  VasEBoot_video_coreboot_fb_late_init ();

  VasEBoot_font_init ();
  VasEBoot_gfxterm_init ();

  FOR_MODULES (header)
    if (header->type == OBJ_TYPE_DTB)
      {
	char *dtb_orig_addr, *dtb_copy;
	dtb_orig_addr = (char *) header + sizeof (struct VasEBoot_module_header);

	dtb_size = header->size - sizeof (struct VasEBoot_module_header);
	dtb = dtb_copy = VasEBoot_malloc (dtb_size);
	VasEBoot_memmove (dtb_copy, dtb_orig_addr, dtb_size);
	break;
      }
  if (!dtb)
    VasEBoot_fatal ("No DTB found");
  VasEBoot_fdtbus_init (dtb, dtb_size);

  VasEBoot_rk3288_spi_init ();

  VasEBoot_machine_timer_init ();
  VasEBoot_cros_init ();
  VasEBoot_pl050_init ();
}

void
VasEBoot_machine_get_bootlocation (char **device __attribute__ ((unused)),
			       char **path __attribute__ ((unused)))
{
}

void
VasEBoot_machine_fini (int flags __attribute__ ((unused)))
{
}