187 lines
5.3 KiB
C
187 lines
5.3 KiB
C
|
/*******************************************************************************
|
||
|
* Trace Recorder Library for Tracealyzer v4.1.5
|
||
|
* Percepio AB, www.percepio.com
|
||
|
*
|
||
|
* trcStreamingPort.c
|
||
|
*
|
||
|
* Supporting functions for trace streaming, used by the "stream ports"
|
||
|
* for reading and writing data to the interface.
|
||
|
* Existing ports can easily be modified to fit another setup, e.g., a
|
||
|
* different TCP/IP stack, or to define your own stream port.
|
||
|
*
|
||
|
* Terms of Use
|
||
|
* This file is part of the trace recorder library (RECORDER), which is the
|
||
|
* intellectual property of Percepio AB (PERCEPIO) and provided under a
|
||
|
* license as follows.
|
||
|
* The RECORDER may be used free of charge for the purpose of recording data
|
||
|
* intended for analysis in PERCEPIO products. It may not be used or modified
|
||
|
* for other purposes without explicit permission from PERCEPIO.
|
||
|
* You may distribute the RECORDER in its original source code form, assuming
|
||
|
* this text (terms of use, disclaimer, copyright notice) is unchanged. You are
|
||
|
* allowed to distribute the RECORDER with minor modifications intended for
|
||
|
* configuration or porting of the RECORDER, e.g., to allow using it on a
|
||
|
* specific processor, processor family or with a specific communication
|
||
|
* interface. Any such modifications should be documented directly below
|
||
|
* this comment block.
|
||
|
*
|
||
|
* Disclaimer
|
||
|
* The RECORDER is being delivered to you AS IS and PERCEPIO makes no warranty
|
||
|
* as to its use or performance. PERCEPIO does not and cannot warrant the
|
||
|
* performance or results you may obtain by using the RECORDER or documentation.
|
||
|
* PERCEPIO make no warranties, express or implied, as to noninfringement of
|
||
|
* third party rights, merchantability, or fitness for any particular purpose.
|
||
|
* In no event will PERCEPIO, its technology partners, or distributors be liable
|
||
|
* to you for any consequential, incidental or special damages, including any
|
||
|
* lost profits or lost savings, even if a representative of PERCEPIO has been
|
||
|
* advised of the possibility of such damages, or for any claim by any third
|
||
|
* party. Some jurisdictions do not allow the exclusion or limitation of
|
||
|
* incidental, consequential or special damages, or the exclusion of implied
|
||
|
* warranties or limitations on how long an implied warranty may last, so the
|
||
|
* above limitations may not apply to you.
|
||
|
*
|
||
|
* Tabs are used for indent in this file (1 tab = 4 spaces)
|
||
|
*
|
||
|
* Copyright Percepio AB, 2018.
|
||
|
* www.percepio.com
|
||
|
******************************************************************************/
|
||
|
|
||
|
#include "trcRecorder.h"
|
||
|
|
||
|
#if (TRC_CFG_RECORDER_MODE == TRC_RECORDER_MODE_STREAMING)
|
||
|
#if (TRC_USE_TRACEALYZER_RECORDER == 1)
|
||
|
|
||
|
/* TCP/IP includes - for lwIP in this case */
|
||
|
#include "lwip/tcpip.h"
|
||
|
#include "lwip/sockets.h"
|
||
|
|
||
|
int errno;
|
||
|
|
||
|
#define TRC_TCPIP_PORT 12000
|
||
|
|
||
|
int sock = -1, new_sd = -1;
|
||
|
int flags = 0;
|
||
|
int remoteSize;
|
||
|
struct sockaddr_in address, remote;
|
||
|
|
||
|
int32_t trcSocketSend( void* data, int32_t size, int32_t* bytesWritten )
|
||
|
{
|
||
|
if (new_sd < 0)
|
||
|
return -1;
|
||
|
|
||
|
if (bytesWritten == NULL)
|
||
|
return -1;
|
||
|
|
||
|
*bytesWritten = send( new_sd, data, size, 0 );
|
||
|
if (*bytesWritten < 0)
|
||
|
{
|
||
|
/* EWOULDBLOCK may be expected when buffers are full */
|
||
|
if (errno != 0 && errno != EWOULDBLOCK)
|
||
|
{
|
||
|
closesocket(new_sd);
|
||
|
new_sd = -1;
|
||
|
return -1;
|
||
|
}
|
||
|
else
|
||
|
*bytesWritten = 0;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int32_t trcSocketReceive( void* data, int32_t size, int32_t* bytesRead )
|
||
|
{
|
||
|
if (new_sd < 0)
|
||
|
return -1;
|
||
|
|
||
|
*bytesRead = recv( new_sd, data, size, 0 );
|
||
|
if ( *bytesRead < 0 )
|
||
|
{
|
||
|
/* EWOULDBLOCK may be expected when there is no data to receive */
|
||
|
if (errno != 0 && errno != EWOULDBLOCK)
|
||
|
{
|
||
|
closesocket(new_sd);
|
||
|
new_sd = -1;
|
||
|
return -1;
|
||
|
}
|
||
|
else
|
||
|
*bytesRead = 0;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int32_t trcSocketInitializeListener()
|
||
|
{
|
||
|
if (sock >= 0)
|
||
|
return 0;
|
||
|
|
||
|
sock = lwip_socket(AF_INET, SOCK_STREAM, 0);
|
||
|
|
||
|
if (sock < 0)
|
||
|
return -1;
|
||
|
|
||
|
address.sin_family = AF_INET;
|
||
|
address.sin_port = htons( TRC_TCPIP_PORT );
|
||
|
address.sin_addr.s_addr = INADDR_ANY;
|
||
|
|
||
|
if (bind(sock, (struct sockaddr *)&address, sizeof (address)) < 0)
|
||
|
{
|
||
|
closesocket(sock);
|
||
|
sock = -1;
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
if (lwip_listen(sock, 5) < 0)
|
||
|
{
|
||
|
closesocket(sock);
|
||
|
sock = -1;
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int32_t trcSocketAccept()
|
||
|
{
|
||
|
if (sock < 0)
|
||
|
return -1;
|
||
|
|
||
|
if (new_sd >= 0)
|
||
|
return 0;
|
||
|
|
||
|
remoteSize = sizeof( remote );
|
||
|
new_sd = accept( sock, (struct sockaddr *)&remote, (socklen_t*)&remoteSize );
|
||
|
|
||
|
flags = fcntl( new_sd, F_GETFL, 0 );
|
||
|
fcntl( new_sd, F_SETFL, flags | O_NONBLOCK );
|
||
|
|
||
|
if( new_sd < 0 )
|
||
|
{
|
||
|
closesocket(new_sd);
|
||
|
new_sd = -1;
|
||
|
closesocket(sock);
|
||
|
sock = -1;
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
/************** MODIFY THE ABOVE PART TO USE YOUR TPC/IP STACK ****************/
|
||
|
|
||
|
int32_t trcTcpWrite(void* data, uint32_t size, int32_t *ptrBytesWritten)
|
||
|
{
|
||
|
return trcSocketSend(data, size, ptrBytesWritten);
|
||
|
}
|
||
|
|
||
|
int32_t trcTcpRead(void* data, uint32_t size, int32_t *ptrBytesRead)
|
||
|
{
|
||
|
trcSocketInitializeListener();
|
||
|
|
||
|
trcSocketAccept();
|
||
|
|
||
|
return trcSocketReceive(data, size, ptrBytesRead);
|
||
|
}
|
||
|
|
||
|
#endif /*(TRC_USE_TRACEALYZER_RECORDER == 1)*/
|
||
|
#endif /*(TRC_CFG_RECORDER_MODE == TRC_RECORDER_MODE_STREAMING)*/
|