// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (c) 2016 Toradex, Inc.
 */

#include <common.h>
#include <env.h>
#include <g_dnl.h>
#include <init.h>
#include <linux/libfdt.h>

#ifdef CONFIG_DM_VIDEO
#include <bmp_logo.h>
#include <dm.h>
#include <splash.h>
#include <video.h>
#endif

#include "tdx-cfg-block.h"
#include <asm/setup.h>
#include "tdx-common.h"

#define TORADEX_OUI 0x00142dUL

#ifdef CONFIG_TDX_CFG_BLOCK
static char tdx_serial_str[9];
static char tdx_board_rev_str[6];

#ifdef CONFIG_TDX_CFG_BLOCK_EXTRA
static char tdx_car_serial_str[9];
static char tdx_car_rev_str[6];
static char *tdx_carrier_board_name;
#endif

#if defined(CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG)
u32 get_board_revision(void)
{
        /* Check validity */
        if (!tdx_hw_tag.ver_major)
                return 0;

        return ((tdx_hw_tag.ver_major & 0xff) << 8) |
                ((tdx_hw_tag.ver_minor & 0xf) << 4) |
                ((tdx_hw_tag.ver_assembly & 0xf) + 0xa);
}
#endif /* CONFIG_TDX_CFG_BLOCK */

#ifdef CONFIG_SERIAL_TAG
void get_board_serial(struct tag_serialnr *serialnr)
{
        int array[8];
        unsigned int serial = tdx_serial;
        int i;

        serialnr->low = 0;
        serialnr->high = 0;

        /* Check validity */
        if (serial) {
                /*
                 * Convert to Linux serial number format (hexadecimal coded
                 * decimal)
                 */
                i = 7;
                while (serial) {
                        array[i--] = serial % 10;
                        serial /= 10;
                }
                while (i >= 0)
                        array[i--] = 0;
                serial = array[0];
                for (i = 1; i < 8; i++) {
                        serial *= 16;
                        serial += array[i];
                }

                serialnr->low = serial;
        }
}
#endif /* CONFIG_SERIAL_TAG */

int show_board_info(void)
{
        unsigned char ethaddr[6];

        if (read_tdx_cfg_block()) {
                printf("MISSING TORADEX CONFIG BLOCK\n");
                tdx_eth_addr.oui = htonl(TORADEX_OUI << 8);
                tdx_eth_addr.nic = htonl(tdx_serial << 8);
                checkboard();
        } else {
                sprintf(tdx_serial_str, "%08u", tdx_serial);
                sprintf(tdx_board_rev_str, "V%1d.%1d%c",
                        tdx_hw_tag.ver_major,
                        tdx_hw_tag.ver_minor,
                        (char)tdx_hw_tag.ver_assembly + 'A');

                env_set("serial#", tdx_serial_str);

                printf("Model: Toradex %s %s, Serial# %s\n",
                       toradex_modules[tdx_hw_tag.prodid],
                       tdx_board_rev_str,
                       tdx_serial_str);
#ifdef CONFIG_TDX_CFG_BLOCK_EXTRA
                if (read_tdx_cfg_block_carrier()) {
                        printf("MISSING TORADEX CARRIER CONFIG BLOCKS\n");
                        try_migrate_tdx_cfg_block_carrier();
                } else {
                        tdx_carrier_board_name = (char *)
                                toradex_carrier_boards[tdx_car_hw_tag.prodid];

                        sprintf(tdx_car_serial_str, "%08u", tdx_car_serial);
                        sprintf(tdx_car_rev_str, "V%1d.%1d%c",
                                tdx_car_hw_tag.ver_major,
                                tdx_car_hw_tag.ver_minor,
                                (char)tdx_car_hw_tag.ver_assembly +
                                'A');

                        env_set("carrier_serial#", tdx_car_serial_str);
                        printf("Carrier: Toradex %s %s, Serial# %s\n",
                               tdx_carrier_board_name,
                               tdx_car_rev_str,
                               tdx_car_serial_str);
                }
#endif
        }

        /*
         * Check if environment contains a valid MAC address,
         * set the one from config block if not
         */
        if (!eth_env_get_enetaddr("ethaddr", ethaddr))
                eth_env_set_enetaddr("ethaddr", (u8 *)&tdx_eth_addr);

#ifdef CONFIG_TDX_CFG_BLOCK_2ND_ETHADDR
        if (!eth_env_get_enetaddr("eth1addr", ethaddr)) {
                /*
                 * Secondary MAC address is allocated from block
                 * 0x100000 higher then the first MAC address
                 */
                memcpy(ethaddr, &tdx_eth_addr, 6);
                ethaddr[3] += 0x10;
                eth_env_set_enetaddr("eth1addr", ethaddr);
        }
#endif

        return 0;
}

#ifdef CONFIG_TDX_CFG_BLOCK_USB_GADGET_PID
int g_dnl_bind_fixup(struct usb_device_descriptor *dev, const char *name)
{
        unsigned short usb_pid;

        usb_pid = TORADEX_USB_PRODUCT_NUM_OFFSET + tdx_hw_tag.prodid;
        put_unaligned(usb_pid, &dev->idProduct);

        return 0;
}
#endif

#if defined(CONFIG_OF_LIBFDT)
int ft_common_board_setup(void *blob, struct bd_info *bd)
{
        if (tdx_serial) {
                fdt_setprop(blob, 0, "serial-number", tdx_serial_str,
                            strlen(tdx_serial_str) + 1);
        }

        if (tdx_hw_tag.ver_major) {
                char prod_id[5];

                sprintf(prod_id, "%04u", tdx_hw_tag.prodid);
                fdt_setprop(blob, 0, "toradex,product-id", prod_id, 5);

                fdt_setprop(blob, 0, "toradex,board-rev", tdx_board_rev_str,
                            strlen(tdx_board_rev_str) + 1);
        }

        return 0;
}
#endif

#else /* CONFIG_TDX_CFG_BLOCK */

#if defined(CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG)
u32 get_board_revision(void)
{
        return 0;
}
#endif /* CONFIG_REVISION_TAG */

#ifdef CONFIG_SERIAL_TAG
u32 get_board_serial(void)
{
        return 0;
}
#endif /* CONFIG_SERIAL_TAG */

int ft_common_board_setup(void *blob, struct bd_info *bd)
{
        return 0;
}

#endif /* CONFIG_TDX_CFG_BLOCK */