git.sur5r.net Git - u-boot/blob - arch/arm/mach-uniphier/board_late_init.c

   1 /*
   2  * Copyright (C) 2014      Panasonic Corporation
   3  * Copyright (C) 2015-2016 Socionext Inc.
   4  *   Author: Masahiro Yamada <yamada.masahiro@socionext.com>
   5  *
   6  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 #include <common.h>
  10 #include <spl.h>
  11 #include <linux/libfdt.h>
  12 #include <nand.h>
  13 #include <stdio.h>
  14 #include <linux/io.h>
  15 #include <linux/printk.h>
  16 #include <../drivers/mtd/nand/denali.h>
  17
  18 #include "init.h"
  19
  20 static void nand_denali_wp_disable(void)
  21 {
  22 #ifdef CONFIG_NAND_DENALI
  23         /*
  24          * Since the boot rom enables the write protection for NAND boot mode,
  25          * it must be disabled somewhere for "nand write", "nand erase", etc.
  26          * The workaround is here to not disturb the Denali NAND controller
  27          * driver just for a really SoC-specific thing.
  28          */
  29         void __iomem *denali_reg = (void __iomem *)CONFIG_SYS_NAND_REGS_BASE;
  30
  31         writel(WRITE_PROTECT__FLAG, denali_reg + WRITE_PROTECT);
  32 #endif
  33 }
  34
  35 static int uniphier_set_fdt_file(void)
  36 {
  37         DECLARE_GLOBAL_DATA_PTR;
  38         const char *compat;
  39         char dtb_name[256];
  40         int buf_len = sizeof(dtb_name);
  41
  42         if (env_get("fdt_file"))
  43                 return 0;       /* do nothing if it is already set */
  44
  45         compat = fdt_stringlist_get(gd->fdt_blob, 0, "compatible", 0, NULL);
  46         if (!compat)
  47                 return -EINVAL;
  48
  49         /* rip off the vendor prefix "socionext,"  */
  50         compat = strchr(compat, ',');
  51         if (!compat)
  52                 return -EINVAL;
  53         compat++;
  54
  55         strncpy(dtb_name, compat, buf_len);
  56         buf_len -= strlen(compat);
  57
  58         strncat(dtb_name, ".dtb", buf_len);
  59
  60         return env_set("fdt_file", dtb_name);
  61 }
  62
  63 int board_late_init(void)
  64 {
  65         puts("MODE:  ");
  66
  67         switch (uniphier_boot_device_raw()) {
  68         case BOOT_DEVICE_MMC1:
  69                 printf("eMMC Boot");
  70                 env_set("bootmode", "emmcboot");
  71                 break;
  72         case BOOT_DEVICE_NAND:
  73                 printf("NAND Boot");
  74                 env_set("bootmode", "nandboot");
  75                 nand_denali_wp_disable();
  76                 break;
  77         case BOOT_DEVICE_NOR:
  78                 printf("NOR Boot");
  79                 env_set("bootmode", "norboot");
  80                 break;
  81         case BOOT_DEVICE_USB:
  82                 printf("USB Boot");
  83                 env_set("bootmode", "usbboot");
  84                 break;
  85         default:
  86                 printf("Unknown");
  87                 break;
  88         }
  89
  90         if (uniphier_have_internal_stm())
  91                 printf(" (STM: %s)",
  92                        uniphier_boot_from_backend() ? "OFF" : "ON");
  93
  94         printf("\n");
  95
  96         if (uniphier_set_fdt_file())
  97                 pr_warn("fdt_file environment was not set correctly\n");
  98
  99         return 0;
 100 }