/*
 * This file is part of the coreboot project.
 *
 * Copyright 2013 Google Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; version 2 of the License.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
 */

#include <arch/cache.h>
#include <arch/lib_helpers.h>
#include <arch/secmon.h>
#include <arch/stages.h>
#include <arch/spintable.h>
#include <arch/transition.h>
#include <console/console.h>
#include <program_loading.h>
#include <rules.h>
#include <string.h>

static void run_payload(struct prog *prog)
{
	void (*doit)(void *);
	void *arg;

	doit = prog_entry(prog);
	arg = prog_entry_arg(prog);

	uint8_t current_el = get_current_el();

	printk(BIOS_SPEW, "entry    = %p\n", doit);

	secmon_run(doit, arg);

	/* Start the other CPUs spinning. */
	spintable_start();

	/* If current EL is not EL3, jump to payload at same EL. */
	if (current_el != EL3) {
		cache_sync_instructions();
		/* Point of no-return */
		doit(arg);
	}

	/* If current EL is EL3, we transition to payload in EL2. */
	struct exc_state exc_state;

	memset(&exc_state, 0, sizeof(exc_state));

	exc_state.elx.spsr = get_eret_el(EL2, SPSR_USE_L);

	cache_sync_instructions();
	transition_with_entry(doit, arg, &exc_state);
}

void arch_prog_run(struct prog *prog)
{
	void (*doit)(void *);
	void *arg;

	if (ENV_RAMSTAGE && prog->type == PROG_PAYLOAD)
		run_payload(prog);
		return;

	doit = prog_entry(prog);
	arg = prog_entry_arg(prog);

	doit(prog_entry_arg(prog));
}