506 lines
11 KiB
C
506 lines
11 KiB
C
/* Copyright (c) 2013-2015, The Linux Foundation. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are
|
|
* met:
|
|
* * Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* * Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and/or other materials provided
|
|
* with the distribution.
|
|
* * Neither the name of The Linux Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
|
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
|
|
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
|
|
* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <debug.h>
|
|
#include <platform/iomap.h>
|
|
#include <platform/irqs.h>
|
|
#include <platform/gpio.h>
|
|
#include <reg.h>
|
|
#include <target.h>
|
|
#include <platform.h>
|
|
#include <dload_util.h>
|
|
#include <uart_dm.h>
|
|
#include <mmc.h>
|
|
#include <spmi.h>
|
|
#include <board.h>
|
|
#include <smem.h>
|
|
#include <baseband.h>
|
|
#include <dev/keys.h>
|
|
#include <crypto5_wrapper.h>
|
|
#include <hsusb.h>
|
|
#include <clock.h>
|
|
#include <partition_parser.h>
|
|
#include <scm.h>
|
|
#include <platform/clock.h>
|
|
#include <platform/gpio.h>
|
|
#include <stdlib.h>
|
|
|
|
extern bool target_use_signed_kernel(void);
|
|
static void set_sdc_power_ctrl();
|
|
|
|
static unsigned int target_id;
|
|
|
|
#if MMC_SDHCI_SUPPORT
|
|
struct mmc_device *dev;
|
|
#endif
|
|
|
|
#define PMIC_ARB_CHANNEL_NUM 0
|
|
#define PMIC_ARB_OWNER_ID 0
|
|
|
|
#define WDOG_DEBUG_DISABLE_BIT 17
|
|
|
|
#define CE_INSTANCE 2
|
|
#define CE_EE 1
|
|
#define CE_FIFO_SIZE 64
|
|
#define CE_READ_PIPE 3
|
|
#define CE_WRITE_PIPE 2
|
|
#define CE_READ_PIPE_LOCK_GRP 0
|
|
#define CE_WRITE_PIPE_LOCK_GRP 0
|
|
#define CE_ARRAY_SIZE 20
|
|
|
|
#ifdef SSD_ENABLE
|
|
#define SSD_CE_INSTANCE_1 1
|
|
#define SSD_PARTITION_SIZE 8192
|
|
#endif
|
|
|
|
#define FASTBOOT_MODE 0x77665500
|
|
|
|
#define BOARD_SOC_VERSION1(soc_rev) (soc_rev >= 0x10000 && soc_rev < 0x20000)
|
|
|
|
#if MMC_SDHCI_SUPPORT
|
|
static uint32_t mmc_sdhci_base[] =
|
|
{ MSM_SDC1_SDHCI_BASE, MSM_SDC2_SDHCI_BASE };
|
|
#endif
|
|
|
|
static uint32_t mmc_sdc_base[] =
|
|
{ MSM_SDC1_BASE, MSM_SDC2_BASE };
|
|
|
|
static uint32_t mmc_sdc_pwrctl_irq[] =
|
|
{ SDCC1_PWRCTL_IRQ, SDCC2_PWRCTL_IRQ };
|
|
|
|
void target_early_init(void)
|
|
{
|
|
#if WITH_DEBUG_UART
|
|
uart_dm_init(9, 0, BLSP2_UART3_BASE);
|
|
#endif
|
|
}
|
|
|
|
/* Return 1 if vol_up pressed */
|
|
static int target_volume_up()
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/* Return 1 if vol_down pressed */
|
|
uint32_t target_volume_down()
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static void target_keystatus()
|
|
{
|
|
keys_init();
|
|
|
|
if (target_volume_down())
|
|
keys_post_event(KEY_VOLUMEDOWN, 1);
|
|
|
|
if (target_volume_up())
|
|
keys_post_event(KEY_VOLUMEUP, 1);
|
|
}
|
|
|
|
/* Set up params for h/w CE. */
|
|
void target_crypto_init_params()
|
|
{
|
|
struct crypto_init_params ce_params;
|
|
|
|
/* Set up base addresses and instance. */
|
|
ce_params.crypto_instance = CE_INSTANCE;
|
|
ce_params.crypto_base = MSM_CE2_BASE;
|
|
ce_params.bam_base = MSM_CE2_BAM_BASE;
|
|
|
|
/* Set up BAM config. */
|
|
ce_params.bam_ee = CE_EE;
|
|
ce_params.pipes.read_pipe = CE_READ_PIPE;
|
|
ce_params.pipes.write_pipe = CE_WRITE_PIPE;
|
|
ce_params.pipes.read_pipe_grp = CE_READ_PIPE_LOCK_GRP;
|
|
ce_params.pipes.write_pipe_grp = CE_WRITE_PIPE_LOCK_GRP;
|
|
|
|
/* Assign buffer sizes. */
|
|
ce_params.num_ce = CE_ARRAY_SIZE;
|
|
ce_params.read_fifo_size = CE_FIFO_SIZE;
|
|
ce_params.write_fifo_size = CE_FIFO_SIZE;
|
|
|
|
/* BAM is initialized by TZ for this platform.
|
|
* Do not do it again as the initialization address space
|
|
* is locked.
|
|
*/
|
|
ce_params.do_bam_init = 0;
|
|
|
|
crypto_init_params(&ce_params);
|
|
}
|
|
|
|
crypto_engine_type board_ce_type(void)
|
|
{
|
|
return CRYPTO_ENGINE_TYPE_HW;
|
|
}
|
|
|
|
#if MMC_SDHCI_SUPPORT
|
|
static void target_mmc_sdhci_init()
|
|
{
|
|
static uint32_t mmc_clks[] = {
|
|
MMC_CLK_96MHZ, MMC_CLK_50MHZ };
|
|
|
|
struct mmc_config_data config = {0};
|
|
int i;
|
|
|
|
config.bus_width = DATA_BUS_WIDTH_8BIT;
|
|
|
|
/* Trying Slot 1*/
|
|
config.slot = 1;
|
|
config.sdhc_base = mmc_sdhci_base[config.slot - 1];
|
|
config.pwrctl_base = mmc_sdc_base[config.slot - 1];
|
|
config.pwr_irq = mmc_sdc_pwrctl_irq[config.slot - 1];
|
|
config.hs400_support = 0;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(mmc_clks); ++i) {
|
|
config.max_clk_rate = mmc_clks[i];
|
|
dprintf(INFO, "SDHC Running at %u MHz\n",
|
|
config.max_clk_rate / 1000000);
|
|
dev = mmc_init(&config);
|
|
if (dev && partition_read_table() == 0)
|
|
return;
|
|
}
|
|
|
|
if (dev == NULL)
|
|
dprintf(CRITICAL, "mmc init failed!");
|
|
else
|
|
dprintf(CRITICAL, "Error reading the partition table info\n");
|
|
ASSERT(0);
|
|
}
|
|
|
|
void *target_mmc_device()
|
|
{
|
|
return (void *) dev;
|
|
}
|
|
|
|
#else
|
|
|
|
static void target_mmc_mci_init()
|
|
{
|
|
uint32_t base_addr;
|
|
uint8_t slot;
|
|
|
|
/* Trying Slot 1 */
|
|
slot = 1;
|
|
base_addr = mmc_sdc_base[slot - 1];
|
|
|
|
if (mmc_boot_main(slot, base_addr))
|
|
{
|
|
/* Trying Slot 2 next */
|
|
slot = 2;
|
|
base_addr = mmc_sdc_base[slot - 1];
|
|
if (mmc_boot_main(slot, base_addr)) {
|
|
dprintf(CRITICAL, "mmc init failed!");
|
|
ASSERT(0);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Function to set the capabilities for the host
|
|
*/
|
|
void target_mmc_caps(struct mmc_host *host)
|
|
{
|
|
host->caps.bus_width = MMC_BOOT_BUS_WIDTH_8_BIT;
|
|
host->caps.ddr_mode = 1;
|
|
host->caps.hs200_mode = 1;
|
|
host->caps.hs_clk_rate = MMC_CLK_96MHZ;
|
|
}
|
|
|
|
#endif
|
|
|
|
void target_init(void)
|
|
{
|
|
dprintf(INFO, "target_init()\n");
|
|
|
|
target_keystatus();
|
|
|
|
if (target_use_signed_kernel())
|
|
target_crypto_init_params();
|
|
|
|
/*
|
|
* Set drive strength & pull ctrl for
|
|
* emmc
|
|
*/
|
|
set_sdc_power_ctrl();
|
|
|
|
#if MMC_SDHCI_SUPPORT
|
|
target_mmc_sdhci_init();
|
|
#else
|
|
target_mmc_mci_init();
|
|
#endif
|
|
}
|
|
|
|
unsigned board_machtype(void)
|
|
{
|
|
return target_id;
|
|
}
|
|
|
|
/* Do any target specific intialization needed before entering fastboot mode */
|
|
#ifdef SSD_ENABLE
|
|
static void ssd_load_keystore_from_emmc()
|
|
{
|
|
uint64_t ptn = 0;
|
|
int index = -1;
|
|
uint32_t size = SSD_PARTITION_SIZE;
|
|
int ret = -1;
|
|
|
|
uint32_t *buffer = (uint32_t *)memalign(CACHE_LINE,
|
|
ROUNDUP(SSD_PARTITION_SIZE, CACHE_LINE));
|
|
|
|
if (!buffer) {
|
|
dprintf(CRITICAL, "Error Allocating memory for SSD buffer\n");
|
|
ASSERT(0);
|
|
}
|
|
|
|
index = partition_get_index("ssd");
|
|
|
|
ptn = partition_get_offset(index);
|
|
if(ptn == 0){
|
|
dprintf(CRITICAL,"ERROR: ssd parition not found");
|
|
return;
|
|
}
|
|
|
|
if(mmc_read(ptn, buffer, size)){
|
|
dprintf(CRITICAL,"ERROR:Cannot read data\n");
|
|
return;
|
|
}
|
|
|
|
ret = scm_protect_keystore((uint32_t *)&buffer[0],size);
|
|
if(ret != 0)
|
|
dprintf(CRITICAL,"ERROR: scm_protect_keystore Failed");
|
|
|
|
free(buffer);
|
|
}
|
|
#endif
|
|
|
|
void target_fastboot_init(void)
|
|
{
|
|
#ifdef SSD_ENABLE
|
|
clock_ce_enable(SSD_CE_INSTANCE_1);
|
|
ssd_load_keystore_from_emmc();
|
|
#endif
|
|
}
|
|
|
|
/* Detect the target type */
|
|
void target_detect(struct board_data *board)
|
|
{
|
|
/* This property is filled as part of board.c */
|
|
}
|
|
|
|
/* Detect the modem type */
|
|
void target_baseband_detect(struct board_data *board)
|
|
{
|
|
uint32_t platform;
|
|
uint32_t platform_subtype;
|
|
|
|
platform = board->platform;
|
|
platform_subtype = board->platform_subtype;
|
|
|
|
/*
|
|
* Look for platform subtype if present, else
|
|
* check for platform type to decide on the
|
|
* baseband type
|
|
*/
|
|
switch (platform_subtype) {
|
|
case HW_PLATFORM_SUBTYPE_UNKNOWN:
|
|
break;
|
|
default:
|
|
dprintf(CRITICAL, "Platform Subtype : %u is not supported\n",platform_subtype);
|
|
ASSERT(0);
|
|
};
|
|
|
|
switch (platform) {
|
|
case FSM9900:
|
|
case FSM9905:
|
|
case FSM9910:
|
|
case FSM9915:
|
|
case FSM9950:
|
|
case FSM9955:
|
|
case FSM9916:
|
|
board->baseband = BASEBAND_MSM;
|
|
break;
|
|
default:
|
|
dprintf(CRITICAL, "Platform type: %u is not supported\n",platform);
|
|
ASSERT(0);
|
|
};
|
|
}
|
|
|
|
unsigned target_baseband()
|
|
{
|
|
return board_baseband();
|
|
}
|
|
|
|
void target_serialno(unsigned char *buf)
|
|
{
|
|
unsigned int serialno;
|
|
if (target_is_emmc_boot()) {
|
|
serialno = mmc_get_psn();
|
|
snprintf((char *)buf, 13, "%x", serialno);
|
|
}
|
|
}
|
|
|
|
unsigned check_reboot_mode(void)
|
|
{
|
|
uint32_t restart_reason = 0;
|
|
uint32_t restart_reason_addr;
|
|
|
|
restart_reason_addr = RESTART_REASON_ADDR_V2;
|
|
|
|
/* Read reboot reason and scrub it */
|
|
restart_reason = readl(restart_reason_addr);
|
|
writel(0x00, restart_reason_addr);
|
|
|
|
return restart_reason;
|
|
}
|
|
|
|
void reboot_device(unsigned reboot_reason)
|
|
{
|
|
/* Write the reboot reason */
|
|
writel(reboot_reason, RESTART_REASON_ADDR_V2);
|
|
|
|
/* Disable Watchdog Debug.
|
|
* Required becuase of a H/W bug which causes the system to
|
|
* reset partially even for non watchdog resets.
|
|
*/
|
|
writel(readl(GCC_WDOG_DEBUG) & ~(1 << WDOG_DEBUG_DISABLE_BIT), GCC_WDOG_DEBUG);
|
|
|
|
dsb();
|
|
|
|
/* Wait until the write takes effect. */
|
|
while(readl(GCC_WDOG_DEBUG) & (1 << WDOG_DEBUG_DISABLE_BIT));
|
|
|
|
/* Drop PS_HOLD for MSM */
|
|
writel(0x00, MPM2_MPM_PS_HOLD);
|
|
|
|
mdelay(5000);
|
|
|
|
dprintf(CRITICAL, "Rebooting failed\n");
|
|
}
|
|
|
|
int set_download_mode(enum dload_mode mode)
|
|
{
|
|
dload_util_write_cookie(mode == NORMAL_DLOAD ?
|
|
DLOAD_MODE_ADDR_V2 : EMERGENCY_DLOAD_MODE_ADDR_V2, mode);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Check if MSM needs VBUS mimic for USB */
|
|
static int target_needs_vbus_mimic()
|
|
{
|
|
return 1;
|
|
}
|
|
|
|
/* Do target specific usb initialization */
|
|
void target_usb_init(void)
|
|
{
|
|
uint32_t val;
|
|
|
|
if (target_needs_vbus_mimic()) {
|
|
/* Select and enable external configuration with USB PHY */
|
|
ulpi_write(ULPI_MISC_A_VBUSVLDEXTSEL | ULPI_MISC_A_VBUSVLDEXT, ULPI_MISC_A_SET);
|
|
|
|
/* Enable sess_vld */
|
|
val = readl(USB_GENCONFIG_2) | GEN2_SESS_VLD_CTRL_EN;
|
|
writel(val, USB_GENCONFIG_2);
|
|
|
|
/* Enable external vbus configuration in the LINK */
|
|
val = readl(USB_USBCMD);
|
|
val |= SESS_VLD_CTRL;
|
|
writel(val, USB_USBCMD);
|
|
}
|
|
}
|
|
|
|
/* Returns 1 if target supports continuous splash screen. */
|
|
int target_cont_splash_screen()
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
unsigned target_pause_for_battery_charge(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
void target_uninit(void)
|
|
{
|
|
#if MMC_SDHCI_SUPPORT
|
|
mmc_put_card_to_sleep(dev);
|
|
#else
|
|
mmc_put_card_to_sleep();
|
|
#endif
|
|
#ifdef SSD_ENABLE
|
|
clock_ce_disable(SSD_CE_INSTANCE_1);
|
|
#endif
|
|
}
|
|
|
|
void shutdown_device()
|
|
{
|
|
dprintf(CRITICAL, "Going down for shutdown.\n");
|
|
|
|
/* Drop PS_HOLD for MSM */
|
|
writel(0x00, MPM2_MPM_PS_HOLD);
|
|
|
|
mdelay(5000);
|
|
|
|
dprintf(CRITICAL, "Shutdown failed\n");
|
|
}
|
|
|
|
static void set_sdc_power_ctrl()
|
|
{
|
|
/* Drive strength configs for sdc pins */
|
|
struct tlmm_cfgs sdc1_hdrv_cfg[] =
|
|
{
|
|
{ SDC1_CLK_HDRV_CTL_OFF, TLMM_CUR_VAL_10MA, TLMM_HDRV_MASK },
|
|
{ SDC1_CMD_HDRV_CTL_OFF, TLMM_CUR_VAL_10MA, TLMM_HDRV_MASK },
|
|
{ SDC1_DATA_HDRV_CTL_OFF, TLMM_CUR_VAL_10MA, TLMM_HDRV_MASK },
|
|
};
|
|
|
|
/* Pull configs for sdc pins */
|
|
struct tlmm_cfgs sdc1_pull_cfg[] =
|
|
{
|
|
{ SDC1_CLK_PULL_CTL_OFF, TLMM_NO_PULL, TLMM_PULL_MASK },
|
|
{ SDC1_CMD_PULL_CTL_OFF, TLMM_PULL_UP, TLMM_PULL_MASK },
|
|
{ SDC1_DATA_PULL_CTL_OFF, TLMM_PULL_UP, TLMM_PULL_MASK },
|
|
};
|
|
|
|
/* Set the drive strength & pull control values */
|
|
tlmm_set_hdrive_ctrl(sdc1_hdrv_cfg, ARRAY_SIZE(sdc1_hdrv_cfg));
|
|
tlmm_set_pull_ctrl(sdc1_pull_cfg, ARRAY_SIZE(sdc1_pull_cfg));
|
|
}
|
|
|
|
int emmc_recovery_init(void)
|
|
{
|
|
return _emmc_recovery_init();
|
|
}
|
|
|
|
void target_usb_stop(void)
|
|
{
|
|
}
|