static int cmd_comtest(unsigned int argc, unsigned char *argv[])
{
unsigned int data_len;
#ifdef UPGRADE_ONCE
if(receive_comtest_falg == FALSE)
return -1;
#endif
#ifdef PANEL_DISPLAY
#if (SYS_SDRAM_SIZE != 2)
pan_display(panel_dev, "conn", 4);
#else
pan_display(panel_dev, "UP9", 4);
#endif
#endif
if (argc != 2)
{
#ifdef PANEL_DISPLAY
pan_display(panel_dev, "r101", 4);
#endif
SH_PRINTF("Usage: comtest <data_num>\n");
SH_PRINTF(" Then begin loopback <data_num> charactor to host.\n");
return -1;
}
data_len = ATOI(argv[1]);
while (data_len--)
LIB_ASH_OC(LIB_ASH_IC());
return 0;
}
/****************************************************************************
*
* Name: packet_receive
* Function: receive a packet
* variable: pPacket -- packet information point
* nTimeOut -- time out
*
****************************************************************************/
UINT32 packet_receive(PPACKET pPacket, UINT32 nTimeOut)
{
//receive and compare packet head flag
unsigned char c = 0;
BOOL bPacketHead = FALSE;
BOOL bComtest = FALSE;
UINT32 i = 0;
int n = 0;
UINT32 nLength = 0;
MEMSET(pPacket, 0, sizeof(PACKET));
for(i = 0; i < nTimeOut;)
{
if( c == 'H')
{
// judge if packet head
for(n = 0; n < 3; n++)
{
if(SUCCESS != com_read_tm(&c, 1, 1))
{
c = 0;
break;
}
if(c != l_packet_head_flag[n + 1])
break;
}
if(n == 3)
{
bPacketHead = TRUE;
break;
}
}
else if(c == 'c')
{
pPacket->data_buffer[0] = 'c';
LIB_ASH_OC(c);
//judge if comtest
for(n = 0; n < 6; n++)
{
// c = LIB_ASH_IC();
if(SUCCESS != com_read_tm(&c, 1, 100))
{
c = 0;
SH_PRINTF("comtest not all : %d\n", n);
break;
}
if(c != l_packet_comtest[n + 1])
break;
LIB_ASH_OC(c);
}
if(n == 6)
{
SH_PRINTF("RECEIVE comtest\n");
bComtest = TRUE;
break;
}
}
else if(SUCCESS != com_read(&c, 1))
{
Sleep(1);
i++;
}
}
if(bPacketHead)
{
//receive packet head
unsigned char packet_head[PACKET_HEAD_LEN];
if(SUCCESS != com_read_tm(packet_head + PACKET_TYPE_OFFSET, PACKET_HEAD_LEN - 4, 1000))
{
SH_PRINTF("ERROR:receive head error");
return ERROR_PACKET_RECEIVEHEAD;
}
//compare CRC about packet head
UINT32 nCRC = MG_Table_Driven_CRC(0xFFFFFFFF, packet_head + PACKET_TYPE_OFFSET, PACKET_HEAD_LEN - 8);
if(nCRC != fetch_long(packet_head + PACKET_HEAD_CRC_OFFSET))
return ERROR_PACKET_HEADCRC;
MakePacketHead(packet_head, pPacket);
//Receive data and CRC
nLength = pPacket->packet_length;
// if blank packet receive 4B packet number only
if(0 != pPacket->blank_flag && PACKET_DATA == pPacket->packet_type)
nLength = 4;
if(SUCCESS != com_read_tm(pPacket->data_buffer, nLength + 4, 1000))
return ERROR_PACKET_RECEIVEDATA;
nCRC = MG_Table_Driven_CRC(0xFFFFFFFF, pPacket->data_buffer, nLength);
if(nCRC != fetch_long(pPacket->data_buffer + nLength))
return ERROR_PACKET_DATACRC;
if(PACKET_DATA == pPacket->packet_type)
{
if(1 == pPacket->blank_flag)
memset(pPacket->data_buffer + 4, 0xFF, pPacket->packet_length - 4);
else if(2 == pPacket->blank_flag)
memset(pPacket->data_buffer + 4, 0x00, pPacket->packet_length - 4);
}
}
else if(bComtest)
{
pPacket->packet_type = PACKET_COMMAND;
MEMCPY(pPacket->data_buffer, l_packet_comtest, 7);
i = 7;
while(i < 128)
{
pPacket->data_buffer[i] = LIB_ASH_IC();
c = pPacket->data_buffer[i];
LIB_ASH_OC(c);
if (c == 0x0D || c == 0x0A)
break;
i++;
}
pPacket->packet_length = STRLEN(pPacket->data_buffer);
// for(i = 0; i < pPacket->packet_length; i++)
// LIB_ASH_OC(pPacket->data_buffer[i]);
SH_PRINTF(pPacket->data_buffer);
g_packet_index = 0;
g_packet_repeat = 0;
}
else
return ERROR_NOPACKETRECEIVE;
return SUCCESS;
}
