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); }