board/gdsys/mpc8308/gazerbeam.c

   1 /*
   2  * (C) Copyright 2015
   3  * Dirk Eibach,  Guntermann & Drunck GmbH, eibach@gdsys.de
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <common.h>
   9 #include <command.h>
  10 #include <dm.h>
  11 #include <env.h>
  12 #include <fdt_support.h>
  13 #include <fsl_esdhc.h>
  14 #include <init.h>
  15 #include <miiphy.h>
  16 #include <misc.h>
  17 #include <sysinfo.h>
  18 #include <tpm-v1.h>
  19 #include <video_osd.h>
  20 #include <asm/global_data.h>
  21
  22 #include "../common/ihs_mdio.h"
  23 #include "../../../drivers/sysinfo/gazerbeam.h"
  24
  25 DECLARE_GLOBAL_DATA_PTR;
  26
  27 struct ihs_mdio_info ihs_mdio_info[] = {
  28         { .fpga = NULL, .name = "ihs0", .base = 0x58 },
  29         { .fpga = NULL, .name = "ihs1", .base = 0x58 },
  30 };
  31
  32 static int get_tpm(struct udevice **devp)
  33 {
  34         int rc;
  35
  36         rc = uclass_first_device_err(UCLASS_TPM, devp);
  37         if (rc) {
  38                 printf("Could not find TPM (ret=%d)\n", rc);
  39                 return CMD_RET_FAILURE;
  40         }
  41
  42         return 0;
  43 }
  44
  45 int board_early_init_r(void)
  46 {
  47         struct udevice *sysinfo;
  48         struct udevice *serdes;
  49         int mc = 0;
  50         int con = 0;
  51
  52         if (sysinfo_get(&sysinfo))
  53                 puts("Could not find sysinfo information device.\n");
  54
  55         /* Initialize serdes */
  56         uclass_get_device_by_phandle(UCLASS_MISC, sysinfo, "serdes", &serdes);
  57
  58         if (sysinfo_detect(sysinfo))
  59                 puts("Device information detection failed.\n");
  60
  61         sysinfo_get_int(sysinfo, BOARD_MULTICHANNEL, &mc);
  62         sysinfo_get_int(sysinfo, BOARD_VARIANT, &con);
  63
  64         if (mc == 2 || mc == 1)
  65                 dev_disable_by_path("/immr@e0000000/i2c@3100/pca9698@22");
  66
  67         if (mc == 4) {
  68                 dev_disable_by_path("/immr@e0000000/i2c@3100/pca9698@20");
  69                 dev_enable_by_path("/localbus@e0005000/iocon_uart@2,0");
  70                 dev_enable_by_path("/fpga1bus");
  71         }
  72
  73         if (mc == 2 || con == VAR_CON) {
  74                 dev_enable_by_path("/fpga0bus/fpga0_video1");
  75                 dev_enable_by_path("/fpga0bus/fpga0_iic_video1");
  76                 dev_enable_by_path("/fpga0bus/fpga0_axi_video1");
  77         }
  78
  79         if (con == VAR_CON) {
  80                 dev_enable_by_path("/fpga0bus/fpga0_video0");
  81                 dev_enable_by_path("/fpga0bus/fpga0_iic_video0");
  82                 dev_enable_by_path("/fpga0bus/fpga0_axi_video0");
  83         }
  84
  85         return 0;
  86 }
  87
  88 int checksysinfo(void)
  89 {
  90         struct udevice *sysinfo;
  91         char *s = env_get("serial#");
  92         int mc = 0;
  93         int con = 0;
  94
  95         if (sysinfo_get(&sysinfo))
  96                 puts("Could not find sysinfo information device.\n");
  97
  98         sysinfo_get_int(sysinfo, BOARD_MULTICHANNEL, &mc);
  99         sysinfo_get_int(sysinfo, BOARD_VARIANT, &con);
 100
 101         puts("Board: Gazerbeam ");
 102         printf("%s ", mc == 4 ? "MC4" : mc == 2 ? "MC2" : "SC");
 103         printf("%s", con == VAR_CON ? "CON" : "CPU");
 104
 105         if (s) {
 106                 puts(", serial# ");
 107                 puts(s);
 108         }
 109
 110         puts("\n");
 111
 112         return 0;
 113 }
 114
 115 static void display_osd_info(struct udevice *osd,
 116                              struct video_osd_info *osd_info)
 117 {
 118         printf("OSD-%s: Digital-OSD version %01d.%02d, %d x %d characters\n",
 119                osd->name, osd_info->major_version, osd_info->minor_version,
 120                osd_info->width, osd_info->height);
 121 }
 122
 123 int last_stage_init(void)
 124 {
 125         int fpga_hw_rev = 0;
 126         int i;
 127         struct udevice *sysinfo;
 128         struct udevice *osd;
 129         struct video_osd_info osd_info;
 130         struct udevice *tpm;
 131         int ret;
 132
 133         if (sysinfo_get(&sysinfo))
 134                 puts("Could not find sysinfo information device.\n");
 135
 136         if (sysinfo) {
 137                 int res = sysinfo_get_int(sysinfo, BOARD_HWVERSION,
 138                                           &fpga_hw_rev);
 139
 140                 if (res)
 141                         printf("Could not determind FPGA HW revision (res = %d)\n",
 142                                res);
 143         }
 144
 145         env_set_ulong("fpga_hw_rev", fpga_hw_rev);
 146
 147         ret = get_tpm(&tpm);
 148         if (ret || tpm_init(tpm) || tpm1_startup(tpm, TPM_ST_CLEAR) ||
 149             tpm1_continue_self_test(tpm)) {
 150                 printf("TPM init failed\n");
 151         }
 152
 153         if (fpga_hw_rev >= 4) {
 154                 for (i = 0; i < 4; i++) {
 155                         struct udevice *rxaui;
 156                         char name[8];
 157
 158                         snprintf(name, sizeof(name), "rxaui%d", i);
 159                         /* Disable RXAUI polarity inversion */
 160                         ret = uclass_get_device_by_phandle(UCLASS_MISC, sysinfo,
 161                                                            name, &rxaui);
 162                         if (!ret)
 163                                 misc_set_enabled(rxaui, false);
 164                 }
 165         }
 166
 167         for (uclass_first_device(UCLASS_VIDEO_OSD, &osd);
 168              osd;
 169              uclass_next_device(&osd)) {
 170                 video_osd_get_info(osd, &osd_info);
 171                 display_osd_info(osd, &osd_info);
 172         }
 173
 174         return 0;
 175 }
 176
 177 #if defined(CONFIG_OF_BOARD_SETUP)
 178 int ft_board_setup(void *blob, struct bd_info *bd)
 179 {
 180         ft_cpu_setup(blob, bd);
 181         fsl_fdt_fixup_dr_usb(blob, bd);
 182         fdt_fixup_esdhc(blob, bd);
 183
 184         return 0;
 185 }
 186 #endif