DM8127 Image-tuning tool server thread 源码
Image-tuning tool server thread. This thread listens on the TCP port for ITT connection and also coordinates the client side CMD/DATA send & receive.
/** ==================================================================
* @file itt_Capture.h
*
* @path ipnc_mcfw/demos/mcfw_api_demos/itt/
*
* @desc This File contains.
* ===================================================================
* Copyright (c) Texas Instruments Inc 2011, 2012
*
* Use of this software is controlled by the terms and conditions found
* in the license agreement under which this software has been supplied
* ===================================================================*/
/*
* Notify from A8 to VPSS M3
*/
#ifndef _ITT_CAPTURE_H_
#define _ITT_CAPTURE_H_
#ifdef __cplusplus
extern "C" {
#endif /* __cplusplus */
#include <osa_thr.h>
#define ITT_ERROR(...) \
fprintf(stderr, " ERROR (%s|%s|%d): ", __FILE__, __func__, __LINE__); \
fprintf(stderr, __VA_ARGS__);
#define ITT_STATUS_OK 0 // /< Status : OK
#define ITT_STATUS_EFAIL -1 // /< Status :
// Generic error
/* SWOSD Timer Thread priority and stack size */
#define ITT_TSK_PRI (7)
#define ITT_TSK_STACK_SIZE (32)
typedef Void *(*ThrEntryFunc) (Void *);
typedef pthread_t ThrId;
typedef struct _TaskCtx {
ThrId handle;
Int8 exitFlag;
} TaskCtx;
typedef struct {
pthread_t *hndl;
pthread_attr_t *thread_attr;
// OSAL_TaskEntryFunc entryFunc;
unsigned int pri;
unsigned int stackSize;
} OSAL_TaskHandle;
Int32 Itt_thrCreate(TaskCtx * ctx, ThrEntryFunc entryFunc, Uint32 pri,
Uint32 stackSize);
Int32 Itt_thrDelete(TaskCtx * ctx);
Int32 Itt_TaskCreate();
int Itt_TaskDelete();
#ifdef __cplusplus
}
#endif /* __cplusplus */
#endif /* _DM81XX_A8_NOTIFY_H_
*/
/** ==================================================================
* @file itt_Capture.c
*
* @path ipnc_mcfw/demos/mcfw_api_demos/itt/
*
* @desc This File contains.
* ===================================================================
* Copyright (c) Texas Instruments Inc 2011, 2012
*
* Use of this software is controlled by the terms and conditions found
* in the license agreement under which this software has been supplied
* ===================================================================*/
/*
* Notify from A8 to VIDEO M3 functions
*/
#include <string.h>
#include <mcfw/interfaces/ti_media_std.h>
#include <itt_Capture.h>
#include <ti/syslink/Std.h>
#include <ti/ipc/MultiProc.h>
#include <ti/syslink/IpcHost.h>
#include <ti/syslink/ProcMgr.h>
#include <ti/ipc/MessageQ.h>
#include <ti/ipc/SharedRegion.h>
#include <ti/syslink/SysLink.h>
#include <unistd.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <netdb.h>
static TaskCtx ittThrHandle;
#define ITT_ASSERT( COND ) // COND
#define ITT_PRINTF( MSG ) OSA_printf(MSG)
#define ITT_SERVER_MSGQ_NAME "ITT_SERVERQ"
#define DCC_SERVER_MSGQ_NAME "DCC_SERVERQ"
/**
* Handle to the ITT Server Message Queue
*/
MessageQ_Handle hIttMsgQ = NULL;
typedef struct ittServer_Msg {
MessageQ_MsgHeader header;
Int32 response;
Int32 arg1;
Int32 arg2;
} ittServer_Msg;
#define CMD_CKH_CONNECTION (1)
#define CMD_SEND_DCC (2)
#define CMD_MEM_READ_WORD (3)
#define CMD_SAVE_RAW (4)
#define CMD_REGS_READ (5)
#define CMD_MEM_WRITE_WORD (6)
#define CMD_RECV_DCC (7)
#define CMD_CAMERA_CNTL (8)
#define CMD_SAVE_YUV (9)
#define CMD_MEM_READ_BUFF (10)
#define CMD_SENSOR_REGS_READ (11)
#define CMD_SENSOR_REG_WRITE (12)
#define ITT_SHAREDREGION_ID (0)
/**
*******************************************************************************
* @func RfileServer_cleanup
* @brief This function uninitializes the Remote File Server
*
* @retval Rfile_SUCCESS Remote File Server uninitialization successful
* @retval Rfile_FAIL Error in uninitializing Remote File Server
*
* @remarks After calling RfileServer_cleanup, no further Remote File
* operations should be attempted.
*
*******************************************************************************
*/
/* ===================================================================
* @func ittServerMsgQ_cleanup
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
Int32 ittServerMsgQ_cleanup()
{
MessageQ_delete(&hIttMsgQ);
return (1);
}
#define ITT_SERVER_DEFAULT_PORT (5000)
static int serverPort;
static int serverSocketId;
/* ===================================================================
* @func ittServer_CreateSocket
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
int ittServer_CreateSocket(unsigned int port)
{
struct sockaddr_in server;
int status;
serverPort = port;
serverSocketId = socket(AF_INET, SOCK_STREAM, 0);
ITT_ASSERT(serverSocketId < 0) server.sin_family = AF_INET;
server.sin_addr.s_addr = INADDR_ANY;
server.sin_port = htons(port);
memset((void *) &(server.sin_zero), 0, 8);
status = bind(serverSocketId, (struct sockaddr *) &server, sizeof(server));
ITT_ASSERT(status == -1);
status = listen(serverSocketId, 5);
ITT_ASSERT(status < 0);
return (0);
}
/* ===================================================================
* @func ittServer_SendData
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
int ittServer_SendData(int SocketId, unsigned char *dataBuf,
unsigned int dataSize)
{
int actDataSize = 0;
while (dataSize > 0)
{
actDataSize = send(SocketId, dataBuf, dataSize, 0);
OSA_printf(" ITT_Server: Send Data %d (%d)\n", actDataSize, dataSize);
if (actDataSize <= 0)
break;
dataBuf += actDataSize;
dataSize -= actDataSize;
}
if (dataSize > 0)
{
ITT_ERROR(" ITT_Server: Failed to send the data\n");
return (-1);
}
return (0);
}
/* ===================================================================
* @func ittServer_RecvData
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
int ittServer_RecvData(int SocketId, unsigned char *dataBuf,
unsigned int dataSize)
{
int actDataSize = 0;
while (dataSize > 0)
{
actDataSize = recv(SocketId, dataBuf, dataSize, 0);
OSA_printf(" ITT_Server: Recived Data %d (%d)\n", actDataSize, dataSize);
if (actDataSize <= 0)
break;
dataBuf += actDataSize;
dataSize -= actDataSize;
}
if (dataSize > 0)
{
ITT_ERROR(" ITT_Server: Failed to recicve the data\n");
return (-1);
}
return (0);
}
/* ===================================================================
* @func ittServer_run
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
MessageQ_QueueId remoteQ;
Int32 ittServer_run()
{
Int32 status = 0;
Bits16 cmd = 1;
ittServer_Msg *ittMsg = NULL;
remoteQ = 0;
MessageQ_Msg msg = NULL;
Ptr srHeap = NULL;
MessageQ_Params msgQParams;
//int cmdCounter = 1;
unsigned int sin_size;
struct sockaddr_in client;
int connectedSocketId;
int dataSize;
// unsigned char dataBuf[100*1024];
Int32 recvData[5];
Int32 payLoadSize;
Bits32 srPtr = 0;
Ptr buf = NULL;
OSA_printf("\n ITT ittServer_run\n");
/*--------------------------------------------------------------------------
* Get the heap associated with the Shared Region for Message Queue. This
* heap is used to create Message Queues, allocate Messages subsequently.
*------------------------------------------------------------------------*/
srHeap = SharedRegion_getHeap(ITT_SHAREDREGION_ID);
ITT_ASSERT(srHeap != NULL);
/*--------------------------------------------------------------------------
* Create a message queue for Remote File Server. The client modules send
* their requests to this message queue
*------------------------------------------------------------------------*/
MessageQ_Params_init(&msgQParams);
hIttMsgQ = MessageQ_create(ITT_SERVER_MSGQ_NAME, &msgQParams);
ITT_ASSERT(hIttMsgQ != NULL);
if(hIttMsgQ == NULL)
{
goto EXIT;
}
msg = MessageQ_alloc(ITT_SHAREDREGION_ID, sizeof(ittServer_Msg));
if (msg == NULL)
{
OSA_printf("ERROR: Can't allocate message for [%s]\n",
ITT_SERVER_MSGQ_NAME);
MessageQ_delete(&hIttMsgQ);
return (0);
}
ittMsg = (ittServer_Msg *) msg;
OSA_printf("ITT Server Message initialization successful\n");
do
{
status = MessageQ_open(DCC_SERVER_MSGQ_NAME, &remoteQ);
} while (status == MessageQ_E_NOTFOUND);
OSA_printf("DCC server Message ques is open succefully\n");
// while (1)
{
ittMsg->arg1 = 1024 * 1024;
/*--------------------------------------------------------------------------
* Specify the command to be used
*------------------------------------------------------------------------*/
OSA_printf("Setting cmd <%d> in message <%x>\n", cmd, (UInt32)msg);
MessageQ_setMsgId(msg, cmd);
/*--------------------------------------------------------------------------
* Specify the MessageQ owned by this Task as the reply queue. The Remote
* File Server will reply to the queue embedded in this message
*------------------------------------------------------------------------*/
MessageQ_setReplyQueue(hIttMsgQ, msg);
/*--------------------------------------------------------------------------
* Send the command to the Remote File Server
*------------------------------------------------------------------------*/
OSA_printf("Posting message <%x> in QId <%x> \n", (UInt32)msg, (UInt32)remoteQ);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
/*--------------------------------------------------------------------------
* Wait for a response from the Remote File Server
*------------------------------------------------------------------------*/
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
srPtr = (Bits32) ittMsg->arg1;
/*--------------------------------------------------------------------------
* Check if shared region pointer is valid
*------------------------------------------------------------------------*/
if (srPtr == 0)
{
OSA_printf("Invalid sr Pointer \n");
goto EXIT;
}
/*--------------------------------------------------------------------------
* Check if SR pointer can be translated to a valid local pointer
*------------------------------------------------------------------------*/
else if ((buf = SharedRegion_getPtr(srPtr)) == NULL)
{
OSA_printf("Invalid sr translation \n");
goto EXIT;
}
}
#if 1
/* send the default dcc data if exists to M3 */
{
FILE *fp;
int lSize, result;
fp = fopen("/opt/ipnc/dcc/dcc_default.bin", "rb");
if (fp == NULL)
{
OSA_printf
("Default dcc profile does not exists. Using system defaults ... \n");
}
else /* Default profile
* exists */
{
// obtain file size:
fseek(fp, 0, SEEK_END);
lSize = ftell(fp);
rewind(fp);
result = fread(buf, 1, lSize, fp);
if (result != lSize)
{
OSA_printf("Unable to read complete dcc file ... \n");
}
else
{
/* Send a message to M3 asking to read the dcc data */
cmd = 2; // 2 is for dcc
// TODO nee to
// make it enum
ittMsg->arg1 = lSize;
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
OSA_printf("Default parameters were sent sucessfully \n");
}
fclose(fp);
}
}
#endif
ittServer_CreateSocket(ITT_SERVER_DEFAULT_PORT);
OSA_printf("Server Socket created with ID <%d> \n", serverSocketId);
while (1)
{
sin_size = sizeof(struct sockaddr_in);
connectedSocketId =
accept(serverSocketId, (struct sockaddr *) &client, &sin_size);
if (connectedSocketId < 0)
{
ITT_ERROR("Illegal client socket ID\n");
goto EXIT;
}
OSA_printf(" ITT Server: Connected to client\n");
while (1)
{
dataSize = 20;
status = ittServer_RecvData(connectedSocketId, (unsigned char *)recvData, dataSize);
if (status == -1)
{
break;
}
// recvData = (Int32 * )buf;
/* Checking connectivity */
if (recvData[0] == CMD_CKH_CONNECTION)
{
OSA_printf("Client checking the connectivity \n");
break;
}
/* dcc data */
else if (recvData[0] == CMD_SEND_DCC)
{
int updateDefault;
cmd = recvData[0];
payLoadSize = recvData[1];
updateDefault = recvData[2];
/* Get the dcc data into buffer */
status =
ittServer_RecvData(connectedSocketId, buf, payLoadSize);
if (status != -1)
{
OSA_printf("Server recived <%d> bytes from client \n",
payLoadSize);
}
if (updateDefault == 1)
{
FILE *fp = fopen("./dcc/dcc_default.bin", "wb");
if (fp == NULL)
{
OSA_printf
("error in opening the default file dcc_default.bin. Unable to update \n");
}
else
{
fwrite(buf, 1, payLoadSize, fp);
OSA_printf("default update is sucessful \n");
fclose(fp);
}
}
ittMsg->arg1 = payLoadSize;
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
recvData[0] = ittMsg->response;
recvData[1] = 0;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
break;
}
/* Reg read */
else if (recvData[0] == CMD_MEM_READ_WORD)
{
cmd = recvData[0];
ittMsg->arg1 = recvData[1];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
recvData[0] = ittMsg->response;
recvData[1] = ittMsg->arg1;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
break;
}
/* Request for RAW data */
else if (recvData[0] == CMD_SAVE_RAW)
{
//int i;
//int *buf_ptr = (int *) buf;
cmd = recvData[0];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
do
{
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
OSA_printf("Got a new message \n");
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
recvData[0] = ittMsg->response;
recvData[1] = ittMsg->arg1;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
if (ittMsg->arg1 != -1)
{
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
OSA_printf("Data to transfer = %d\n", ittMsg->arg1);
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData,
dataSize);
status =
ittServer_SendData(connectedSocketId, buf,
ittMsg->arg1);
/* { int i; for (i = 0; i < 10; i++) { OSA_printf("%x",
* ((int*)buf)[i]); } } */
// Put
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
}
else
{
break;
}
} while (1);
recvData[1] = -1;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
break;
}
else if (recvData[0] == CMD_REGS_READ)
{
//int i;
//int *buf_ptr = (int *) buf;
cmd = recvData[0];
ittMsg->arg1 = recvData[1];
ittMsg->arg2 = recvData[2];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
if (ittMsg->arg1 > 0)
{
recvData[0] = ittMsg->response;
recvData[1] = ittMsg->arg1;
recvData[2] = ittMsg->arg2;
recvData[3] = 0;
recvData[4] = 0;
OSA_printf("Data to transfer = %d\n", ittMsg->arg1);
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData,
dataSize);
status =
ittServer_SendData(connectedSocketId, buf,
ittMsg->arg1);
}
break;
}
else if ((recvData[0] == CMD_MEM_READ_BUFF) ||
(recvData[0] == CMD_SENSOR_REGS_READ))
{
//int i;
//int *buf_ptr = (int *) buf;
cmd = recvData[0];
ittMsg->arg1 = recvData[1];
ittMsg->arg2 = recvData[2];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
if (ittMsg->arg1 > 0)
{
recvData[0] = ittMsg->response;
recvData[1] = ittMsg->arg1;
recvData[2] = ittMsg->arg2;
recvData[3] = 0;
recvData[4] = 0;
OSA_printf("Data to transfer = %d\n", ittMsg->arg1);
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData,
dataSize);
status =
ittServer_SendData(connectedSocketId, buf,
ittMsg->arg1);
}
break;
} /* Reg Write */
else if ((recvData[0] == CMD_MEM_WRITE_WORD) ||
(recvData[0] == CMD_SENSOR_REG_WRITE))
{
cmd = recvData[0];
ittMsg->arg1 = recvData[1];
ittMsg->arg2 = recvData[2];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
recvData[0] = ittMsg->response;
recvData[1] = 0;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
break;
}
else if (recvData[0] == CMD_RECV_DCC)
{
cmd = recvData[0];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
recvData[0] = ittMsg->response;
recvData[1] = ittMsg->arg1;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
status =
ittServer_SendData(connectedSocketId, buf, ittMsg->arg1);
break;
}
else if (recvData[0] == CMD_CAMERA_CNTL)
{
cmd = recvData[0];
payLoadSize = recvData[1];
/* Control Parameters into buffer */
status =
ittServer_RecvData(connectedSocketId, buf, payLoadSize);
if (status != -1)
{
OSA_printf("Server recived <%d> bytes from client \n",
payLoadSize);
}
ittMsg->arg1 = payLoadSize;
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
recvData[0] = ittMsg->response;
recvData[1] = 0;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
break;
}
else if (recvData[0] == CMD_SAVE_YUV)
{
//int i;
//int *buf_ptr = (int *) buf;
cmd = recvData[0];
MessageQ_setMsgId(msg, cmd);
MessageQ_setReplyQueue(hIttMsgQ, msg);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
do
{
status = MessageQ_get(hIttMsgQ, &msg, MessageQ_FOREVER);
OSA_printf("Got a new message \n");
ITT_ASSERT(status == MessageQ_S_SUCCESS);
if(msg == NULL)
{
goto EXIT;
}
recvData[0] = ittMsg->response;
recvData[1] = ittMsg->arg1;
recvData[2] = 0;
recvData[3] = 0;
recvData[4] = 0;
if (ittMsg->arg1 != -1)
{
OSA_printf("Response from M3 is : %d\n", ittMsg->response);
OSA_printf("Data to transfer = %d\n", ittMsg->arg1);
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData,
dataSize);
status =
ittServer_SendData(connectedSocketId, buf,
ittMsg->arg1);
status = MessageQ_put(remoteQ, msg);
ITT_ASSERT(status == MessageQ_S_SUCCESS);
}
else
{
break;
}
} while (1);
recvData[1] = -1;
status =
ittServer_SendData(connectedSocketId, (unsigned char *)recvData, dataSize);
break;
}
else
{
OSA_printf("Un-supported command \n");
break;
}
}
OSA_printf(" ITT Server: Disconnected from client\n");
}
return (1);
EXIT:
ITT_ERROR("ITT server exiting with erro\n");
return (0);
}
/* ===================================================================
* @func IttServer_Task
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
void *IttServer_Task(void *taskHndl)
{
OSA_printf("ITT server task running !!!\n");
ittServer_run();
OSA_printf("ITT server task Exiting \n");
return NULL;
}
/* ===================================================================
* @func Itt_TaskCreate
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
Int32 Itt_TaskCreate()
{
Int32 status = ITT_STATUS_OK;
status = Itt_thrCreate(&ittThrHandle,
(ThrEntryFunc) IttServer_Task,
ITT_TSK_PRI, ITT_TSK_STACK_SIZE);
OSA_printf("\n ITT capture task created\n");
UTILS_assert(status == ITT_STATUS_OK);
return status;
}
/* Date Time task delete */
/* ===================================================================
* @func Itt_TaskDelete
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
int Itt_TaskDelete()
{
Itt_thrDelete(&ittThrHandle);
return 0;
}
/* ===================================================================
* @func Itt_thrCreate
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
Int32 Itt_thrCreate(TaskCtx * ctx, ThrEntryFunc entryFunc, Uint32 pri,
Uint32 stackSize)
{
Int32 status = ITT_STATUS_OK;
pthread_attr_t thread_attr;
struct sched_param schedprm;
if (ctx == NULL || entryFunc == NULL)
{
ITT_ERROR("Input param error\n");
return ITT_STATUS_EFAIL;
}
// initialize thread attributes structure
status = pthread_attr_init(&thread_attr);
if (status != ITT_STATUS_OK)
{
ITT_ERROR("Itt_thrCreate() - Could not initialize thread attributes\n");
return status;
}
if (stackSize != 0)
pthread_attr_setstacksize(&thread_attr, stackSize);
status |=
pthread_attr_setinheritsched(&thread_attr, PTHREAD_EXPLICIT_SCHED);
status |= pthread_attr_setschedpolicy(&thread_attr, SCHED_FIFO);
if (pri > sched_get_priority_max(SCHED_FIFO))
pri = sched_get_priority_max(SCHED_FIFO);
else if (pri < sched_get_priority_min(SCHED_FIFO))
pri = sched_get_priority_min(SCHED_FIFO);
schedprm.sched_priority = pri;
status |= pthread_attr_setschedparam(&thread_attr, &schedprm);
if (status != ITT_STATUS_OK)
{
ITT_ERROR("Itt_thrCreate() - Could not initialize thread attributes\n");
goto error_exit;
}
ctx->exitFlag = 0;
status = pthread_create(&ctx->handle, &thread_attr, entryFunc, ctx);
if (status != ITT_STATUS_OK)
{
ITT_ERROR("Itt_thrCreate() - Could not create thread [%d]\n", status);
}
error_exit:
pthread_attr_destroy(&thread_attr);
return status;
}
/* ===================================================================
* @func Itt_thrDelete
*
* @desc Function does the following
*
* @modif This function modifies the following structures
*
* @inputs This function takes the following inputs
* <argument name>
* Description of usage
* <argument name>
* Description of usage
*
* @outputs <argument name>
* Description of usage
*
* @return Return value of this function if any
* ==================================================================
*/
Int32 Itt_thrDelete(TaskCtx * ctx)
{
Int32 status = ITT_STATUS_OK;
void *retVal;
if (NULL == ctx)
{
ITT_ERROR("Itt_thrDelete() - handle is NULL\n");
return ITT_STATUS_EFAIL;
}
status = close(serverSocketId);
UTILS_assert(status == MessageQ_S_SUCCESS);
status = MessageQ_close(&remoteQ);
UTILS_assert(status == MessageQ_S_SUCCESS);
MessageQ_unblock(hIttMsgQ);
status = MessageQ_delete(&hIttMsgQ);
UTILS_assert(status == MessageQ_S_SUCCESS);
status |= pthread_cancel(ctx->handle);
ctx->exitFlag = 1;
if (pthread_join(ctx->handle, &retVal))
{
ITT_ERROR("Itt_thrDelete() - handle is NULL\n");
}
return status;
}
DM8127下面的例子，使用socket传输数据；