int CKMotionIO::WriteLineReadLine(const char *send, char *response)
{
Mutex->Lock();
if (WriteLine(send))
{
Mutex->Unlock();
return 1;
}
if (ReadLineTimeOut(response,3000))
{
Mutex->Unlock();
return 1;
}
response[strlen(response)-2]=0; // remove the /r /n
Mutex->Unlock();
return 0;
}
int CKMotionIO::WriteLineReadLine(const char *send, char *response)
{
Mutex->Lock();
if (WriteLine(send))
{
Mutex->Unlock();
debug("WriteLine failed.");
return 1;
}
if (ReadLineTimeOut(response,3000))
{
Mutex->Unlock();
//TODO this fails occasionally
debug("ReadLineTimeOut failed.");
return 1;
}
//TODO handle if response len < 2
response[strlen(response)-2]=0; // remove the /r /n
Mutex->Unlock();
return 0;
}
