/**
 * @file   drUtils.c
 * @brief  Utility functionalities for FastCall driver.
 *
 * Copyright (C) 2012 Giesecke & Devrient GmbH
 */

#include "drStd.h"

#include "drUtils.h"

/**
 * Exchange registers of current thread or another thread.
 *
 * @retval E_OK or relevant error code.
 */
drApiResult_t drUtilsRestartThread(
		threadno_t threadno,
		addr_t ip,
		addr_t sp)
{
	drApiResult_t ret  = E_INVALID;
	uint32_t ctrl = THREAD_EX_REGS_IP | THREAD_EX_REGS_SP;

	#pragma push /* save pragma state */
	#pragma diag_suppress 2523 /* use of inline assembler is deprecated */
	__asm {
		swi #SYSCALL_THREAD_EX_REGS,\
			{r0 = threadno, r1 = ctrl, r2 = (uint32_t)ip, r3 = (uint32_t)sp},\
			{ret = r0}
	}
	#pragma pop /* restore pragma state */

	if (ret == E_OK)
		ret = drApiResumeThread(threadno);

	return ret;
}

/**
 * Makes request to RTM to update notification thread
 *
 * @retval E_OK or relevant error code.
 */
drApiResult_t drUtilsUpdateNotificationThread(threadno_t threadno)
{
	drApiResult_t ret =  E_INVALID;
	threadid_t  notificationThread;

	/* Retrieve task id */
	taskid_t task = drApiGetTaskid();
	if (task == NILTASK)
		return ret;

	/* Retrieve thread id based on task id and DCI handler thread no */
	notificationThread = drApiTaskidGetThreadid(task, threadno);

	/* IPC data for setting notification handler */
	threadid_t ipcClient = notificationThread;
	message_t ipcMsg = MSG_SET_NOTIFICATION_HANDLER;
	uint32_t ipcData = 0;

	/* Make IPC call to IPCH and wait for a response */
	ret = drApiIpcCallToIPCH(&ipcClient, &ipcMsg, &ipcData);

	return ret;
}