U16 tcp_callback (U8 soc, U8 evt, U8 *ptr, U16 par) {
int i=0;

unsigned short ln;
if (soc != socket_tcp) {
return (0);
}

switch (evt) {
case TCP_EVT_DATA:
/* TCP data frame has arrived, data is located at *par1, */
/* data length is par2. Allocate buffer to send reply. */
pEther=EtherBuf;
//memcpy(EtherBufIn,(char*)ptr,par);
for(i=0;i<par;i++)
{
EtherBufIn[EthBufOffset]=(char)ptr[i];
if(EtherBufIn[EthBufOffset]==0xd
|| EtherBufIn[EthBufOffset]==0)
{
EtherBufIn[EthBufOffset]=0;
ExecuteCmd(EtherBufIn,0);
EthBufOffset = 0;
}
else
{
EthBufOffset++;
if(EthBufOffset>=sizeof(EtherBufIn))
EthBufOffset=0;
}
}
ln = pEther-EtherBuf;
SendEther = tcp_get_buf(ln);
memcpy(SendEther,EtherBuf,ln);
tcp_send(socket_tcp, SendEther, ln);
Cmd = 0;
break;
case TCP_EVT_ABORT:
/* Connection was aborted */
break;
case TCP_EVT_CONREQ:
/* Remote peer requested connect, accept it */
return (1);
case TCP_EVT_CONNECT:
/* The TCP socket is connected */
return (1);
}
return (0);
}

__task void Ether()
{
os_itv_set(RL_1MS*20);
init_TcpNet();

// Initialize TCP Socket and start listening
socket_tcp = tcp_get_socket (TCP_TYPE_SERVER, 0, 30, tcp_callback); // | TCP_TYPE_KEEP_ALIVE
if (socket_tcp != 0)
tcp_listen(socket_tcp, PORT_NUM);

while (1)
{
os_itv_wait(); // wait timer event
timer_tick();
main_TcpNet();
}
}