CAPL:testWaitForMessage函数检测报文不准，如何解决

各位，我在写Autosar网络管理自动化测试用例时，写了一下代码

testcase Test6_CN220MHEV_BSMToRMS_ByNMmsg0x629()
{
message 0x629 msg;
msg.dlc=8;

setLogFileName("logfiles\Test6_CN220MHEV_BSMToRMS_ByNMmsg0x629");
startLogging();

KL30on();
KL15on();

testWaitForTimeout(2000);
KL15off();
testWaitForTimeout(12000);
if(1 == testWaitForMessage(200))
{
testStepFail("Fail,IC can't enter bus sleep mode.");
}
else
{
testSteppass("Pass,IC can enter bus sleep mode.");
}
IP614Time=0;
Time_KL15ON=0;

//KL15on();
output(msg);
Time_NMmsgSend=timeNow()/100;
testWaitForMessage(50);

if(1 == testWaitForMessage(200))
{
// if((Rec_Message_ID==0x614)&&(getSignal(InitContionInd) == 0x1))
if(Rec_Message_ID==0x614)
{
testStepPass("Pass,IC wakeup by NM message in 200ms");
testStep("Text","When send NM message ,DUT Fisrt NM message send out time is %dms",IP614Time-Time_NMmsgSend);
}
else
{
testStepFail("Fail,IC can't wakeup by NM message in 200ms");
testStep("Text","When send NM message ,DUT Fisrt NM message send out time is frame %x",Rec_Message_ID);
}
}
else
{
testStepFail("Fail, After send NM message ，IC can't send any message in 200ms.");
}

testWaitForTimeout(500);
stopLogging();
}

测试结果：

实际报文：

经过分析：
测试实际回复首帧报文是614，结果自动化工程将我发送的那一帧629报文识别为首帧报文

我的代码如何改进可以得到期望的结果？