static bool
devInitOne(PDeviceDescriptor_t dev, int index, const TCHAR *port,
DWORD speed, PDeviceDescriptor_t &nmeaout)
{
TCHAR DeviceName[DEVNAMESIZE];
if (is_simulator())
return FALSE;
ReadDeviceSettings(index, DeviceName);
const struct DeviceRegister *Driver = devGetDriver(DeviceName);
if (Driver) {
ComPort *Com = new ComPort(dev);
if (!Com->Initialize(port, speed))
return FALSE;
memset(dev->Name, 0, sizeof(dev->Name));
_tcsncpy(dev->Name, Driver->Name, DEVNAMESIZE);
dev->Driver = Driver;
dev->Com = Com;
devOpen(dev, index);
if (devIsBaroSource(dev)) {
if (pDevPrimaryBaroSource == NULL) {
pDevPrimaryBaroSource = dev;
} else if (pDevSecondaryBaroSource == NULL) {
pDevSecondaryBaroSource = dev;
}
}
if (nmeaout == NULL && Driver->Flags & (1l << dfNmeaOut)) {
nmeaout = dev;
}
}
return TRUE;
}
BOOL devInit(LPTSTR CommandLine){
int i;
TCHAR DeviceName[DEVNAMESIZE+1];
PDeviceDescriptor_t pDevNmeaOut = NULL;
static bool doinit=true;
for (i=0; i<NUMDEV; i++){
DeviceList[i].Port = -1;
DeviceList[i].fhLogFile = NULL;
DeviceList[i].Name[0] = '\0';
DeviceList[i].ParseNMEA = NULL;
DeviceList[i].PutMacCready = NULL;
DeviceList[i].DirectLink = NULL;
DeviceList[i].PutBugs = NULL;
DeviceList[i].PutBallast = NULL;
DeviceList[i].Open = NULL;
DeviceList[i].Close = NULL;
DeviceList[i].Init = NULL;
DeviceList[i].LinkTimeout = NULL;
DeviceList[i].Declare = NULL;
DeviceList[i].IsLogger = devIsFalseReturn;
DeviceList[i].IsGPSSource = devIsFalseReturn;
DeviceList[i].IsBaroSource = devIsFalseReturn;
DeviceList[i].IsRadio = devIsFalseReturn;
DeviceList[i].PutVoice = (int (*)(struct DeviceDescriptor_t *,TCHAR *))devIsFalseReturn;
DeviceList[i].PortNumber = i;
DeviceList[i].PutQNH = NULL;
DeviceList[i].OnSysTicker = NULL;
DeviceList[i].pDevPipeTo = NULL;
DeviceList[i].PutVolume = NULL;
DeviceList[i].PutFreqActive = NULL;
DeviceList[i].PutFreqStandby = NULL;
DeviceList[i].IsCondor = devIsFalseReturn;
DeviceList[i].Disabled = true;
ComPortStatus[i]=CPS_UNUSED; // 100210
ComPortHB[i]=0; // counter
if (doinit) {
ComPortRx[i]=0;
ComPortTx[i]=0;
ComPortErrTx[i]=0;
ComPortErrRx[i]=0;
ComPortErrors[i]=0;
doinit=false;
}
}
pDevPrimaryBaroSource = NULL;
pDevSecondaryBaroSource=NULL;
ReadDeviceSettings(0, DeviceName);
#ifdef DEBUG_DEVSETTING
StartupStore(_T(".......... ReadDeviceSetting 0, DeviceName=<%s>\n"),DeviceName);
#endif
PortIndex1 = 0; SpeedIndex1 = 2; Bit1Index=(BitIndex_t)bit8N1;
ReadPort1Settings(&PortIndex1,&SpeedIndex1,&Bit1Index);
//if (_tcslen(DeviceName)>0) // removed 110530
if (wcscmp(DeviceName,_T(DEV_DISABLED_NAME))!=0) {
DeviceList[0].Disabled=false;
StartupStore(_T(". Device A is <%s> Port=%s%s"),DeviceName,COMMPort[PortIndex1],NEWLINE);
} else {
DeviceList[0].Disabled=true;
StartupStore(_T(". Device A is DISABLED.%s"),NEWLINE);
}
for (i=DeviceRegisterCount-1; i>=0; i--) {
if (DeviceList[0].Disabled) break;
if ((_tcscmp(DeviceRegister[i].Name, DeviceName) == 0)) {
ComPort *Com = new ComPort(0);
// remember: Port1 is the port used by device A, port1 may be Com3 or Com1 etc
// this is port 1, so index 0 for us.
if (!Com->Initialize(COMMPort[PortIndex1], dwSpeed[SpeedIndex1],Bit1Index,0)) {
delete Com;
ComPortStatus[0]=CPS_OPENKO;
break;
}
ComPortStatus[0]=CPS_OPENOK;
DeviceRegister[i].Installer(devA());
if ((pDevNmeaOut == NULL) &&
(DeviceRegister[i].Flags & (1l << dfNmeaOut))){
pDevNmeaOut = devA();
}
devA()->Com = Com;
devInit(devA());
devOpen(devA(), 0);
if (devIsBaroSource(devA())) {
if (pDevPrimaryBaroSource == NULL){
pDevPrimaryBaroSource = devA();
} else
if (pDevSecondaryBaroSource == NULL){
pDevSecondaryBaroSource = devA();
}
}
break;
}
}
ReadDeviceSettings(1, DeviceName);
#ifdef DEBUG_DEVSETTING
StartupStore(_T(".......... ReadDeviceSetting 1, DeviceName=<%s>\n"),DeviceName);
#endif
PortIndex2 = 0; SpeedIndex2 = 2, Bit2Index=(BitIndex_t)bit8N1;
ReadPort2Settings(&PortIndex2,&SpeedIndex2, &Bit2Index);
//if (_tcslen(DeviceName)>0) // removed 110530
if (wcscmp(DeviceName,_T(DEV_DISABLED_NAME))!=0) {
DeviceList[1].Disabled=false;
StartupStore(_T(". Device B is <%s> Port=%s%s"),DeviceName,COMMPort[PortIndex2],NEWLINE);
} else {
DeviceList[1].Disabled=true;
StartupStore(_T(". Device B is DISABLED.%s"),NEWLINE);
}
for (i=DeviceRegisterCount-1; i>=0; i--) {
if (PortIndex1 == PortIndex2) break;
if (DeviceList[1].Disabled) break;
if ((_tcscmp(DeviceRegister[i].Name, DeviceName) == 0)) {
ComPort *Com = new ComPort(1);
// this is port 2, so index 1 for us
if (!Com->Initialize(COMMPort[PortIndex2], dwSpeed[SpeedIndex2],Bit2Index,1)) { // 100210
delete Com;
ComPortStatus[1]=CPS_OPENKO;
break;
}
ComPortStatus[1]=CPS_OPENOK;
DeviceRegister[i].Installer(devB());
if ((pDevNmeaOut == NULL) &&
(DeviceRegister[i].Flags & (1l << dfNmeaOut))){
pDevNmeaOut = devB();
}
devB()->Com = Com;
devInit(devB());
devOpen(devB(), 1);
if (devIsBaroSource(devB())) {
if (pDevPrimaryBaroSource == NULL){
pDevPrimaryBaroSource = devB();
} else
if (pDevSecondaryBaroSource == NULL){
pDevSecondaryBaroSource = devB();
}
}
break;
}
}
if (pDevNmeaOut != NULL){
if (pDevNmeaOut == devA()){
devB()->pDevPipeTo = devA();
}
if (pDevNmeaOut == devB()){
devA()->pDevPipeTo = devB();
}
}
return(TRUE);
}
BOOL devInit(LPCTSTR CommandLine) {
TCHAR DeviceName[DEVNAMESIZE + 1];
PDeviceDescriptor_t pDevNmeaOut = NULL;
TCHAR Port[MAX_PATH] = {_T('\0')};
DWORD SpeedIndex = 2;
DWORD BitIndex = (BitIndex_t) bit8N1;
static bool doinit = true;
pDevPrimaryBaroSource = NULL;
pDevSecondaryBaroSource = NULL;
std::set<std::wstring> UsedPort; // list of already used port
for (unsigned i = 0; i < NUMDEV; i++) {
DeviceList[i].InitStruct(i);
ComPortStatus[i] = CPS_UNUSED; // 100210
ComPortHB[i] = 0; // counter
if (doinit) {
ComPortRx[i] = 0;
ComPortTx[i] = 0;
ComPortErrTx[i] = 0;
ComPortErrRx[i] = 0;
ComPortErrors[i] = 0;
doinit = false;
}
if (SIMMODE){
continue;
}
ReadDeviceSettings(i, DeviceName);
DeviceList[i].Disabled = (wcscmp(DeviceName, _T(DEV_DISABLED_NAME)) == 0);
if (DeviceList[i].Disabled) {
StartupStore(_T(". Device %c is DISABLED.%s"), (_T('A') + i), NEWLINE);
continue;
}
DeviceRegister_t* pDev = std::find_if(&DeviceRegister[0], &DeviceRegister[DeviceRegisterCount], devNameCompare(DeviceName));
if (pDev == &DeviceRegister[DeviceRegisterCount]) {
DeviceList[i].Disabled = true;
StartupStore(_T(". Device %c : invalide drivers name <%s>%s"), (_T('A') + i), DeviceName, NEWLINE);
continue;
}
if(_tcscmp(pDev->Name,TEXT("Internal")) == 0) {
_tcscpy(Port, _T("GPSID"));
} else {
Port[0] = _T('\0');
SpeedIndex = 2;
BitIndex = (BitIndex_t) bit8N1;
ReadPortSettings(i, Port, &SpeedIndex, &BitIndex);
}
// remember: Port1 is the port used by device A, port1 may be Com3 or Com1 etc
if(std::find(UsedPort.begin(), UsedPort.end(), Port) != UsedPort.end()) {
StartupStore(_T(". Port <%s> Already used, Device %c Disabled ! %s"), Port, (_T('A') + i), NEWLINE);
continue;
}
UsedPort.insert(Port);
// remember: Port1 is the port used by device A, port1 may be Com3 or Com1 etc
StartupStore(_T(". Device %c is <%s> Port=%s%s"), (_T('A') + i), DeviceName, Port, NEWLINE);
ComPort *Com = NULL;
if (_tcsncmp(Port, _T("BT:"), 3) == 0) {
CBtHandler* pBtHandler = CBtHandler::Get();
StartupStore(_T(".. Initialise Bluetooth Device %s%s"), Port, NEWLINE);
if (pBtHandler && pBtHandler->IsOk()) {
if (pBtHandler->StartHW()) {
Com = new BthPort(i, &Port[3]);
}
}
} else if (_tcscmp(Port, _T("GPSID")) == 0) {
Com = new GpsIdPort(i, Port);
} else {
Com = new SerialPort(i, Port, dwSpeed[SpeedIndex], (BitIndex_t)BitIndex, PollingMode);
}
if (Com && Com->Initialize()) {
ComPortStatus[i] = CPS_OPENOK;
pDev->Installer(&DeviceList[i]);
if ((pDevNmeaOut == NULL) && (pDev->Flags & (1l << dfNmeaOut))) {
pDevNmeaOut = &DeviceList[i];
}
DeviceList[i].Com = Com;
devInit(&DeviceList[i]);
devOpen(&DeviceList[i], i);
if (devIsBaroSource(&DeviceList[i])) {
if (pDevPrimaryBaroSource == NULL) {
pDevPrimaryBaroSource = &DeviceList[i];
} else if (pDevSecondaryBaroSource == NULL) {
pDevSecondaryBaroSource = &DeviceList[i];
}
}
} else {
delete Com;
ComPortStatus[i] = CPS_OPENKO;
}
}
if (pDevNmeaOut != NULL) {
if (pDevNmeaOut == devA()) {
devB()->pDevPipeTo = devA();
}
if (pDevNmeaOut == devB()) {
devA()->pDevPipeTo = devB();
}
}
return (TRUE);
}
