Mity CPU Platforms » MityDSP-L138 (ARM9 Based Platforms)

/**

 * 	\file 	main.cpp

 * 

 * 	\brief 	DSP side main routine for DSP Hello World application.

 * 			The DSP simply sets itself up, and then waits for a 

 * 			message from the ARM, to which it replies. 

 *

 *     o  0

 *     | /       Copyright (c) 2005-2010

 *    (CL)---o   Critical Link, LLC

 *      \

 *       O

 */

#include <std.h>

#include <tsk.h>

#include <stdio.h>

#include <string.h>

#include "core/cl_ipc_inbound.h"

#include "core/cl_ipc_outbound.h"

using namespace MityDSP;

// Forward declarations

void init();

void debugPrint(char *buffer);

int handleInboundMessage(void *apBuffer, uint32_t anLength, void *apUserArg) ;

// Object for sending debug messages (these are received and printed to stdout by tcDspApp)

tcCL_IPCOutbound* 	gpDebug;

// Object for sending GPPMSGQ1 messages that the ARM will receive

tcCL_IPCOutbound* 	gpOutbound;

// Object for receiving DSPMSGQ0 messages that the DSP will receive

tcCL_IPCInbound* 	gpInbound;

/**

 * 	Main routine. 

 */

int main(int argc, char* argv[])

{

	// initialize the DSPLink system

	tcCL_IPCInit::GetInstance();  

	// Launch an initialization task

   	TSK_Attrs* lpAttrs = new TSK_Attrs;

    *lpAttrs           = TSK_ATTRS;

    lpAttrs->name      = "Initialize";

    lpAttrs->stacksize = 8192*2;

    lpAttrs->priority  = 5;

   	TSK_create((Fxn)init,lpAttrs);

    return 0;

}

/**

 *	Initialize the inbound and outbound IPC objects. 

 * 

 * 	\return None.

 */

void init()

{  

	// Message to ARM core. 

	char lpReturnMessage[] = "DSP Initialization finished.";

	// Buffer for return message

	char* lpMessageBuffer = NULL;

	// Create the outbound debug link

	gpDebug = new tcCL_IPCOutbound("debug");

	// Create the inbound link for messages to the DSP

   	gpInbound = new tcCL_IPCInbound();

   	gpInbound->Open("DSPMSGQ0", 8);

	// Create the outbound controller for sending messages to the ARM

   	gpOutbound = new tcCL_IPCOutbound("GPPMSGQ1");

	if (NULL != gpInbound)

	{

		// Register a callback function to handle messages from the ARM

   		gpInbound->RegisterCallback(handleInboundMessage, (void*)NULL);

	}

	// Now that initialization is complete, let the ARM know with a message

	// Obtain a dsplink buffer for the return message

	lpMessageBuffer = (char*)gpOutbound->GetBuffer(strlen(lpReturnMessage) + 1); 

	// Make sure we received a valid buffer

	if (NULL != lpMessageBuffer)

	{

		// Copy our message to the buffer

		strcpy(lpMessageBuffer, lpReturnMessage);

		// Send the message back to the ARM

		gpOutbound->SendMessage(lpMessageBuffer, strlen(lpMessageBuffer)+1);

	}

}

/**

 * 	Callback function that handles messages from the ARM.

 * 

 * 	\param apBuffer		Pointer to message buffer.

 * 	\param anLength		Length of message.

 * 	\param apUserArg	Pointer to user defined argument

 * 

 * 	\return 0 on sucess. 

 */

int handleInboundMessage(void* apBuffer, uint32_t anLength, void* apUserArg) 

{

	int retval = 0;

	// The return message to the ARM

	char lpReturnMessage[] = "Hello Word. DSP Received Message = \'";

	// Buffer for return message

	char* lpMessageBuffer = NULL;

	// Obtain a dsplink buffer for the return message

	lpMessageBuffer = (char*)gpOutbound->GetBuffer(strlen(lpReturnMessage) + strlen((const char*)apBuffer) + 2); 

	// Make sure we received a valid buffer

	if (NULL != lpMessageBuffer)

	{

		// Copy our message to the buffer

		strcpy(lpMessageBuffer, lpReturnMessage);

		// Append the received message to the buffer

		strcpy((char*)&lpMessageBuffer[strlen(lpReturnMessage)], (const char *)apBuffer);

		// Null terminate the string

		lpMessageBuffer[strlen(lpMessageBuffer)+1] = 0;

		// Append the closing quotation

		lpMessageBuffer[strlen(lpMessageBuffer)] = '\'';

		// Send the message back to the ARM

		retval = gpOutbound->SendMessage(lpMessageBuffer, strlen(lpMessageBuffer)+1);

	}

	else

	{

		retval = -1;	

	}

	return retval;

}

/**

 * 	Function for sending debug messages to the ARM.

 * 

 * 	\param buffer	Null terminated string to be printed.

 * 

 * 	\return None. 

 */

void debugPrint(char* pMsg)

{

	// The length of the message to be sent

	int len = strlen(pMsg);

   	// Pointer to dsplink buffer where to write the message

	char* pBuffer;

	// Make sure the debug IPC outbound object has been initialized 

	if (gpDebug == NULL) 

		return;

	// Get a buffer for the message

	pBuffer = (char *)gpDebug->GetBuffer(len+1); 

	// Check that the buffer is valid

	if (pBuffer) 

	{

		// Copy the message to the buffer

		strcpy(pBuffer, pMsg);

		// Send the message

		gpDebug->SendMessage(pBuffer, len+1);

	}

}