//Copyright+LGPL
//-----------------------------------------------------------------------------------------------------------------------------------------------
// Copyright 2000-2013 Makoto Mori, Nobuyuki Oba
//-----------------------------------------------------------------------------------------------------------------------------------------------
// This file is part of MMTTY.
// MMTTY is free software: you can redistribute it and/or modify it under the terms of the GNU Lesser General Public License
// as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version.
// MMTTY is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more details.
// You should have received a copy of the GNU Lesser General Public License along with MMTTY. If not, see
// .
//-----------------------------------------------------------------------------------------------------------------------------------------------
//---------------------------------------------------------------------------
#include
#pragma hdrstop
#include "Comm.h"
#include "ComLib.h"
#define WAITSTAT 0
#define DEFFSOUND 3
COMMPARA COMM;
void InitCOMMPara(void)
{
COMM.change = 1;
}
__fastcall CComm::CComm(bool CreateSuspended)
: TThread(CreateSuspended)
{
m_CreateON = FALSE; // クリエイトフラグ
m_Command = 0;
m_fHnd = NULL; // ファイルハンドル
m_inv = 0;
m_Execute = 0;
m_txwp = m_txrp = m_txcnt = 0;
m_TxEnb = 0;
m_figout = 0;
m_idle = 0;
m_WaitTimerCount = 0;
m_nextcount = 0;
pMod = NULL;
m_pEXT = NULL;
}
void __fastcall CComm::WaitTXD(int w)
{
if( w ){
#if 0
ULONG tim = ::GetTickCount();
ULONG w = ((pMod->m_ReCount*(pMod->m_BitLen + 1.5) ) + (w * pMod->m_ReCount/3)) * 1000 / SampFreq;
tim += w;
if( w > 10 )::Sleep(w - 10);
while(tim >= ::GetTickCount()) ::Sleep(0);
#else
::Sleep(((pMod->m_ReCount*(pMod->m_BitLen + 1.5) ) + (w * pMod->m_ReCount/3)) * 1000 / SampFreq);
#endif
}
}
void __fastcall CComm::NextBuf(void)
{
m_txrp++;
if( m_txrp >= COMM_TXBUFSIZE ){
m_txrp = 0;
}
m_txcnt--;
FSKCount1++;
FSKCount--;
}
void __fastcall CComm::EnbTX(int sw)
{
m_TxEnb = 0;
if( !sw ){
FSKCount1 = 1000;
FSKCount2 = 0;
}
else {
m_WaitTimerCount = 4;
m_FirstGaurd = TRUE;
FSKCount1 = 0;
FSKCount2 = 0;
FSKDeff = 0;
}
m_txwp = m_txrp = m_txcnt = 0;
FSKCount = 0;
m_figout = 0;
m_idle = 0;
m_TxEnb = sw;
}
void __fastcall CComm::Timer(void)
{
if( m_CreateON ){
if( sys.m_TxPort ){
if( m_fHnd == NULL ) return;
if( !m_TxEnb ) return;
if( m_DisDiddle != pMod->m_DisDiddle ){
m_DisDiddle = pMod->m_DisDiddle;
}
}
}
}
//-----------------------------------------------------------------
// DTRで符号送信用
void __fastcall CComm::OutData(BYTE d)
{
const BYTE tbl[]={
0x00, 0x10, 0x08, 0x18, // 00000 10000 01000 11000
0x04, 0x14, 0x0c, 0x1c, // 00100 10100 01100 11100
0x02, 0x12, 0x0a, 0x1a, // 00010 10010 01010 11010
0x06, 0x16, 0x0e, 0x1e, // 00110 10110 01110 11110
0x01, 0x11, 0x09, 0x19, // 00001 10001 01001 11001
0x05, 0x15, 0x0d, 0x1d, // 00101 10101 01101 11101
0x03, 0x13, 0x0b, 0x1b, // 00011 10011 01011 11011
0x07, 0x17, 0x0f, 0x1f, // 00111 10111 01111 11111
};
if( m_CreateON == FALSE ) return;
if( pMod->m_BitLen <= 6 ){
d = tbl[d & 0x001f];
}
if( sys.m_TxdJob >= 2 ){
if( m_nextcount ){
while( m_nextcount >= ::GetTickCount() ){
if( m_Command == COMM_CLOSE ) return;
::Sleep(1);
}
}
m_nextcount = ::GetTickCount() + m_addcount;
}
if( m_pEXT != NULL ){
m_pEXT->PutChar(d);
}
else {
TransmitCommChar(m_fHnd, d);
}
#if BITDEBUG
m_bitCountA = GetTickCount() - m_bitCount;
m_bitCount = GetTickCount();
#endif
}
//---------------------------------------------------------------------------
void __fastcall CComm::Execute()
{
m_Execute = 1;
int BitLen = pMod->m_BitLen;
//---- スレッドのコードをここに記述 ----
// Priority = tpLower;
while(1){
_try:;
if( Terminated == TRUE ){
return;
}
if( m_Command == COMM_CLOSE ){
m_Command = 0;
return;
}
if( m_CreateON == TRUE ){
if( !m_TxEnb ){
::Sleep(10);
}
else if( !TxBusy() ){
if( m_FirstGaurd ){ // 最初のガード時間の確保
m_FirstGaurd = 0;
::Sleep(250);
if( m_DisDiddle == -1 ) m_DisDiddle = 0;
}
else if( m_txcnt && (FSKDeff <= DEFFSOUND) ){ // 送信データあり
m_DisDiddle = pMod->m_DisDiddle;
m_Data = m_txbuf[m_txrp];
if( m_figout && (m_fig == 0x1b) && (m_Data != 0x1f) ){
m_Data = 0x1b;
}
else {
switch(m_Data){
case 0xff: // Mark
::Sleep((pMod->m_ReCount * 3 * 1000) / SampFreq);
NextBuf();
goto _try;
case 0xfe: // キャリア断続
NextBuf();
goto _try;
case 0xfd: // disable diddle
m_DisDiddle = 0;
NextBuf();
goto _try;
case 0xfc: // enable diddle
m_DisDiddle = 1;
NextBuf();
goto _try;
case 0x1b:
case 0x1f:
m_fig = m_Data;
break;
}
NextBuf();
}
m_figout = 0;
if( !pMod->m_CharWaitDiddle ){
WaitTXD(pMod->m_CharWait);
}
m_WaitTimerCount = 4;
OutData(m_Data);
}
else if( (BitLen < 6) && ((FSKDeff > DEFFSOUND) || (pMod->m_diddle && !m_DisDiddle)) ){
if( FSKDeff > DEFFSOUND ){
WaitTXD(pMod->m_CharWait);
}
else if( (sys.m_LWait == 2) || !pMod->m_WaitTimer || m_WaitTimerCount ){
if( !pMod->m_CharWaitDiddle ){
if( sys.m_LWait == 2 ){
WaitTXD(pMod->m_CharWait);
}
else if( pMod->m_DiddleWait ){
WaitTXD(pMod->m_DiddleWait);
}
}
}
m_idle = 1;
switch(pMod->m_diddle){
case 1: // BLK
if( pMod->m_RandomDiddle && !(rand() & 3) ){
m_Data = 0x1f;
if( pMod->m_BitLen <= 6 ) m_figout = 1;
}
else {
m_Data = 0x00;
}
break;
default: // LTR
if( pMod->m_RandomDiddle && !(rand() & 3) ){
m_Data = 0x00;
}
else {
m_Data = 0x1f;
if( pMod->m_BitLen <= 6 ) m_figout = 1;
}
break;
}
if( m_WaitTimerCount ) m_WaitTimerCount--;
OutData(m_Data);
}
else {
if( !m_idle ){
::Sleep((pMod->m_ReCount * pMod->m_BitLen)*1000/SampFreq);
}
m_idle = 1;
}
::Sleep(10);
}
else {
::Sleep(1);
}
}
else {
::Sleep(10);
}
}
}
/*#$%
==============================================================
通信回線をクローズする
--------------------------------------------------------------
--------------------------------------------------------------
--------------------------------------------------------------
==============================================================
*/
void __fastcall CComm::Close(void)
{
if( m_CreateON == TRUE ){
if( m_Execute ){
m_TxEnb = 0;
m_Command = COMM_CLOSE; // スレッド終了コマンド
Priority = tpNormal; //スレッドは通常の優先度である
#if 0
DWORD tim = GetTickCount();
while( m_Command && (GetTickCount() < (tim + 3000)) ){ // スレッド終了待ち
::Sleep(1);
}
#else
WaitFor();
#endif
FSKCount1+=1000;
}
if( m_pEXT != NULL ){
delete m_pEXT;
m_pEXT = NULL;
}
else {
::CloseHandle(m_fHnd);
}
m_CreateON = FALSE;
}
}
void __fastcall CComm::ReqClose(void)
{
if( m_CreateON == TRUE ){
if( m_Execute ){
m_TxEnb = 0;
m_Command = COMM_CLOSE; // スレッド終了コマンド
Priority = tpNormal; //スレッドは通常の優先度である
FSKCount1+=1000;
}
}
}
void __fastcall CComm::WaitClose(void)
{
if( m_CreateON == TRUE ){
if( m_Execute && m_Command ){
#if 0
DWORD tim = GetTickCount();
while( GetTickCount() < (tim + 3000) ){ // 1[s]のウエイト
if( !m_Command ) break;
::Sleep(1);
}
#else
WaitFor();
#endif
}
if( m_pEXT != NULL ){
delete m_pEXT;
m_pEXT = NULL;
}
else {
::CloseHandle(m_fHnd);
}
m_CreateON = FALSE;
}
}
/*#$%
==============================================================
通信回線をオープンする
--------------------------------------------------------------
PortName : 回線の名前
pCP : COMMPARAのポインタ(ヌルの時はデフォルトで初期化)
RBufSize : 受信バッファのサイズ(default=2048)
TBufSize : 送信バッファのサイズ(default=2048)
--------------------------------------------------------------
TRUE/FALSE
--------------------------------------------------------------
==============================================================
*/
BOOL __fastcall CComm::Open(LPCTSTR PortName, int inv, COMMPARA *cp)
{
if( m_CreateON == TRUE ) Close();
m_Execute = 0;
m_fHnd = ::CreateFile( PortName, GENERIC_READ | GENERIC_WRITE,
0, NULL,
OPEN_EXISTING,
FILE_ATTRIBUTE_NORMAL,
NULL
);
if( m_fHnd == INVALID_HANDLE_VALUE ){
m_pEXT = new CEXTFSK(PortName);
if( m_pEXT->IsLib() ){
LONG para;
if( cp != NULL ){
para = (cp->Baud << 16);
para |= cp->Stop;
para |= (cp->BitLen << 2);
}
else {
para = (45 << 16);
}
m_pEXT->Open(para);
m_CreateON = TRUE;
return TRUE;
}
else {
delete m_pEXT;
m_pEXT = NULL;
}
return FALSE;
}
m_inv = inv;
// setup device buffers
if( ::SetupComm( m_fHnd, DWORD(1024), DWORD(2) ) == FALSE ){
::CloseHandle(m_fHnd);
return FALSE;
}
// purge any information in the buffer
::PurgeComm( m_fHnd, PURGE_TXABORT | PURGE_RXABORT | PURGE_TXCLEAR | PURGE_RXCLEAR );
// set up for overlapped I/O
COMMTIMEOUTS TimeOut;
TimeOut.ReadIntervalTimeout = 0xffffffff;
TimeOut.ReadTotalTimeoutMultiplier = 0;
TimeOut.ReadTotalTimeoutConstant = 0;
TimeOut.WriteTotalTimeoutMultiplier = 0;
TimeOut.WriteTotalTimeoutConstant = 20000;
// TimeOut.WriteTotalTimeoutConstant = 1;
if( !::SetCommTimeouts( m_fHnd, &TimeOut ) ){
::CloseHandle( m_fHnd );
return FALSE;
}
::GetCommState( m_fHnd, &m_dcb );
m_dcb.BaudRate = (cp != NULL) ? cp->Baud : 9600;
m_dcb.fBinary = TRUE;
m_dcb.ByteSize = BYTE((cp != NULL) ? cp->BitLen : 8);
m_dcb.Parity = BYTE((cp != NULL) ? cp->Parity : NOPARITY);
m_dcb.StopBits = BYTE((cp != NULL ) ? cp->Stop : ONESTOPBIT);
// Application->MainForm->Caption = int(cp ? cp->Stop == TWOSTOPBITS : FALSE);
m_dcb.XonChar = 0x11; // XON
m_dcb.XoffChar = 0x13; // XOFF
m_dcb.fParity = 0;
m_dcb.fOutxCtsFlow = FALSE;
m_dcb.fInX = m_dcb.fOutX = FALSE;
m_dcb.fOutxDsrFlow = FALSE;
m_dcb.EvtChar = 0x0d;
m_dcb.fRtsControl = m_inv ? RTS_CONTROL_ENABLE : RTS_CONTROL_DISABLE; // 送信禁止
m_dcb.fDtrControl = m_inv ? DTR_CONTROL_ENABLE : DTR_CONTROL_DISABLE; // 送信禁止
// m_dcb.fTXContinueOnXoff = TRUE;
m_dcb.XonLim = USHORT(1024/4); // 1/4 of RBufSize
m_dcb.XoffLim = USHORT(1024*3/4); // 3/4 of RBufSize
m_dcb.DCBlength = sizeof( DCB );
if( m_dcb.StopBits != ONESTOPBIT ){
m_addcount = DWORD((1000.0/double(m_dcb.BaudRate)) * double(m_dcb.ByteSize + 2.7));
}
else {
m_addcount = DWORD((1000.0/double(m_dcb.BaudRate)) * double(m_dcb.ByteSize + 2.2));
}
#if 0 // debug
m_dcb.BaudRate = 9600;
m_dcb.ByteSize = 8;
#endif
if( !::SetCommState( m_fHnd, &m_dcb ) ){
::CloseHandle( m_fHnd );
return FALSE;
}
// get any early notifications
if( !::SetCommMask( m_fHnd, EV_RXFLAG ) ){
::CloseHandle(m_fHnd);
return FALSE;
}
m_CreateON = TRUE;
return TRUE;
}
//-----------------------------------------------------------------
// PTT切り替え用
void __fastcall CComm::SetTXRX(int sw)
{
if( m_CreateON == FALSE ) return;
if( m_inv ) sw = sw ? 0 : 1;
if( m_pEXT != NULL ){
m_pEXT->SetPTT(sw);
}
else if( sw ){
::EscapeCommFunction(m_fHnd, SETRTS);
::EscapeCommFunction(m_fHnd, SETDTR);
}
else {
::EscapeCommFunction(m_fHnd, CLRRTS);
::EscapeCommFunction(m_fHnd, CLRDTR);
}
}
#if 0
//-----------------------------------------------------------------
// DTRで符号送信用
void __fastcall CComm::SetDTR(int sw)
{
if( m_CreateON == FALSE ) return;
if( sw ){
::EscapeCommFunction(m_fHnd, SETDTR);
}
else {
::EscapeCommFunction(m_fHnd, CLRDTR);
}
}
#endif
//-----------------------------------------------------------------
// 送信ビジーかどうか調べる TRUE : 送信ビジー状態
int __fastcall CComm::TxBusy(void)
{
if( m_CreateON == FALSE ) return 0;
if( m_pEXT != NULL ){
return m_pEXT->IsTxBusy();
}
else {
COMSTAT ComStat;
DWORD dwErrorFlags;
ClearCommError( m_fHnd, &dwErrorFlags, &ComStat );
return ComStat.fTxim;
}
}
/*#$%
==============================================================
通信回線にデータを送信する
--------------------------------------------------------------
--------------------------------------------------------------
--------------------------------------------------------------
==============================================================
*/
void __fastcall CComm::PutChar(BYTE c)
{
if( (m_CreateON == TRUE) && m_Execute ){
if( m_txcnt < COMM_TXBUFSIZE ){
m_txbuf[m_txwp] = c;
m_txwp++;
if( m_txwp >= COMM_TXBUFSIZE ) m_txwp = 0;
m_txcnt++;
m_idle = 0;
FSKCount++;
}
}
}
#if 0
/*#$%
==============================================================
受信バッファ内の格納データ長を得る
--------------------------------------------------------------
--------------------------------------------------------------
データの長さ
--------------------------------------------------------------
==============================================================
*/
DWORD CComm::RecvLen(void)
{
if( m_pEXT != NULL ){
return m_pEXT->IsEmpty(0) ? 0 : 1;
}
else {
COMSTAT ComStat;
DWORD dwErrorFlags;
::ClearCommError( m_fHnd, &dwErrorFlags, &ComStat );
return ComStat.cbInQue;
}
}
#endif
/*******************************************************************
EXTFSK.DLL
*******************************************************************/
__fastcall CEXTFSK::CEXTFSK(LPCSTR pName)
{
char Name[128];
sprintf(Name, "%s.%s", pName, strcmpi(pName, "EXTFSK") ? "fsk" : "dll");
fextfskOpen = NULL;
fextfskClose = NULL;
fextfskIsTxBusy = NULL;
fextfskPutChar = NULL;
fextfskSetPTT = NULL;
m_hLib = ::LoadLibrary(Name);
if( m_hLib != NULL ){
fextfskOpen = (extfskOpen)GetProc("_extfskOpen");
fextfskClose = (extfskClose)GetProc("_extfskClose");
fextfskIsTxBusy = (extfskIsTxBusy)GetProc("_extfskIsTxBusy");
fextfskPutChar = (extfskPutChar)GetProc("_extfskPutChar");
fextfskSetPTT = (extfskSetPTT)GetProc("_extfskSetPTT");
}
}
//---------------------------------------------------------------------
__fastcall CEXTFSK::~CEXTFSK()
{
if( m_hLib != NULL ){
Close();
::FreeLibrary(m_hLib);
m_hLib = NULL;
}
}
//---------------------------------------------------------------------
FARPROC CEXTFSK::GetProc(LPCSTR pName)
{
FARPROC fn = ::GetProcAddress(m_hLib, pName+1);
if( fn == NULL ){
fn = ::GetProcAddress(m_hLib, pName);
}
return fn;
}
long __fastcall CEXTFSK::Open(long para)
{
if( !m_hLib || !fextfskOpen ) return FALSE;
return fextfskOpen(para);
}
void __fastcall CEXTFSK::Close(void)
{
if( !m_hLib || !fextfskClose ) return;
fextfskClose();
}
long __fastcall CEXTFSK::IsTxBusy(void)
{
if( !m_hLib || !fextfskIsTxBusy ) return FALSE;
return fextfskIsTxBusy();
}
void __fastcall CEXTFSK::PutChar(BYTE c)
{
if( !m_hLib || !fextfskPutChar ) return;
fextfskPutChar(c);
}
void __fastcall CEXTFSK::SetPTT(long tx)
{
if( !m_hLib || !fextfskSetPTT ) return;
fextfskSetPTT(tx);
}