388 lines
10 KiB
C
388 lines
10 KiB
C
/*
|
|
* Copyright (c) 2009, Google Inc.
|
|
* All rights reserved.
|
|
*
|
|
* Copyright (c) 2009-2013, 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 Google, Inc. 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 BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
* FOR A PARTICULAR PURPOSE 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 <reg.h>
|
|
#include <debug.h>
|
|
#include <lib/ptable.h>
|
|
#include <dev/flash.h>
|
|
#include <dev/pm8921.h>
|
|
#include <dev/ssbi.h>
|
|
#include <string.h>
|
|
#include <smem.h>
|
|
#include <gsbi.h>
|
|
#include <platform/iomap.h>
|
|
#include <platform.h>
|
|
|
|
#define MDM9X15_CDP 3675
|
|
#define MDM9X15_MTP 3681
|
|
#define LINUX_MACHTYPE MDM9X15_CDP
|
|
|
|
#define RECOVERY_MODE 0x77665502
|
|
#define FOTA_COOKIE 0x64645343
|
|
#define FOTA_PARTITION 5
|
|
#define DSP3_PARTITION 5
|
|
|
|
static struct ptable flash_ptable;
|
|
unsigned hw_platform = 0;
|
|
unsigned target_msm_id = 0;
|
|
|
|
/* Partition names for fastboot flash */
|
|
static char *apps_ptn_names[] = { "aboot", "boot", "cache", "misc", "recovery", "fota",
|
|
"recoveryfs", "system", "userdata" };
|
|
|
|
/* Partitions should be in this order */
|
|
static char *ptable_ptn_names[] = { "APPSBL", "APPS", "CACHE", "MISC", "RECOVERY",
|
|
"FOTA", "RECOVERYFS", "SYSTEM", "USERDATA" };
|
|
|
|
static unsigned ptn_name_count = 9;
|
|
|
|
/* Apps partition flags to detect the presence of FOTA partitions.
|
|
* Initially, assume that the FOTA partitions are absent.
|
|
*/
|
|
static unsigned int apps_ptn_flag[] = {1, 1, 0, 0, 0, 0, 0, 1, 1};
|
|
/* Modem partition flags to detect the presence of DSP3 partitions.
|
|
* Initially, assume that the DSP3 partition is absent.
|
|
* The order of modem partiotions -
|
|
* "mibib", "sbl2", "rpm", "efs2", "dsp1", "dsp3", "dsp2"
|
|
*/
|
|
static unsigned int modem_ptn_flag[] = {1, 1, 1, 1, 1, 0, 1};
|
|
|
|
static unsigned modem_ptn_count = 7;
|
|
|
|
static const uint8_t uart_gsbi_id = GSBI_ID_4;
|
|
|
|
static pm8921_dev_t pmic;
|
|
|
|
void smem_ptable_init(void);
|
|
extern void reboot(unsigned reboot_reason);
|
|
void update_ptable_apps_partitions(void);
|
|
void update_ptable_modem_partitions(void);
|
|
void update_ptable_reorder(void);
|
|
extern int fake_key_get_state(void);
|
|
|
|
void target_init(void)
|
|
{
|
|
struct flash_info *flash_info;
|
|
|
|
dprintf(INFO, "target_init()\n");
|
|
|
|
/* Initialize PMIC driver */
|
|
pmic.read = (pm8921_read_func) & pa1_ssbi2_read_bytes;
|
|
pmic.write = (pm8921_write_func) & pa1_ssbi2_write_bytes;
|
|
|
|
pm8921_init(&pmic);
|
|
|
|
ptable_init(&flash_ptable);
|
|
smem_ptable_init();
|
|
|
|
flash_init();
|
|
flash_info = flash_get_info();
|
|
ASSERT(flash_info);
|
|
|
|
smem_add_modem_partitions(&flash_ptable);
|
|
|
|
/* Update the naming for apps partitions and type */
|
|
update_ptable_apps_partitions();
|
|
|
|
/* Update modem partitions to lower case for fastboot */
|
|
update_ptable_modem_partitions();
|
|
|
|
ptable_dump(&flash_ptable);
|
|
|
|
/* Reorder the partition table */
|
|
update_ptable_reorder();
|
|
|
|
flash_set_ptable( &flash_ptable);
|
|
}
|
|
|
|
|
|
static int read_from_flash(struct ptentry* ptn, int offset, int size, void *dest)
|
|
{
|
|
void *buffer = NULL;
|
|
unsigned page_size = flash_page_size();
|
|
unsigned page_mask = page_size - 1;
|
|
int read_size = (size + page_mask) & (~page_mask);
|
|
|
|
buffer = malloc(read_size);
|
|
if(!buffer){
|
|
dprintf(CRITICAL, "ERROR : Malloc failed for read_from_flash \n");
|
|
return -1;
|
|
}
|
|
if(flash_read(ptn, offset, buffer, read_size)){
|
|
dprintf(CRITICAL, "ERROR : Flash read failed \n");
|
|
return -1;
|
|
}
|
|
memcpy(dest, buffer, size);
|
|
free(buffer);
|
|
return 0;
|
|
}
|
|
|
|
|
|
static unsigned int get_fota_cookie(void)
|
|
{
|
|
struct ptentry *ptn;
|
|
struct ptable *ptable;
|
|
unsigned int cookie = 0;
|
|
|
|
ptable = flash_get_ptable();
|
|
if (ptable == NULL) {
|
|
dprintf(CRITICAL, "ERROR: Partition table not found\n");
|
|
return 0;
|
|
}
|
|
|
|
ptn = ptable_find(ptable, "fota");
|
|
if (ptn == NULL) {
|
|
dprintf(CRITICAL, "ERROR: No fota partition found\n");
|
|
return 0;
|
|
}
|
|
if(read_from_flash(ptn, 0, sizeof(unsigned int), &cookie) == -1){
|
|
dprintf(CRITICAL,"ERROR: failed to read fota cookie from flash");
|
|
return 0;
|
|
}
|
|
return cookie;
|
|
}
|
|
|
|
unsigned check_reboot_mode(void)
|
|
{
|
|
unsigned restart_reason = 0;
|
|
unsigned int cookie = 0;
|
|
|
|
/* Read reboot reason and scrub it */
|
|
restart_reason = readl(RESTART_REASON_ADDR);
|
|
writel(0x00, RESTART_REASON_ADDR);
|
|
|
|
/* SMEM value is not relied upon on power shutdown.
|
|
* Check either of SMEM or FOTA update cookie is set.
|
|
* Check fota cookie only when fota partition is available on target
|
|
*/
|
|
if (apps_ptn_flag[FOTA_PARTITION] == 1) {
|
|
cookie = get_fota_cookie();
|
|
if (cookie == FOTA_COOKIE)
|
|
return RECOVERY_MODE;
|
|
}
|
|
return restart_reason;
|
|
}
|
|
|
|
void board_info(void)
|
|
{
|
|
struct smem_board_info_v4 board_info_v4;
|
|
struct smem_board_info_v7 board_info_v7;
|
|
unsigned int board_info_len = 0;
|
|
unsigned smem_status;
|
|
unsigned format = 0;
|
|
unsigned id = 0;
|
|
|
|
if (hw_platform && target_msm_id)
|
|
return;
|
|
|
|
hw_platform = MDM9X15_CDP;
|
|
target_msm_id = MDM9600;
|
|
|
|
smem_status = smem_read_alloc_entry_offset(SMEM_BOARD_INFO_LOCATION,
|
|
&format, sizeof(format), 0);
|
|
if (!smem_status) {
|
|
if (format == 4) {
|
|
board_info_len = sizeof(board_info_v4);
|
|
smem_status =
|
|
smem_read_alloc_entry(SMEM_BOARD_INFO_LOCATION,
|
|
&board_info_v4,
|
|
board_info_len);
|
|
if (!smem_status) {
|
|
id = board_info_v4.board_info_v3.hw_platform;
|
|
target_msm_id =
|
|
board_info_v4.board_info_v3.msm_id;
|
|
}
|
|
} else if (format == 7) {
|
|
board_info_len = sizeof(board_info_v7);
|
|
smem_status =
|
|
smem_read_alloc_entry(SMEM_BOARD_INFO_LOCATION,
|
|
&board_info_v7,
|
|
board_info_len);
|
|
if (!smem_status) {
|
|
id = board_info_v7.board_info_v3.hw_platform;
|
|
target_msm_id =
|
|
board_info_v7.board_info_v3.msm_id;
|
|
}
|
|
} else
|
|
ASSERT(0);
|
|
}
|
|
return;
|
|
}
|
|
|
|
unsigned board_machtype(void)
|
|
{
|
|
board_info();
|
|
return hw_platform;
|
|
}
|
|
|
|
void reboot_device(unsigned reboot_reason)
|
|
{
|
|
/* Write reboot reason */
|
|
writel(reboot_reason, RESTART_REASON_ADDR);
|
|
|
|
/* Actually reset the chip */
|
|
pm8921_config_reset_pwr_off(1);
|
|
writel(0, MSM_PSHOLD_CTL_SU);
|
|
mdelay(10000);
|
|
|
|
dprintf(CRITICAL, "Rebooting failed\n");
|
|
return;
|
|
}
|
|
|
|
uint8_t target_uart_gsbi(void)
|
|
{
|
|
return uart_gsbi_id;
|
|
}
|
|
|
|
/*
|
|
* Return 1 to trigger to fastboot
|
|
*/
|
|
int fastboot_trigger(void)
|
|
{
|
|
int ret;
|
|
ret = fake_key_get_state();
|
|
/* Want to trigger when dip switch is on */
|
|
return (ret);
|
|
}
|
|
|
|
void update_ptable_modem_partitions(void)
|
|
{
|
|
uint32_t ptn_index, i = 0;
|
|
uint32_t name_size;
|
|
struct ptentry *ptentry_ptr = flash_ptable.parts;
|
|
struct ptentry *dsp3_ptn;
|
|
|
|
dsp3_ptn = ptable_find(&flash_ptable, "DSP3");
|
|
|
|
/* Check for DSP3 partition and its size */
|
|
if (dsp3_ptn != NULL)
|
|
if (dsp3_ptn->length > 0)
|
|
modem_ptn_flag[DSP3_PARTITION] = 1;
|
|
|
|
for (ptn_index = 0; ptn_index < modem_ptn_count; ptn_index++)
|
|
{
|
|
if (!modem_ptn_flag[ptn_index])
|
|
continue;
|
|
|
|
name_size = strlen(ptentry_ptr[ptn_index].name);
|
|
for (i = 0; i < name_size; i++)
|
|
{
|
|
ptentry_ptr[ptn_index].name[i] =
|
|
tolower(ptentry_ptr[ptn_index].name[i]);
|
|
}
|
|
ptentry_ptr[ptn_index].type = TYPE_APPS_PARTITION;
|
|
}
|
|
}
|
|
|
|
void update_ptable_apps_partitions(void)
|
|
{
|
|
uint32_t ptn_index, name_index = 0;
|
|
uint32_t end = 0xffffffff;
|
|
uint32_t name_size = strlen(ptable_ptn_names[name_index]);
|
|
struct ptentry *ptentry_ptr = flash_ptable.parts;
|
|
struct ptentry *fota_ptn;
|
|
unsigned int size;
|
|
|
|
fota_ptn = ptable_find(&flash_ptable, "FOTA");
|
|
|
|
/* Check for FOTA partitions and their size */
|
|
if (fota_ptn != NULL) {
|
|
if (fota_ptn->length > 0) {
|
|
/* FOTA partitions are present */
|
|
apps_ptn_flag[2] = 1;
|
|
apps_ptn_flag[3] = 1;
|
|
apps_ptn_flag[4] = 1;
|
|
apps_ptn_flag[5] = 1;
|
|
apps_ptn_flag[6] = 1;
|
|
|
|
}
|
|
}
|
|
|
|
for (ptn_index = 0; ptentry_ptr[ptn_index].start != end; ptn_index++) {
|
|
if (!(strncmp(ptentry_ptr[ptn_index].name,
|
|
ptable_ptn_names[name_index], name_size))) {
|
|
name_size = strlen(apps_ptn_names[name_index]);
|
|
name_size++; /* For null termination */
|
|
|
|
/* Update the partition names to something familiar */
|
|
if (name_size <= MAX_PTENTRY_NAME)
|
|
strncpy(ptentry_ptr[ptn_index].name,
|
|
apps_ptn_names[name_index], name_size);
|
|
|
|
/* Aboot uses modem page layout, leave aboot ptn */
|
|
if (name_index != 0)
|
|
ptentry_ptr[ptn_index].type =
|
|
TYPE_APPS_PARTITION;
|
|
|
|
/* Check for valid partitions
|
|
* according to the apps_ptn_flag
|
|
*/
|
|
do {
|
|
/* Don't go out of bounds */
|
|
name_index++;
|
|
if (name_index >= ptn_name_count)
|
|
goto ptn_name_update_done;
|
|
name_size =
|
|
strlen(ptable_ptn_names[name_index]);
|
|
} while (!apps_ptn_flag[name_index]);
|
|
}
|
|
}
|
|
|
|
ptn_name_update_done:
|
|
/* Update the end to be actual end for grow partition */
|
|
ptn_index--;
|
|
for (; ptentry_ptr[ptn_index].length != end; ptn_index++) {
|
|
};
|
|
|
|
/* If SMEM ptable is updated already then don't manually update this */
|
|
if (ptentry_ptr[ptn_index].start != end)
|
|
ptentry_ptr[ptn_index].length =
|
|
((struct flash_info *)flash_get_info())->num_blocks -
|
|
ptentry_ptr[ptn_index].start;
|
|
}
|
|
|
|
void update_ptable_reorder(void)
|
|
{
|
|
int boot_index;
|
|
struct ptentry boot_ptn;
|
|
|
|
boot_index = ptable_get_index(&flash_ptable, "boot");
|
|
if(boot_index == -1) {
|
|
dprintf (CRITICAL, "ERROR: Boot Partition not found. \n");
|
|
return;
|
|
}
|
|
boot_ptn = flash_ptable.parts[boot_index] ;
|
|
flash_ptable.parts[boot_index] = flash_ptable.parts[0];
|
|
flash_ptable.parts[0] = boot_ptn;
|
|
}
|