anovikova/bcrt
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

v2

Browse Source
This commit is contained in:
anovikova
2025-09-16 12:08:45 +03:00
parent 648e754d32
commit 105b4e79da
21 changed files with 984 additions and 289 deletions
Download Patch File Download Diff File Expand all files Collapse all files

151
bcmil.cpp
View File

@@ -1,16 +1,22 @@
#include "declarations.h"
#include <QDebug>
#include "bcmil.h"
#include "WDMTMKv2.cpp"
TTmkEventData tmkEvD;
HANDLE hBcEvent;
HANDLE hRtEvent;
HANDLE hEvent;
int nTmk;
uint8_t wAddr_RT, wRecTrans;
unsigned long dwGoodStarts = 0, dwBusyStarts = 0, dwErrStarts = 0, dwStatStarts = 0;
unsigned long dwStarts = 0L;
TMK_DATA wSubAddr, wState, wStatus;
MIL::MIL(int dev_index) //open the driver, configuration, create event
int bcrtFlag; //RT = 0, BC = 1
//Open the driver, configuration, create event
MIL::MIL(int dev_index)
{
qDebug() << "MIL constructor";
if (TmkOpen())
@@ -21,30 +27,39 @@ MIL::MIL(int dev_index) //open the driver, configuration, create event
else
{
if ((dev_index > tmkgetmaxn()) || (dev_index < 0))
{
closeAll();
}
else
{
this->m_TmkIndex = dev_index;
if (tmkconfig(this->m_TmkIndex))
{
closeAll();
this->m_hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
ResetEvent(this->m_hEvent);
tmkdefevent(this->m_hEvent, TRUE);
}
}
}
hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
if (!hEvent)
{
qDebug() << "CreateEvent() error";
closeAll();
}
ResetEvent(hEvent);
tmkdefevent(hEvent, TRUE);
}
int MIL::WaitInt(TMK_DATA wCtrlCode)
{
//Wait for an interrupt */
//Wait for an interrupt
DWORD k;
k = WaitForSingleObject(hBcEvent, 1000);
k = WaitForSingleObject(hEvent, 1000);
switch (k)
{
case WAIT_OBJECT_0:
ResetEvent(hBcEvent);
ResetEvent(hEvent);
break;
case WAIT_TIMEOUT:
@@ -57,34 +72,89 @@ int MIL::WaitInt(TMK_DATA wCtrlCode)
return 1;
}
/* Get interrupt data */
/* We do not need to check tmkEvD.nInt because bcstartx with CX_NOSIG */
/* guarantees us only single interrupt of single type nInt == 3 */
// Get interrupt data
// We do not need to check tmkEvD.nInt because bcstartx with CX_NOSIG
// guarantees us only single interrupt of single type nInt == 3
tmkgetevd(&tmkEvD);
if (tmkEvD.bcx.wResultX & SX_IB_MASK)
{
/* We have set bit(s) in Status Word */
// We have set bit(s) in Status Word
if (((tmkEvD.bcx.wResultX & SX_ERR_MASK) == SX_NOERR) || ((tmkEvD.bcx.wResultX & SX_ERR_MASK) == SX_TOD))
{
wStatus = bcgetansw(wCtrlCode); /* We have either no errors or Data Time Out (No Data) error */
if (wStatus & BUSY_MASK) /* We have BUSY bit set */
wStatus = bcgetansw(wCtrlCode); // We have either no errors or Data Time Out (No Data) error
if (wStatus & BUSY_MASK) // We have BUSY bit set
++dwBusyStarts;
else /* We have unknown bit(s) set */
else // We have unknown bit(s) set
++dwStatStarts;
}
else /* We have an error */
else // We have an error
++dwErrStarts;
}
else if (tmkEvD.bcx.wResultX & SX_ERR_MASK) /* We have an error */
else if (tmkEvD.bcx.wResultX & SX_ERR_MASK) // We have an error
++dwErrStarts;
else /* We have a completed message */
else // We have a completed message
++dwGoodStarts;
++dwStarts;
return 0;
}
void MIL::closeAll()
{
qDebug() << "Close All";
if(!bcrtFlag)
rtreset();
else
bcreset();
CloseHandle(hEvent);
tmkdone(ALL_TMKS);
TmkClose();
}
bool MIL::GetEvent(unsigned short Timeout)
{
//int MASK = 0;
if (tmkselect(this->m_TmkIndex))
{
qDebug() << "tmkselect() error";
return false;
}
//MASK = MASK | BUSY;
//rtsetanswbits(BUSY);
switch (WaitForSingleObject(hEvent, Timeout))
{
case WAIT_OBJECT_0:
qDebug() << "Interrupt";
ResetEvent(hEvent);
tmkgetevd(&tmkEvD);
qDebug() << "1 bc wResult " << tmkEvD.bc.wResult;
qDebug() << "1 bc wAW1 " << tmkEvD.bc.wAW1;
qDebug() << "1 bc wAW2 " << tmkEvD.bc.wAW2;
qDebug() << "1 bcx wBase " << tmkEvD.bcx.wBase;
qDebug() << "1 bcx wResultX " << tmkEvD.bcx.wResultX;
qDebug() << "1 rt wStatus" << tmkEvD.rt.wStatus;
qDebug() << "1 rt wCmd" << tmkEvD.rt.wCmd;
qDebug() << "1 mt wBase " << tmkEvD.mt.wBase;
qDebug() << "1 mt wResultX " << tmkEvD.mt.wResultX;
qDebug() << "1 mrt wStatus" << tmkEvD.mrt.wStatus;
qDebug() << "1 tmk wRequest" << tmkEvD.tmk.wRequest;
return true;
break;
case WAIT_TIMEOUT:
//qDebug() << "No new messages";
return false;
break;
default:
qDebug() << "Interrupt wait error";
return false;
break;
}
}
MIL::~MIL()
{
qDebug() << "MIL destructor";
@@ -120,30 +190,21 @@ RT_MIL::RT_MIL(int dev_index, unsigned short Addr): MIL(dev_index)
qDebug() << "RT_MIL constructor";
this->m_Addr = Addr;
//Find first configured device
for (nTmk = 0; nTmk <= MAX_TMK_NUMBER; ++nTmk)
if (!tmkselect(nTmk))
break;
if (nTmk > MAX_TMK_NUMBER)
{
qDebug() << "tmkselect error";
closeAllrt();
}
//Try to reset in RT mode
if (rtreset())
{
qDebug() << "rtreset error";
closeAllrt();
qDebug() << "rtreset() error";
closeAll();
}
//Set RT address, set flag mode, enable data irqs
rtdefaddress(Addr);
rtdefmode(rtgetmode()|RT_FLAG_MODE);
//rtdefmode(rtgetmode()&~RT_FLAG_MODE);
rtdefmode(0);
rtdefirqmode(rtgetirqmode()&~RT_DATA_BL);
//Ready to receive, not ready to transmit
for (wSubAddr = 1; wSubAddr <= 30; ++wSubAddr)
{
/* Ready to receive, not ready to transmit */
rtdefsubaddr(RT_RECEIVE, wSubAddr);
rtclrflag();
rtdefsubaddr(RT_TRANSMIT, wSubAddr);
@@ -156,24 +217,4 @@ RT_MIL::~RT_MIL()
qDebug() << "RT_MIL destructor";
}
void MIL::closeAll()
{
qDebug() << "Close All";
//printf("\nGood: %ld, Busy: %ld, Error: %ld, Status: %ld\n", dwGoodStarts, dwBusyStarts, dwErrStarts, dwStatStarts);
bcreset();
/* Close all opened things */
CloseHandle(hBcEvent);
tmkdone(ALL_TMKS);
TmkClose();
}
void MIL::closeAllrt()
{
qDebug() << "Close All";
//printf("\nGood: %ld, Busy: %ld, Error: %ld, Status: %ld\n", dwGoodStarts, dwBusyStarts, dwErrStarts, dwStatStarts);
rtreset();
/* Close all opened things */
CloseHandle(hRtEvent);
tmkdone(ALL_TMKS);
TmkClose();
}