/*
 * Copyright (c) 2013 embedded brains GmbH.  All rights reserved.
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 * http://www.rtems.org/license/LICENSE.
 */

#include <bsp.h>
#include <bsp/bootcard.h>
#include <bsp/irq-generic.h>
#include <bsp/fdt.h>
#include <bsp/linker-symbols.h>
#include <bsp/i2c.h>
#include <rtems/sysinit.h>
#include "bsp-soc-detect.h"
#include <arm/ti/ti_pinmux.h>
#include <ofw/ofw.h>
#include <bsp/i2c.h>
#include <string.h>
#include <stdlib.h>
#include <ctype.h>

#include "bspdebug.h"

void bsp_start(void)
{
  const char *type;

  bsp_soc_detect();

  switch (ti_chip()) {
    case CHIP_AM335X:
      type = "am335x-based";
      break;
    case CHIP_OMAP_3:
      type = "dm3730-based";
      break;
    default:
      type = "Unknown SOC";
      break;
  }

  bsp_interrupt_initialize();
  printk("\nRTEMS Beagleboard: %s\n", type);
  printk("        ARM Debug: 0x%08x\n", (intptr_t) bbb_arm_debug_registers());
  rtems_cache_coherent_add_area(
      bsp_section_nocacheheap_begin,
      (uintptr_t) bsp_section_nocacheheap_size
  );
}

uint32_t bsp_fdt_map_intr(const uint32_t *intr, size_t icells)
{
  return intr[0];
}

static void traverse_fdt_nodes( phandle_t node )
{

  for (node = rtems_ofw_child(node); node != 0; node = rtems_ofw_peer(node)) {
    traverse_fdt_nodes(node);

    if (!rtems_ofw_node_status(node))
      continue;

    /*
     * Put all driver initialization functions here
     */
    beagle_pinmux_init(node);
    beagle_i2c_init(node);
  }
}

static void bbb_drivers_initialize(void)
{
  phandle_t node = rtems_ofw_peer(0);

  traverse_fdt_nodes(node);
}

int beagle_get_node_unit(phandle_t node)
{
  char name[30];
  char prop[30];
  char prop_val[30];
  static int unit;
  phandle_t aliases;
  int rv;
  int i;

  rv = rtems_ofw_get_prop(node, "name", name, sizeof(name));
  if (rv <= 0)
    return unit++;

  aliases = rtems_ofw_find_device("/aliases");

  rv = rtems_ofw_next_prop(aliases, NULL, &prop[0], sizeof(prop));

  while (rv > 0) {
    rv = rtems_ofw_get_prop(aliases, prop, prop_val, sizeof(prop_val));

    if (strstr(prop_val, name) != NULL) {
      for (i = strlen(prop) - 1; i >= 0; i--) {
        if (!isdigit(prop[i]))
          break;
      }

      return strtol(&prop[i + 1], NULL, 10);
    }
    rv = rtems_ofw_next_prop(aliases, prop, prop, sizeof(prop));
  }

  return unit++;
}

RTEMS_SYSINIT_ITEM(
	bbb_drivers_initialize,
	RTEMS_SYSINIT_BSP_PRE_DRIVERS,
	RTEMS_SYSINIT_ORDER_LAST
);