/*
 * Copyright 2016 Freescale Semiconductor, Inc.
 *
 * SPDX-License-Identifier:     GPL-2.0+
 */

#include <common.h>
#include <i2c.h>
#include <fdt_support.h>
#include <asm/io.h>
#include <asm/arch/clock.h>
#include <asm/arch/fsl_serdes.h>
#include <asm/arch/fdt.h>
#include <asm/arch/soc.h>
#include <ahci.h>
#include <hwconfig.h>
#include <mmc.h>
#include <scsi.h>
#include <fm_eth.h>
#include <fsl_csu.h>
#include <fsl_esdhc.h>
#include <fsl_ifc.h>
#include <spl.h>

#include "../common/vid.h"
#include "../common/qixis.h"
#include "ls1046aqds_qixis.h"

DECLARE_GLOBAL_DATA_PTR;

enum {
        MUX_TYPE_GPIO,
};

int checkboard(void)
{
        char buf[64];
#ifndef CONFIG_SD_BOOT
        u8 sw;
#endif

        puts("Board: LS1046AQDS, boot from ");

#ifdef CONFIG_SD_BOOT
        puts("SD\n");
#else
        sw = QIXIS_READ(brdcfg[0]);
        sw = (sw & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;

        if (sw < 0x8)
                printf("vBank: %d\n", sw);
        else if (sw == 0x8)
                puts("PromJet\n");
        else if (sw == 0x9)
                puts("NAND\n");
        else if (sw == 0xF)
                printf("QSPI\n");
        else
                printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH);
#endif

        printf("Sys ID: 0x%02x, Sys Ver: 0x%02x\n",
               QIXIS_READ(id), QIXIS_READ(arch));

        printf("FPGA:  v%d (%s), build %d\n",
               (int)QIXIS_READ(scver), qixis_read_tag(buf),
               (int)qixis_read_minor());

        return 0;
}

bool if_board_diff_clk(void)
{
        u8 diff_conf = QIXIS_READ(brdcfg[11]);

        return diff_conf & 0x40;
}

unsigned long get_board_sys_clk(void)
{
        u8 sysclk_conf = QIXIS_READ(brdcfg[1]);

        switch (sysclk_conf & 0x0f) {
        case QIXIS_SYSCLK_64:
                return 64000000;
        case QIXIS_SYSCLK_83:
                return 83333333;
        case QIXIS_SYSCLK_100:
                return 100000000;
        case QIXIS_SYSCLK_125:
                return 125000000;
        case QIXIS_SYSCLK_133:
                return 133333333;
        case QIXIS_SYSCLK_150:
                return 150000000;
        case QIXIS_SYSCLK_160:
                return 160000000;
        case QIXIS_SYSCLK_166:
                return 166666666;
        }

        return 66666666;
}

unsigned long get_board_ddr_clk(void)
{
        u8 ddrclk_conf = QIXIS_READ(brdcfg[1]);

        if (if_board_diff_clk())
                return get_board_sys_clk();
        switch ((ddrclk_conf & 0x30) >> 4) {
        case QIXIS_DDRCLK_100:
                return 100000000;
        case QIXIS_DDRCLK_125:
                return 125000000;
        case QIXIS_DDRCLK_133:
                return 133333333;
        }

        return 66666666;
}

int select_i2c_ch_pca9547(u8 ch)
{
        int ret;

        ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1);
        if (ret) {
                puts("PCA: failed to select proper channel\n");
                return ret;
        }

        return 0;
}

int dram_init(void)
{
        /*
         * When resuming from deep sleep, the I2C channel may not be
         * in the default channel. So, switch to the default channel
         * before accessing DDR SPD.
         */
        select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
        gd->ram_size = initdram(0);

        return 0;
}

int i2c_multiplexer_select_vid_channel(u8 channel)
{
        return select_i2c_ch_pca9547(channel);
}

int board_early_init_f(void)
{
#ifdef CONFIG_HAS_FSL_XHCI_USB
        struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
        u32 usb_pwrfault;
#endif

#ifdef CONFIG_SYS_I2C_EARLY_INIT
        i2c_early_init_f();
#endif
        fsl_lsch2_early_init_f();

#ifdef CONFIG_HAS_FSL_XHCI_USB
        out_be32(&scfg->rcwpmuxcr0, 0x3333);
        out_be32(&scfg->usbdrvvbus_selcr, SCFG_USBDRVVBUS_SELCR_USB1);
        usb_pwrfault = (SCFG_USBPWRFAULT_DEDICATED <<
                        SCFG_USBPWRFAULT_USB3_SHIFT) |
                        (SCFG_USBPWRFAULT_DEDICATED <<
                        SCFG_USBPWRFAULT_USB2_SHIFT) |
                        (SCFG_USBPWRFAULT_SHARED <<
                        SCFG_USBPWRFAULT_USB1_SHIFT);
        out_be32(&scfg->usbpwrfault_selcr, usb_pwrfault);
#endif

        return 0;
}

#ifdef CONFIG_FSL_DEEP_SLEEP
/* determine if it is a warm boot */
bool is_warm_boot(void)
{
#define DCFG_CCSR_CRSTSR_WDRFR  (1 << 3)
        struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR;

        if (in_be32(&gur->crstsr) & DCFG_CCSR_CRSTSR_WDRFR)
                return 1;

        return 0;
}
#endif

int config_board_mux(int ctrl_type)
{
        u8 reg14;

        reg14 = QIXIS_READ(brdcfg[14]);

        switch (ctrl_type) {
        case MUX_TYPE_GPIO:
                reg14 = (reg14 & (~0x6)) | 0x2;
                break;
        default:
                puts("Unsupported mux interface type\n");
                return -1;
        }

        QIXIS_WRITE(brdcfg[14], reg14);

        return 0;
}

int config_serdes_mux(void)
{
        return 0;
}

#ifdef CONFIG_MISC_INIT_R
int misc_init_r(void)
{
        if (hwconfig("gpio"))
                config_board_mux(MUX_TYPE_GPIO);

        return 0;
}
#endif

int board_init(void)
{
        select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);

#ifdef CONFIG_SYS_FSL_SERDES
        config_serdes_mux();
#endif

#ifdef CONFIG_LAYERSCAPE_NS_ACCESS
        enable_layerscape_ns_access();
#endif

        if (adjust_vdd(0))
                printf("Warning: Adjusting core voltage failed.\n");

        return 0;
}

#ifdef CONFIG_OF_BOARD_SETUP
int ft_board_setup(void *blob, bd_t *bd)
{
        u64 base[CONFIG_NR_DRAM_BANKS];
        u64 size[CONFIG_NR_DRAM_BANKS];
        u8 reg;

        /* fixup DT for the two DDR banks */
        base[0] = gd->bd->bi_dram[0].start;
        size[0] = gd->bd->bi_dram[0].size;
        base[1] = gd->bd->bi_dram[1].start;
        size[1] = gd->bd->bi_dram[1].size;

        fdt_fixup_memory_banks(blob, base, size, 2);
        ft_cpu_setup(blob, bd);

#ifdef CONFIG_SYS_DPAA_FMAN
        fdt_fixup_fman_ethernet(blob);
        fdt_fixup_board_enet(blob);
#endif

        reg = QIXIS_READ(brdcfg[0]);
        reg = (reg & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;

        /* Disable IFC if QSPI is enabled */
        if (reg == 0xF)
                do_fixup_by_compat(blob, "fsl,ifc",
                                   "status", "disabled", 8 + 1, 1);

        return 0;
}
#endif

u8 flash_read8(void *addr)
{
        return __raw_readb(addr + 1);
}

void flash_write16(u16 val, void *addr)
{
        u16 shftval = (((val >> 8) & 0xff) | ((val << 8) & 0xff00));

        __raw_writew(shftval, addr);
}

u16 flash_read16(void *addr)
{
        u16 val = __raw_readw(addr);

        return (((val) >> 8) & 0x00ff) | (((val) << 8) & 0xff00);
}