// MultiplexerInterface.cpp: implementation of the MultiplexerInterface class.
//
//////////////////////////////////////////////////////////////////////
#include "stdafx.h"
#include "monitor.h"
#include "MultiplexerInterface.h"
#include "monitorDoc.h"
#include "Settings.h"
#include <assert.h>
#ifdef _DEBUG
#undef THIS_FILE
static char THIS_FILE[]=__FILE__;
#define new DEBUG_NEW
#endif
void TrimTrailingJunk(CString& str)
{
while( (str.Right(1) == '\015') || (str.Right(1) == '\012') )
str = str.Left(str.GetLength() - 1);
str.TrimRight();
}
// **************************************************************************
// Checksum object
Checksum::Checksum()
{
Clear();
}
Checksum::~Checksum()
{
}
void Checksum::Add(unsigned char c)
{
plain_checksum ^= c;
cyclic_checksum ^= c;
cyclic_checksum += (unsigned short)c << 8;
bool carry = (cyclic_checksum & 1) ? true : false;
cyclic_checksum >>= 1;
cyclic_checksum |= carry ? 0x8000 : 0;
cyclic_checksum += 817;
}
// **************************************************************************
// MultiplexerInterface object
// and related functions
// ----------------------------------------
// Thread startup procedure for driver
UINT DriverThreadProc( LPVOID pParam )
{
MultiplexerInterface* pObj = (MultiplexerInterface*)pParam;
if (pObj == NULL)
return -1; // illegal parameter
pObj->fDriverThreadRunning = true;
pObj->vmessage("Main driver thread started");
pObj->Driver(); // The interface driver for the object
pObj->vmessage("Main driver thread stopped");
pObj->fDriverThreadRunning = false;
return 0; // thread completed successfully
}
// ----------------------------------------
// Thread startup procedure for output driver
UINT OutputDriverThreadProc( LPVOID pParam )
{
MultiplexerInterface* pObj = (MultiplexerInterface*)pParam;
if (pObj == NULL)
return -1; // illegal parameter
pObj->fOutputDriverThreadRunning = true;
pObj->vmessage("Output driver thread started");
pObj->OutputDriver(); // The interface driver for the object
pObj->vmessage("Output driver thread stopped");
pObj->fOutputDriverThreadRunning = false;
return 0; // thread completed successfully
}
//////////////////////////////////////////////////////////////////////
// Construction/Destruction
//////////////////////////////////////////////////////////////////////
void MultiplexerInterface::GeneralInitializations()
{
parent = NULL;
parent_channel = 0;
hCom = NULL;
com_open = false;
last_port_number = 1;
LastError = 0;
LastErrorContext = COM_ERRCONTEXT_NO_ERROR;
fExitDriverThread = false;
fDriverThreadRunning = false;
fExitOutputDriverThread = false;
fOutputDriverThreadRunning = false;
suspend_activity = false;
read_in_progress = false;
write_in_progress = false;
InitializeDriverState();
}
void MultiplexerInterface::InitializeDriverState()
{
vmessage("Initializing buffers");
packets = 0;
bad_packet_count = 0;
missing_packet_count = 0;
prior_serial_initialized = false;
character_count = 0;
receiver_state = 0;
crx_state = 0;
crx_read_response_received = false;
crx_write_response_received = false;
transmitter_state = 0;
transmit_channel = 0;
transmit_serial = 0;
fail_count1 = 0;
fail_count2 = 0;
fail_count3 = 0;
error_flag = false;
int i;
for( i = 0; i < 8; i++ )
{
rbuf_enqueue_idx[i] = rbuf_dequeue_idx[i] = 0;
tbuf_enqueue_idx[i] = tbuf_dequeue_idx[i] = 0;
rbuf_overrun_count[i] = 0;
cascaded[i] = NULL;
}
outq_enqueue_idx = 0;
outq_dequeue_idx = 0;
outq_free = mux_interface_outqueuesize - 1;
outq_free_outer_lock = false;
outq_free_critical_section = false;
outq_growing = false;
}
MultiplexerInterface::MultiplexerInterface(class CMonitorDoc* doc)
{
MultiplexerInterface::doc = doc;
GeneralInitializations();
}
MultiplexerInterface::MultiplexerInterface(MultiplexerInterface* parent, int parent_channel)
{
GeneralInitializations();
MultiplexerInterface::parent = parent;
MultiplexerInterface::parent_channel = parent_channel;
}
MultiplexerInterface::~MultiplexerInterface()
{
if(com_open)
{
vmessage("Setting COM break");
SetCommBreak(hCom); // set BREAK to reset multiplexer (stops output)
Sleep(200);
vmessage("Clearing COM break");
ClearCommBreak(hCom);
}
ClosePort(); // close port if it is open and kill the associated driver thread and child interface objects
if(mux_interface == this)
mux_interface = NULL;
}
void MultiplexerInterface::message(const char* sz, bool error, bool newline)
{
if(doc)
doc->message(sz, error, newline);
}
void MultiplexerInterface::tail_msg(const char* sz, bool error)
{
if(doc)
doc->tail_msg(sz, error);
}
void MultiplexerInterface::vmessage(const char* sz, bool error, bool newline)
{
if(doc)
doc->vmessage(sz, error, newline);
}
void MultiplexerInterface::vtail_msg(const char* sz, bool error)
{
if(doc)
doc->vtail_msg(sz, error);
}
// --------------------------------------------------------------------------------------
// Open a COM port and start associated driver thread
//
// The COM port provides the connection to the multiplexer hardware.
// (only valid for objects created via default constructor since the
// other constructor sets up a link to a cascaded multiplexer board).
//
// Returns true if successful.
//
// If this function fails the GetLastError() method may be called
// to retrieve the operating-system supplied error code.
// GetLastErrorContext() may be called to retrieve a code describing
// which operating-system function failed. GetLastErrorString()
// returns a formatted string describing what the error was and where
// it occurred.
bool MultiplexerInterface::OpenPort(int port_number, DWORD baud_rate)
{
DCB dcb;
CString port;
ClosePort(); // close port incase a different port was previously opened
last_port_number = port_number;
port.Format("COM%i", port_number);
vtail_msg("Opening operating-system handle to COM port");
hCom = CreateFile(port,
GENERIC_READ | GENERIC_WRITE,
0, /* comm devices must be opened w/exclusive-access */
NULL, /* no security attrs */
OPEN_EXISTING, /* comm devices must use OPEN_EXISTING */
0, /* not overlapped I/O */
NULL /* hTemplate must be NULL for comm devices */
);
LastErrorContext = OPENING_PORT;
if (hCom == INVALID_HANDLE_VALUE) {
show_comm_err:
LastError = ::GetLastError();
LPVOID lpMsgBuf;
FormatMessage(
FORMAT_MESSAGE_ALLOCATE_BUFFER | FORMAT_MESSAGE_FROM_SYSTEM, NULL,
LastError,
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), // Default language
(LPTSTR) &lpMsgBuf, 0, NULL );// Display the string.
LastErrorString.Format("Error %s %s: %s", GetLastErrorContextString(), port, lpMsgBuf);
TrimTrailingJunk(LastErrorString);
LocalFree( lpMsgBuf );
if(com_open) {
CloseHandle(hCom);
com_open = false;
}
return false;
}
vmessage("Opened operating-system handle to COM port");
com_open = true;
if( !SetupComm( hCom, 0X8000, 0X8000 ) ) // request 32k input buffer and 32k output buffer
{
LastErrorContext = SETTING_BUFSIZES;
goto show_comm_err;
}
if( !GetCommState(hCom, &dcb) )
{
LastErrorContext = READING_DCB;
goto show_comm_err;
}
bool high_baud_rate;
switch(baud_rate)
{
case CBR_56000 :
case CBR_115200 :
case CBR_128000 :
case CBR_256000 :
high_baud_rate = true;
default :
high_baud_rate = false; // baud rate not supported
}
dcb.BaudRate = baud_rate;
dcb.ByteSize = 8;
dcb.Parity = NOPARITY;
dcb.StopBits = high_baud_rate ? TWOSTOPBITS : ONESTOPBIT;
dcb.fBinary = 1;
dcb.fParity = 0;
dcb.fOutxCtsFlow = 0;
dcb.fOutxDsrFlow = 0;
dcb.fDtrControl = DTR_CONTROL_DISABLE;
dcb.fDsrSensitivity = 0;
dcb.fTXContinueOnXoff = 1;
dcb.fOutX = 0;
dcb.fInX = 0;
dcb.fErrorChar = 0;
dcb.fNull = 0;
dcb.fRtsControl = RTS_CONTROL_DISABLE;
dcb.fAbortOnError = 0;
if( !SetCommState(hCom, &dcb) )
{
LastErrorContext = WRITING_DCB;
goto show_comm_err;
}
// Set up timeouts so that read operations always return
// immediately with whatever is buffered (even if it is 0 bytes)
// and write operations don't time out.
COMMTIMEOUTS cmto;
cmto.ReadIntervalTimeout = MAXDWORD;
cmto.ReadTotalTimeoutMultiplier = 0;
cmto.ReadTotalTimeoutConstant = 1;
cmto.WriteTotalTimeoutMultiplier = MAXDWORD;
cmto.WriteTotalTimeoutConstant = MAXDWORD;
if( !SetCommTimeouts(hCom, &cmto) )
{
LastErrorContext = WRITING_TIMEOUTS;
goto show_comm_err;
}
// Start driver thread for COM port interface
assert(!fDriverThreadRunning);
suspend_activity = false;
fExitDriverThread = false;
AfxBeginThread(DriverThreadProc, this);
return true;
}
// ----------------------------------------------------------------------------------
// Close the COM port if one is open ... also kill the associated driver thread.
// The driver thread will destroy all child interface objects when it exits (it must
// destroy them since it created them and no other thread can destroy them).
void MultiplexerInterface::ClosePort()
{
if(fDriverThreadRunning)
vtail_msg("Stopping driver threads prior to port close");
fExitDriverThread = true;
while(fDriverThreadRunning)
Sleep(0);
if(com_open)
{
vtail_msg("Closing operating-system handle to COM port");
if( !CloseHandle(hCom) )
{
CString str;
LPVOID lpMsgBuf;
FormatMessage(
FORMAT_MESSAGE_ALLOCATE_BUFFER | FORMAT_MESSAGE_FROM_SYSTEM, NULL,
::GetLastError(),
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), // Default language
(LPTSTR) &lpMsgBuf, 0, NULL );// Display the string.
str.Format("Error closing COM port: %s", lpMsgBuf);
TrimTrailingJunk(str);
MessageBox(NULL, str, "CloseHandle()", MB_ICONEXCLAMATION);
LocalFree( lpMsgBuf );
}
vmessage("Operating-system handle to COM port closed");
com_open = false;
}
}
const char* MultiplexerInterface::GetLastErrorContextString()
{
switch(LastErrorContext)
{
case COM_ERRCONTEXT_NO_ERROR : return "<<<NO ERROR>>>";
case OPENING_PORT : return "opening";
case SETTING_BUFSIZES : return "setting buffer sizes";
case READING_DCB : return "reading settings for";
case WRITING_DCB : return "changing settings for";
case WRITING_TIMEOUTS : return "changing timeout settings for";
case READING_DATA : return "reading data from";
case WRITING_DATA : return "writing data to";
default : return "<<<BAD ERROR CONTEXT CODE>>>";
}
}
//****************************************************************************************
// Channel buffer status functions
//
// These functions return status information about the data buffers for each
// channel. They are safe to call from any thread at any time.
//
// returns true if device at address is a multiplexer (and thus has subchannels)
bool MultiplexerInterface::IsCascaded(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if((addr > 6) || !cascaded[addr])
return false;
return true;
}
else
{
// to do: resolve cascaded address
return false;
}
}
unsigned MultiplexerInterface::GetTxBufFree(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
int count;
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetTxBufFree()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return 0;
}
count = tbuf_enqueue_idx[addr] - tbuf_dequeue_idx[addr];
if(count < 0)
count += mux_interface_txbufsize;
return (mux_interface_txbufsize - 1) - count;
}
else
{
// to do: resolve cascaded address
return 0;
}
}
unsigned MultiplexerInterface::GetRxBufCount(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
int count;
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetRxBufCount()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return 0;
}
count = rbuf_enqueue_idx[addr] - rbuf_dequeue_idx[addr];
if(count < 0)
count += mux_interface_rxbufsize;
return count;
}
else
{
// to do: resolve cascaded address
return 0;
}
}
//****************************************************************************************
// Channel buffer access functions
//
// These functions allow the receive buffers for each channel to be read and
// the transmit buffers for each channel to be written. Although it is safe
// for any one thread to access any channel's buffer via these functions it is
// not safe for more than one thread to access any one particular buffer.
//
// By convention, channels 0..6 should be accessed only by the worker thread
// or higher-level driver threads if they are not cascaded. Cascaded addresses
// should only be accessed by the MultiplexerInterface main driver thread.
//
// Channel 7's receive buffer should only be read by the MultiplexerInterface
// main driver thread. Channel 7's transmit buffer should only be written
// by the worker thread or higher-level driver threads.
//
// All receive buffers are written by the MultiplexerInterface main driver
// thread. All transmit buffers are read by the MultiplexerInterface main
// driver thread.
//
unsigned MultiplexerInterface::WriteTxBuf(const char* address, void *buffer, unsigned count)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::WriteTxBuf()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return 0;
}
// To do: convert to using memcpy() instead of PutTxChar()
// if performance is important
unsigned i = 0;
char *cp = (char*)buffer;
while( (i < count) && PutTxChar(address, cp[i]) )
i++;
return i;
}
else
{
// to do: resolve cascaded address
return 0;
}
}
unsigned MultiplexerInterface::ReadRxBuf(const char* address, void *buffer, unsigned count)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::ReadRxBuf()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return 0;
}
// To do: convert to using memcpy() instead of GetRxChar()
// if performance is important
unsigned i = 0;
char *cp = (char*)buffer;
while( (i < count) && GetRxChar(address, cp + i) )
i++;
return i;
}
else
{
// to do: resolve cascaded address
return 0;
}
}
bool MultiplexerInterface::PutTxChar(const char* address, char c)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
unsigned ttei;
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::PutTxChar()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return false;
}
ttei = (tbuf_enqueue_idx[addr] + 1) & mux_interface_txbufmask;
if(ttei == tbuf_dequeue_idx[addr])
return false;
tbuf[addr][tbuf_enqueue_idx[addr]] = c;
tbuf_enqueue_idx[addr] = ttei;
return true;
}
else
{
// to do: resolve cascaded address
message("Cascaded Address in call to MultiplexerInterface::PutTxChar() is not yet supported", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return false;
}
}
bool MultiplexerInterface::GetRxChar(const char* address, char *c)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetRxChar()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return false;
}
if(rbuf_dequeue_idx[addr] == rbuf_enqueue_idx[addr])
return false;
*c = rbuf[addr][rbuf_dequeue_idx[addr]];
rbuf_dequeue_idx[addr]++;
rbuf_dequeue_idx[addr] &= mux_interface_rxbufmask;
return true;
}
else
{
// to do: resolve cascaded address
return false;
}
}
//****************************************************************************************
// High-performance (direct access) channel buffer access functions
//
// These functions allow the caller to obtain pointers to the actual buffers
// and buffer enqueue and dequeue indexes so that the caller may write to
// transmit buffers and read from receive buffers directly (avoiding the
// call overhead of the higher-level access functions).
//
// The pointers returned by these functions are valid as long as the object
// is in scope.
//
// Although it is safe for any one thread to access any buffer, it is not safe
// for more than one thread to access any one particular transmit buffer.
// Receive buffers may be accessed by any number of threads.
//
// By convention, channels 0..6 should be accessed only by the worker thread
// or higher-level driver threads if they are not cascaded. Cascaded addresses
// should only be accessed by the MultiplexerInterface main driver thread.
//
// Channel 7's receive buffer should only be read by the MultiplexerInterface
// main driver thread. Channel 7's transmit buffer should only be written
// by the worker thread or higher-level driver threads.
//
// All receive buffers are written by the MultiplexerInterface main driver
// thread. All transmit buffers are read by the MultiplexerInterface main
// driver thread.
//
// Note that the dequeue indexes for the receive buffers may not be obtained
// via these functions ... the Rx dequeue indexes are only for use by the
// higher-level buffer access functions. The caller of these functions is
// expected to maintain its own independent dequeue index. Two consequences
// of this scheme are:
//
// 1). Multiple sinks may be attached to each receive stream. Each sink
// will receive a copy of all of the data received and there is no
// need for sinks to consume data synchronously (or for them to belong
// to the same thread, for that matter).
//
// 2). Receive buffer overruns are not detected ... if a receive buffer
// overrun ever occurs the result would be that the enqueue index
// laps the dequeue index and thus one full buffer worth of data
// would be lost.
//
const unsigned* MultiplexerInterface::GetRxEnqueueIdx(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetRxEnqueueIdx()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return NULL;
}
return &(rbuf_enqueue_idx[addr]);
}
else
{
// to do: resolve cascaded address
return NULL;
}
}
const char* MultiplexerInterface::GetRxBuf(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetRxBuf()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return NULL;
}
return rbuf[addr];
}
else
{
// to do: resolve cascaded address
return NULL;
}
}
const unsigned* MultiplexerInterface::GetTxDequeueIdx(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetTxDequeueIdx()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return NULL;
}
return &(tbuf_dequeue_idx[addr]);
}
else
{
// to do: resolve cascaded address
return NULL;
}
}
unsigned* MultiplexerInterface::GetTxEnqueueIdx(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetTxEnqueueIdx()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return NULL;
}
return &(tbuf_enqueue_idx[addr]);
}
else
{
// to do: resolve cascaded address
return NULL;
}
}
char* MultiplexerInterface::GetTxBuf(const char* address)
{
if( address[1] == 0 )
{
unsigned addr = address[0] - '0';
if(addr > 7)
{
message("Invalid Address in call to MultiplexerInterface::GetTxBuf()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return NULL;
}
return tbuf[addr];
}
else
{
// to do: resolve cascaded address
return NULL;
}
}
//-------------------------------------------------------------------------------
// Sets the "break" condition on the specified port (NULL = PC's COM port)
// for 200ms and then clears the "break" condition and resets the port's
// baud rate to 2400.
//
// If a multiplexer is attached to the specified port then it will reset its
// baud rate to 2400 and reset its internal buffers and slave ports.
//
bool MultiplexerInterface::Break(const char* address)
{
if(address == NULL) { // root -- this PC's COM port
bool rval;
vmessage("Suspending driver thread activity");
suspend_activity = true;
while( read_in_progress || write_in_progress )
Sleep(0);
Sleep(0); // make sure other threads have really seen the suspend_activity flag
while( read_in_progress || write_in_progress )
Sleep(0);
vmessage("Setting COM break");
SetCommBreak(hCom);
Sleep(200);
vmessage("Clearing COM break");
ClearCommBreak(hCom);
vmessage("Re-opening port at 2400 baud");
rval = OpenPort(last_port_number, CBR_2400); // will close port if already opened and then re-open with new baud rate
return rval;
}
if(address[1] == 0) { // address terminates on this multiplexer
unsigned addr = address[0] - '0';
unsigned u;
if(addr > 6)
{
message("Invalid Address in call to MultiplexerInterface::Break()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return false;
}
if( !ReadByte(0X18, &u, address) ) // RCSTA -- save CREN bit
return false;
if( !WriteByte(0X18, 0, address) ) // RCSTA -- disable COM port
return false;
if( !WriteByte(0X07, 0, address) ) // PORTC -- set break condition
return false;
Sleep(200);
if( !WriteWord(0X98, 0X8120, address) ) // TXSTA and SPBRG -- set 2400 baud
return false;
if( !WriteByte(0X18, u | 0X80, address) ) // RCSTA -- enable COM port
return false;
return true;
}
else { // to do: resolve addresses on cascaded multiplexer
return false;
}
}
//------------------------------------------------------------------------------
// Change the baud rate for the specified port (NULL = PC's COM port)
//
// If the specified port is connected to a multiplexer (root or cascaded)
// then the following additional actions are taken:
// 1). A "break" is sent on the line to force the multiplexer to 2400 baud
// 2). Dummy packets are sent to assure that the multiplexer's receiver
// is in-phase with the packet stream
// 3). The multiplexer is commanded to set its baud rate to the new setting
// 4). The port to which the multiplexer is connected is set to the new rate
// 5). More dummy packets are sent to assure correct receiver packet phase
bool MultiplexerInterface::SetBaudRate(DWORD baud_rate, const char* address)
{
// To do: resolve cascaded addresses
unsigned char spbrg;
unsigned char txsta = 0x20;
CString s;
Checksum c;
char *brt;
bool rval;
unsigned u;
switch(baud_rate)
{
case CBR_2400 :
spbrg = 129; //2404
brt = "2400";
break;
case CBR_4800 :
spbrg = 65; //4735
brt = "4800";
break;
case CBR_9600 :
spbrg = 32; //9470
brt = "9600";
break;
case CBR_14400 :
spbrg = 21; //14205
brt = "14400";
break;
case CBR_19200 :
spbrg = 15; //19531
brt = "19200";
break;
case CBR_38400 :
spbrg = 7; //39062
brt = "38400";
break;
/* These baud rates don't work -- the MCU's SCI module is too sensitive
to baud rate errors when BRGH is set.
case CBR_56000 :
// txsta = 0X24;
txsta = 0X65; // 9 bit transmission ... 9th bit is high
spbrg = 21; //56818
brt = "56000";
break;
case CBR_115200 :
txsta = 0X65;
spbrg = 10; //113636
brt = "115200";
break;
case CBR_128000 :
txsta = 0X65;
spbrg = 9; //125000
brt = "128000";
break;
case CBR_256000 :
txsta = 0X65;
spbrg = 4; //250000
brt = "256000";
break;
*/
default :
message("Illegal baud rate in call to MultiplexerInterface::SetBaudRate()", true);
return false; // baud rate not supported
}
if(address == NULL) { // root -- set baud rate of PC's COM port and master MCU
s.Format("Setting baud rate to %s", brt);
message(s);
/*
if( doc && doc->thread_safe_settings )
{
s.Format("SPBRG tweak %i orig spbrg %i new spbrg %i",
doc->thread_safe_settings->spbrg_tweak,
spbrg,
spbrg + doc->thread_safe_settings->spbrg_tweak);
message(s);
spbrg += doc->thread_safe_settings->spbrg_tweak;
}
*/
Break(address);
tail_msg("Establishing link...");
vmessage("Sending pre-control packet dummy packets");
PutTxChar("7", '.'); // send dummy packets to re-establish packet phase incase it was thrown off
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
vmessage("Sending TXSTA and SPBRG control packet");
PutTxChar("7", '@');
PutTxChar("7", 'B');
PutTxChar("7", txsta ^ 0X6C);
c.Add(txsta);
PutTxChar("7", spbrg ^ 0X35);
c.Add(spbrg);
PutTxChar("7", c.plain_checksum);
PutTxChar("7", (char)(c.cyclic_checksum));
PutTxChar("7", (char)(c.cyclic_checksum >> 8));
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
Sleep(100);
s.Format("Re-opening port at %s baud", brt);
vmessage(s);
rval = OpenPort(last_port_number, baud_rate); // will close port if already opened and then re-open with new baud rate
vmessage("Sending post-reopen dummy packets");
PutTxChar("7", '.'); // send dummy packets to re-establish packet phase incase it was thrown off
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
PutTxChar("7", '.');
while((tbuf_enqueue_idx[7] != tbuf_dequeue_idx[7]) || GetTxBytesQueued() || outq_growing)
Sleep(0);
vmessage("Finished resetting baud rate");
return rval;
}
else { // not master port ... set baud rate of a slave port
if( IsCascaded(address) ) {
Break(address);
s.Format("%s7", address); // address of control channel on multiplexer chained off of given address
tail_msg("Establishing cascaded link...");
vmessage("Pre baud rate change dummy register read");
if(!ReadByte(0X20, &u, s, 6)) { // dummy read from master MCU attached to slave MCU at <address> .. retries up to 6 times so that packet phase will be re-established
cascaded_relink_failed:
message("Failed to relink with cascaded multiplexer", true);
return false;
}
vmessage("Sending TXSTA and SPBRG control packet");
PutTxChar(s, '@');
PutTxChar(s, 'B');
PutTxChar(s, txsta ^ 0X6C);
c.Add(txsta);
PutTxChar(s, spbrg ^ 0X35);
c.Add(spbrg);
PutTxChar(s, c.plain_checksum);
PutTxChar(s, (char)(c.cyclic_checksum));
PutTxChar(s, (char)(c.cyclic_checksum >> 8));
Sleep(500); // wait long enough for packet to definitely reach its destination (there is no Ack)
}
s.Format("Changing slave port baud rate to %s", brt);
vmessage(s);
if(!WriteWord(0X98, ((unsigned)spbrg << 8) | (unsigned)txsta, address)) {
message("Failed to set slave port baud rate", true);
return false;
}
if( IsCascaded(address) ) {
vmessage("Post baud rate change dummy register read");
if(!ReadByte(0X20, &u, s, 6)) // dummy read from master MCU attached to slave MCU at <address> .. retries up to 6 times so that packet phase will be re-established
goto cascaded_relink_failed;
}
return true;
}
}
//-------------------------------------------------------------------------
// Enables reception (not valid for root .. root is always enabled)
//
// Returns true if successful
bool MultiplexerInterface::EnableInput(const char* address)
{
if(address[1] == 0) { // address terminates on this multiplexer
unsigned addr = address[0] - '0';
if(addr > 6)
{
message("Invalid Address in call to MultiplexerInterface::EnableInput()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return false;
}
return WriteByte(0X18, 0X90, address); // RCSTA
}
else { // to do: resolve addresses on cascaded multiplexer
return false;
}
}
//-------------------------------------------------------------------------
// Disables reception (not valid for root .. root is always enabled)
//
// Returns true if successful
bool MultiplexerInterface::DisableInput(const char* address)
{
if(address[1] == 0) { // address terminates on this multiplexer
unsigned addr = address[0] - '0';
if(addr > 6)
{
message("Invalid Address in call to MultiplexerInterface::EnableInput()", true);
CString s;
s.Format("Address specified = \"%s\"", address);
message(s, true);
return false;
}
return WriteByte(0X18, 0X80, address); // RCSTA
}
else { // to do: resolve addresses on cascaded multiplexer
return false;
}
}
//****************************************************************************************
// MCU interface functions
//
// These functions allow registers in the MCUs to be read and written.
// They all operate by sending command packets to the master MCU's control
// channel and then waiting for a response to be recieved by the main
// driver thread ( see ProcessCommandRx() ).
//
// The last two parameters of all of these functions specify the nubmer of
// times to atempt the operation and the number of timer tics (100ms per)
// to wait before giving up on each attempt. Both of these parametrs have
// default values (thus may be omitted).
//
// These functions may only be called by the worker thread or higher-level
// interface threads. The MultiplexerInterface driver threads and the main
// user-interface thread (responsible for timer) must both be running.
//
// These functions may only be called by one thread at a time (only one MCU
// interface function may be active at any given moment).
//
// The return values are true if successful.
//
bool MultiplexerInterface::WriteByte(unsigned register_address, unsigned value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = device_address << 5;
PutTxChar("7", '@');
PutTxChar("7", 'W');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
PutTxChar("7", (char)value);
check.Add((char)value);
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_write_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_write_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(!crx_write_response_received)
vmessage("WriteByte() timed out");
else
return true;
} while(--try_count);
vmessage("WriteByte() failed", true);
return false;
}
bool MultiplexerInterface::WriteWord(unsigned register_address, unsigned value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = (device_address << 5) | 1;
PutTxChar("7", '@');
PutTxChar("7", 'W');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
PutTxChar("7", (char)value);
check.Add((char)value);
PutTxChar("7", (char)(value >> 8));
check.Add((char)(value >> 8));
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_write_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_write_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(!crx_write_response_received)
vmessage("WriteWord() timed out");
else
return true;
} while(--try_count);
vmessage("WriteWord() failed", true);
return false;
}
bool MultiplexerInterface::WriteTriplet(unsigned register_address, unsigned value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = (device_address << 5) | 2;
PutTxChar("7", '@');
PutTxChar("7", 'W');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
PutTxChar("7", (char)value);
check.Add((char)value);
PutTxChar("7", (char)(value >> 8));
check.Add((char)(value >> 8));
PutTxChar("7", (char)(value >> 16));
check.Add((char)(value >> 16));
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_write_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_write_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(!crx_write_response_received)
vmessage("WriteTriplet() timed out");
else
return true;
} while(--try_count);
vmessage("WriteTriplet() failed", true);
return false;
}
bool MultiplexerInterface::WriteDWord(unsigned register_address, unsigned value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = (device_address << 5) | 3;
PutTxChar("7", '@');
PutTxChar("7", 'W');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
PutTxChar("7", (char)value);
check.Add((char)value);
PutTxChar("7", (char)(value >> 8));
check.Add((char)(value >> 8));
PutTxChar("7", (char)(value >> 16));
check.Add((char)(value >> 16));
PutTxChar("7", (char)(value >> 24));
check.Add((char)(value >> 24));
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_write_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_write_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(!crx_write_response_received)
vmessage("WriteDWord() timed out");
else
return true;
} while(--try_count);
vmessage("WriteDWord() failed", true);
return false;
}
bool MultiplexerInterface::ReadByte(unsigned register_address, unsigned* value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = device_address << 5;
PutTxChar("7", '@');
PutTxChar("7", 'R');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
reg_xfer_length = 1;
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_read_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_read_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(crx_read_response_received)
{
*value = reg_xfer >> 24;
return true;
}
vmessage("ReadByte() timed out");
} while(--try_count);
vmessage("ReadByte() failed", true);
return false;
}
bool MultiplexerInterface::ReadWord(unsigned register_address, unsigned* value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = (device_address << 5) | 1;
PutTxChar("7", '@');
PutTxChar("7", 'R');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
reg_xfer_length = 2;
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_read_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_read_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(crx_read_response_received)
{
*value = reg_xfer >> 16;
return true;
}
vmessage("ReadWord() timed out");
} while(--try_count);
vmessage("ReadWord() failed", true);
return false;
}
bool MultiplexerInterface::ReadTriplet(unsigned register_address, unsigned* value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = (device_address << 5) | 2;
PutTxChar("7", '@');
PutTxChar("7", 'R');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
reg_xfer_length = 3;
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_read_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_read_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(crx_read_response_received)
{
*value = reg_xfer >> 8;
return true;
}
vmessage("ReadTriplet() timed out");
} while(--try_count);
vmessage("ReadTriplet() failed", true);
return false;
}
bool MultiplexerInterface::ReadDWord(unsigned register_address, unsigned* value, const char* address, unsigned try_count, unsigned timeout)
{
// To do: resolve addresses longer than 1 char
do {
Checksum check;
char device_address;
char addrlen;
device_address = address[0] - '0';
addrlen = (device_address << 5) | 3;
PutTxChar("7", '@');
PutTxChar("7", 'R');
PutTxChar("7", addrlen);
check.Add(addrlen);
PutTxChar("7", (char)register_address);
check.Add((char)register_address);
reg_xfer_length = 4;
reg_xfer_xs = check.plain_checksum;
reg_xfer_cl = (char)(check.cyclic_checksum);
reg_xfer_ch = (char)(check.cyclic_checksum >> 8);
crx_read_response_received = false;
PutTxChar("7", reg_xfer_xs);
PutTxChar("7", reg_xfer_cl);
PutTxChar("7", reg_xfer_ch);
assert(doc);
doc->countdown_timer = timeout;
while(!crx_read_response_received && doc->countdown_timer)
Sleep(0); // wait for other thread to send request and receive and interpret response
if(crx_read_response_received)
{
*value = reg_xfer;
return true;
}
vmessage("ReadDWord() timed out");
} while(--try_count);
vmessage("ReadDWord() failed", true);
return false;
}
//*******************************************************************************
// Communications interface driver
//
// The following procedures are responsible for implementing the packet
// transport protocol. There are 2 threads associated with the driver
// functions -- a "main driver" thread and an "output driver" thread.
//
// The main driver thread is responsible for receiving input from the
// COM port, encoding and decoding packets, and moving data in and out
// of the channel buffers.
//
// The output driver thread is responsible for moving data form the
// output queue to the COM port. A seperate thread was needed for this
// function because the Windows COM port interface functions only provide
// 2 modes of operation -- "synchronous" and "asynchronous". These
// driver functions need to read data synchronously (read all available
// data and not wait or keep a pending operation running) but write
// data asynchronously. The 2nd thread allows the writing of data to
// be asynchronous as far as the main driver thread is concerned.
//
//
// These driver functions implement a layer between the COM port and the
// channel buffers. Other threads simply write the transmit channel buffers
// and read the receive channel buffers (with the exception of the
// channel 7 buffers).
//
// The channel 7 buffers are connected to the master MCU's control channel
// and thus have special functionality. Data arriving in the channel 7
// receive buffer is further processed by these driver functions ...
// control packet contents are extracted and made availible in the reg_xfer_
// data members of the MultiplexerInterface object. A set of mid-level
// MultiplexerInterface methods use channel 7 and the reg_xfer_ members
// to facilitate reading and writing MCU registers.
//
// ------------------------------------------------------------------------------
// Main driver thread procedure
//
// Only the MultiplexerInterface object which owns the COM port owns a driver
// thread. Cascaded MultiplexerInterface objects have their ChildTimeSlice()
// procedures called by their parents.
//
// This procedure is responsible for calling the TimeSlice() procedure and
// relinquishing unneeded thread time. It is also responsible for cleaning up
// and exiting the thread if fExitDriverThread is set.
void MultiplexerInterface::Driver()
{
InitializeDriverState();
if(!fOutputDriverThreadRunning) {
fExitOutputDriverThread = false;
TRACE("Starting output driver thread\n");
AfxBeginThread(OutputDriverThreadProc, this);
}
while( !fExitDriverThread )
{
if( !TimeSlice() && !fExitDriverThread )
// timeslice and all child timeslices emptied their input buffers on the last go-around ...
// suspend thread for 50ms ... enough time for about 190 characters to arrive at 38.4 kbaud
Sleep(50);
}
fExitOutputDriverThread = true;
TRACE("Stopping output driver thread\n");
while(fOutputDriverThreadRunning)
Sleep(0);
for( int i = 0; i < 8; i++ ) {
if( cascaded[i] ) {
delete cascaded[i];
cascaded[i] = NULL;
}
}
}
// ------------------------------------------------------------------------------
// Output Driver thread procedure
//
// Only the MultiplexerInterface object which owns the COM port owns an output
// driver thread.
//
// This procedure is responsible for calling the ODTimeSlice() procedure and
// relinquishing unneeded thread time. It is also responsible for cleaning up
// and exiting the thread if fExitDriverThread is set.
void MultiplexerInterface::OutputDriver()
{
// LastErrorString.Format("Output driver thread started");
// error_flag = true;
TRACE("Output driver thread started\n");
while( !fExitOutputDriverThread )
{
if( !ODTimeSlice() && !fExitOutputDriverThread )
// output buffer emptied on last iteration...
// suspend thread for 50ms ... enough time for about 190 characters to arrive at 38.4 kbaud
Sleep(50);
}
TRACE("Output driver thread exiting\n");
}
// ------------------------------------------------------------------------------
// Perform driver/interface duties for one timeslice (timeslice is relenquished
// when this function returns). This is the root controller's driver function
// which interfaces to the COM port.
//
// Accepts input and spools out output. Packages and unpackages data to/from
// routing packets. Gives thread time to all its children.
//
// This function processes 1024 input characters at most before returning so
// that any pending events (i.e. fExitDriverThread) don't wait too long.
//
// Returns true if the input buffer still contains more than 1024 bytes worth
// of data (and thus another TimeSlice is needed right away).
//
// This function is called by the main driver thread.
bool MultiplexerInterface::TimeSlice()
{
char szBuf[1024];
DWORD bytes_read;
int i;
if(suspend_activity)
return false;
// Read as much as is available or 1024 bytes, whichever is less, from the
// operating system's COM port input buffer
read_in_progress = true;
if(!suspend_activity)
{
if( !ReadFile( hCom, szBuf, sizeof(szBuf), &bytes_read, NULL ) )
{
LastError = ::GetLastError();
LastErrorContext = READING_DATA;
LPVOID lpMsgBuf;
FormatMessage(
FORMAT_MESSAGE_ALLOCATE_BUFFER | FORMAT_MESSAGE_FROM_SYSTEM, NULL,
::GetLastError(),
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), // Default language
(LPTSTR) &lpMsgBuf, 0, NULL ); // Display the string.
LastErrorString.Format("Error reading from COM port: %s", lpMsgBuf);
TrimTrailingJunk(LastErrorString);
LocalFree( lpMsgBuf );
error_flag = true;
}
read_in_progress = false;
// Process the data received
// (decode packets and route data to specified channels' receive buffers)
if( bytes_read != 0 )
AcceptInput(szBuf, bytes_read);
} // if(!suspend_activity)
read_in_progress = false;
// Give time to child MultiplexerInterface objects
for( i = 0; i < 8; i++ ) {
if( cascaded[i] )
cascaded[i]->ChildTimeSlice();
}
// Process queued data from one channel's transmit buffer
// (encode a packet and put it in the output queue)
i = 8;
bool sent_data = false;
do {
if( tbuf_enqueue_idx[transmit_channel] != tbuf_dequeue_idx[transmit_channel] ) { // have any data to send?
unsigned starting_outq_free = outq_free;
unsigned updated_outq_free = starting_outq_free; // pass this to EncodeOutput so that semaphores don't need to be checked for every byte written
outq_growing = true;
EncodeOutput(transmit_channel, outq, &outq_enqueue_idx, &updated_outq_free, mux_interface_outqueuemask);
sent_data = true;
starting_outq_free -= updated_outq_free; // number of bytes added to queue
while(outq_free_outer_lock || outq_free_critical_section)
Sleep(0);
outq_free_outer_lock = true;
while(outq_free_critical_section)
Sleep(0);
outq_free_critical_section = true;
outq_free -= starting_outq_free;
outq_free_critical_section = false;
outq_free_outer_lock = false;
outq_growing = false;
}
transmit_channel++;
transmit_channel &= 7;
} while( --i && !sent_data );
if(rbuf_enqueue_idx[7] != rbuf_dequeue_idx[7])
ProcessCommandRx(); // interpret data from command interpreter channel
return (bytes_read == sizeof(szBuf)) ? true : false;
}
//---------------------------------------------------------------
// Process data received from the control channel (channel 7)
//
// Decodes control packets.
// This function is called by the main driver thread.
void MultiplexerInterface::ProcessCommandRx()
{
unsigned char c;
while( rbuf_dequeue_idx[7] != rbuf_enqueue_idx[7] )
{
c = rbuf[7][rbuf_dequeue_idx[7]];
rbuf_dequeue_idx[7]++;
rbuf_dequeue_idx[7] &= mux_interface_rxbufmask;
// CString str;
// str.Format("CRX %.2X state %i", c & 0XFF, crx_state);
// message(str);
switch(crx_state)
{
case 0 :
crx_state = (c == '@') ? 1 : 0;
break;
case 1 :
switch(c)
{
case 'r' :
crx_state = 2;
break;
case 'w' :
crx_state = 12;
break;
default :
crx_state = 0;
break;
}
break;
case 2 :
crx_state = (c == reg_xfer_xs) ? 3 : 0;
break;
case 3 :
crx_state = (c == reg_xfer_cl) ? 4 : 0;
break;
case 4 :
crx_state = (c == reg_xfer_ch) ? (9 - reg_xfer_length) : 0;
crx_check.Clear();
reg_xfer = 0;
break;
case 5 :
reg_xfer |= (unsigned)c;
crx_check.Add(c);
crx_state++;
break;
case 6 :
reg_xfer |= (unsigned)c << 8;
crx_check.Add(c);
crx_state++;
break;
case 7 :
reg_xfer |= (unsigned)c << 16;
crx_check.Add(c);
crx_state++;
break;
case 8 :
reg_xfer |= (unsigned)c << 24;
crx_check.Add(c);
crx_state++;
break;
case 9 :
crx_state = (c == crx_check.plain_checksum) ? 10 : 0;
break;
case 10 :
crx_state = (c == (unsigned char)(crx_check.cyclic_checksum)) ? 11 : 0;
break;
case 11 :
if(c == (unsigned char)(crx_check.cyclic_checksum >> 8))
crx_read_response_received = true;
crx_state = 0;
break;
case 12 :
crx_state = (c == reg_xfer_xs) ? 13 : 0;
break;
case 13 :
crx_state = (c == reg_xfer_cl) ? 14 : 0;
break;
case 14 :
if(c == reg_xfer_ch)
crx_write_response_received = true;
crx_state = 0;
break;
}
if( crx_state == 0 )
crx_state = (c == '@') ? 1 : 0;
}
}
//----------------------------------------------------------------------------
// Output driver timeslice
//
// Writes data from outq to the COM port ... runs in its own thread since the
// operating-system's COM write does not return until all bytes have been sent.
// Writes and reads are thus overlapped.
//
// Returns false if outq was empty (and thus the thread can sleep)
// Returns true if data was written (and thus another timeslice is needed)
//
// This function is called by the output driver thread procedure.
bool MultiplexerInterface::ODTimeSlice()
{
if(suspend_activity)
return false;
// If there is anything in the output queue then write as much of it as possible
// to the operating system's COM port output buffer
write_in_progress = true;
if( (outq_free < (mux_interface_outqueuesize - 1)) && !suspend_activity )
{
// The write will need to be split into 2 parts if the dequeue index would
// wrap around to the buffer start on its way to catch up with the enqueue
// index. Calculate the particulars of each write necessary.
char* block1_ptr = outq + outq_dequeue_idx;
// pointer to first chunk of data to write
unsigned bytes_queued = (mux_interface_outqueuesize - 1) - outq_free;
unsigned v_endidx = outq_dequeue_idx + bytes_queued;
// virtual end index -- where the enqueue index would be if it didn't wrap around at the end of the buffer
unsigned block1_endidx = (v_endidx > mux_interface_outqueuesize) ? mux_interface_outqueuesize : v_endidx;
// where block1 actually ends (taking the end of the buffer into account)
unsigned block1_size = block1_endidx - outq_dequeue_idx;
unsigned block2_size = bytes_queued - block1_size;
// block2 starts at the beginning of the buffer and will normally be null
DWORD bytes_written;
if(!com_open) { // if port not open then just discard the data so other processes don't hang
bytes_written = block1_size;
goto skip_write1;
}
// vmessage("Writing block1");
if( !WriteFile( hCom, block1_ptr, block1_size, &bytes_written, NULL ) & 0 )
{
vmessage("Error writing block1");
LastError = ::GetLastError();
LastErrorContext = WRITING_DATA;
LPVOID lpMsgBuf;
FormatMessage(
FORMAT_MESSAGE_ALLOCATE_BUFFER | FORMAT_MESSAGE_FROM_SYSTEM, NULL,
::GetLastError(),
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), // Default language
(LPTSTR) &lpMsgBuf, 0, NULL ); // Display the string.
LastErrorString.Format("Error writing to COM port: %s", lpMsgBuf);
TrimTrailingJunk(LastErrorString);
LocalFree( lpMsgBuf );
error_flag = true;
}
else
{
// vmessage("Finished writing block1");
skip_write1:
write_in_progress = false;
outq_dequeue_idx += bytes_written;
outq_dequeue_idx &= mux_interface_outqueuemask;
while(outq_free_outer_lock || outq_free_critical_section)
Sleep(0);
outq_free_outer_lock = true;
while(outq_free_critical_section)
Sleep(0);
outq_free_critical_section = true;
outq_free += bytes_written;
outq_free_critical_section = false;
outq_free_outer_lock = false;
last_tx_request = block1_size;
last_tx = bytes_written;
}
write_in_progress = true;
// Write the second block if it is non-null and the first block was completely written
// (operating system's buffer isn't full)
if( block2_size && (bytes_written == block1_size) && !suspend_activity )
{
if(!com_open) { // if port not open then just discard the data so other processes don't hang
bytes_written = block1_size;
goto skip_write2;
}
// vmessage("Writing block2");
if( !WriteFile( hCom, outq, block2_size, &bytes_written, NULL ) & 0 )
{
vmessage("Error writing block2");
LastError = ::GetLastError();
LastErrorContext = WRITING_DATA;
LPVOID lpMsgBuf;
FormatMessage(
FORMAT_MESSAGE_ALLOCATE_BUFFER | FORMAT_MESSAGE_FROM_SYSTEM, NULL,
::GetLastError(),
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), // Default language
(LPTSTR) &lpMsgBuf, 0, NULL ); // Display the string.
LastErrorString.Format("Error writing to COM port: %s", lpMsgBuf);
TrimTrailingJunk(LastErrorString);
LocalFree( lpMsgBuf );
error_flag = true;
}
else
{
// vmessage("Finished writing block2");
skip_write2:
write_in_progress = false;
outq_dequeue_idx += bytes_written;
outq_dequeue_idx &= mux_interface_outqueuemask;
while(outq_free_outer_lock || outq_free_critical_section)
Sleep(0);
outq_free_outer_lock = true;
while(outq_free_critical_section)
Sleep(0);
outq_free_critical_section = true;
outq_free += bytes_written;
outq_free_critical_section = false;
outq_free_outer_lock = false;
last_tx_request = block2_size;
last_tx = bytes_written;
}
} // if there is block2 data to write
write_in_progress = false;
return true; // need another timeslice
} // if there is any data in the output queue
else
{
if(!error_flag && (outq_dequeue_idx != outq_enqueue_idx) && !outq_growing)
{
LastErrorString.Format("outq_dequeue_idx %u outq_enqueue_idx %u", outq_dequeue_idx, outq_enqueue_idx);
error_flag = true;
}
write_in_progress = false;
return false; // nothing to do ... sleep for awhile
}
}
// ------------------------------------------------------------------------------
// Perform driver/interface duties for one timeslice (timeslice is relenquished
// when this function returns). This is a child controller's driver function
// which interfaces to a parent controller.
//
// Accepts input and spools out output. Packages and unpackages data to/from
// routing packets. Gives thread time to all its children.
void MultiplexerInterface::ChildTimeSlice()
{
}
// ------------------------------------------------------------------------------
// Accept input data.
//
// The input data may come from the COM port or a parent multiplexer object.
// This function decodes packets and moves contents into the channel receive
// buffers for the channels to which the packets were addressed.
//
// This function is called by the main driver thread.
void MultiplexerInterface::AcceptInput(char* buf, unsigned count)
{
character_count += count;
for( unsigned i = 0; i < count; i++ )
{
unsigned char c = buf[i];
switch( receiver_state )
{
case 0 :
retest_case0:
receiver_state = (c == '@') ? 1 : 0;
break;
case 1 :
if( c != 'P' )
goto retest_case0;
else
receiver_state++;
break;
case 2 : // length and address
packet_size = (c & 0x1f) + 1;
packet_channel = (c & 0xe0) >> 5;
rx_checksum.Clear();
rx_checksum.Add(c);
receiver_state++;
break;
case 3 :
serial = c; // low byte of serial number
rx_checksum.Add(c);
receiver_state++;
break;
case 4 :
serial += (unsigned)c << 8; // high byte of serial number
rx_checksum.Add(c);
rx_substate = packet_size; // packet byte counter
tei = rbuf_enqueue_idx[packet_channel]; // tentative enqueue index
// toc = 0; // tentative overrun count
receiver_state++;
break;
case 5 :
{
char oc;
rbuf[packet_channel][tei] = oc = c ^ (unsigned char)(rx_checksum.cyclic_checksum);
rx_checksum.Add(oc);
receiver_state = (--rx_substate) ? 5 : 6;
tei++;
tei &= mux_interface_rxbufmask;
// if( tei == rbuf_dequeue_idx[packet_channel] )
// {
// tei = --tei & mux_interface_rxbufmask;
// toc++;
// }
}
break;
case 6 :
if( c == rx_checksum.plain_checksum )
receiver_state = 7;
else
{
bad_packet_count++;
fail_count1++;
goto retest_case0;
}
break;
case 7 :
if( c == (unsigned char)(rx_checksum.cyclic_checksum) )
receiver_state = 8;
else
{
bad_packet_count++;
fail_count2++;
goto retest_case0;
}
break;
case 8 :
if( c == (unsigned char)(rx_checksum.cyclic_checksum >> 8) )
{
receiver_state = 0;
packets++;
rbuf_enqueue_idx[packet_channel] = tei;
// rbuf_overrun_count[packet_channel] += toc;
if( prior_serial_initialized )
missing_packet_count += (unsigned short)serial - (unsigned short)(prior_serial + 1);
prior_serial = serial;
prior_serial_initialized = true;
}
else
{
bad_packet_count++;
fail_count3++;
goto retest_case0;
}
break;
}
}
}
// ------------------------------------------------------------------------------
// Encode output data packet.
//
// Encodes all of the data from the specified channel's transmit buffer into
// packets. Data is written to the buffer specified (allowing this function to
// work for root as well as child MultiplexerInterface objects).
//
// Precondition:
// channel specifies which transmit buffer to take the data from
// and that channel's transmit buffer contains data
// buf points to the output buffer to write the packet to
// *enq_idx is an index into the output buffer of the enqueue location
// *free is the number of bytes free in the output buffer
// idx_mask is an AND mask for updating *enq_idx (rolling it over to the start of the buffer)
//
// Postcondition:
// a packet was written to the specified output buffer (if it fits)
// *enq_idx and *free are updated
// the channel's transmit buffer is empty (unless output buffer is full)
//
// This function is called by the MultiplexerInterface main driver thread.
void MultiplexerInterface::EncodeOutput(int channel, char* buf, unsigned* enq_idx, unsigned* free, unsigned idx_mask)
{
int packet_size;
Checksum tx_checksum;
char c;
do {
tx_checksum.Clear();
packet_size = tbuf_enqueue_idx[channel] - tbuf_dequeue_idx[channel];
if(packet_size < 0)
packet_size += mux_interface_txbufsize;
assert( packet_size > 0 );
if( packet_size > 32 )
packet_size = 32;
if( ((unsigned)packet_size + 8) > *free )
return; // Output buffer is too full to accept the packet
EnqueueOutc( '@', buf, enq_idx, free, idx_mask );
EnqueueOutc( 'P', buf, enq_idx, free, idx_mask );
c = (packet_size - 1) | (channel << 5);
EnqueueOutc( c, buf, enq_idx, free, idx_mask );
tx_checksum.Add(c);
c = transmit_serial & 0XFF;
EnqueueOutc( c, buf, enq_idx, free, idx_mask );
tx_checksum.Add(c);
c = (transmit_serial >> 8) & 0XFF;
EnqueueOutc( c, buf, enq_idx, free, idx_mask );
tx_checksum.Add(c);
for( int i = packet_size; i > 0; i-- )
{
c = tbuf[channel][tbuf_dequeue_idx[channel]];
tbuf_dequeue_idx[channel]++;
tbuf_dequeue_idx[channel] &= mux_interface_txbufmask;
EnqueueOutc( c ^ (char)(tx_checksum.cyclic_checksum), buf, enq_idx, free, idx_mask );
tx_checksum.Add(c);
}
c = tx_checksum.plain_checksum;
EnqueueOutc( c, buf, enq_idx, free, idx_mask );
c = (char)(tx_checksum.cyclic_checksum);
EnqueueOutc( c, buf, enq_idx, free, idx_mask );
c = (char)(tx_checksum.cyclic_checksum >> 8);
EnqueueOutc( c, buf, enq_idx, free, idx_mask );
} while( tbuf_enqueue_idx[channel] != tbuf_dequeue_idx[channel] );
}
| file: /Techref/scenix/lib/io/osi2/serial/sermuxcpp.htm, 72KB, , updated: 2000/1/6 12:06, local time: 2024/11/20 05:31,
18.118.121.114:LOG IN
|
| ©2024 These pages are served without commercial sponsorship. (No popup ads, etc...).Bandwidth abuse increases hosting cost forcing sponsorship or shutdown. This server aggressively defends against automated copying for any reason including offline viewing, duplication, etc... Please respect this requirement and DO NOT RIP THIS SITE. Questions? <A HREF="http://linistepper.com/techref/scenix/lib/io/osi2/serial/sermuxcpp.htm"> Ken's Web Server -- /cgi-bin/tl.exe/Timemon/monitor/MultiplexerInterface.cpp</A> |
| Did you find what you needed? |