40 lines
713 B
C++
40 lines
713 B
C++
#include "XLaserCommand.h"
|
|
|
|
|
|
|
|
CXLaserCommand::CXLaserCommand(uint8_t oa)
|
|
:m_OrderAddr(oa)
|
|
{
|
|
}
|
|
|
|
|
|
CXLaserCommand::~CXLaserCommand()
|
|
{
|
|
}
|
|
|
|
int CXLaserCommand::GetRequestSequence(unsigned char* bseq)
|
|
{
|
|
bseq[0] = m_HeadL;
|
|
bseq[1] = m_HeadH;
|
|
bseq[2] = m_DevNo;
|
|
bseq[3] = m_ReadCtrl;
|
|
bseq[4] = m_OrderAddr;
|
|
bseq[5] = 0;
|
|
bseq[6] = 0;
|
|
bseq[7] = 0;
|
|
bseq[8] = 0;
|
|
bseq[9] = 0;
|
|
bseq[10] = 0;
|
|
return 11;
|
|
}
|
|
|
|
bool CXLaserCommand::Verify(unsigned char* rseq, int dlength)
|
|
{
|
|
if (dlength != 11)return false;
|
|
if (rseq[0] != m_HeadL)return false;
|
|
if (rseq[1] != m_HeadH)return false;
|
|
if (rseq[2] != m_DevNo)return false;
|
|
//if (rseq[3] != 0x05)return false;
|
|
if (rseq[4] != m_OrderAddr)return false;
|
|
return true;
|
|
} |