int main(){ // Function to retrieve OAPI version size_t len = LEN; size_t read; char *line = malloc(len); assert(line); // return variables char s0[1024]; int i0; int nFrameOld = -1; while ((read = getline(&line, &len, stdin)) != -1) { //fprintf(stderr, "INFO: Retrieved line of length %zu (including NULL): %s", read, line); if (cmp(line, "OAPIGetVersionString")){ i0 = OAPIGetVersionString(s0, len); printf("'%s'\n", s0); } else if (cmp(line, "OptoGetLastError")){ i0 = OptoGetLastError(s0, len); printf("'%s'\n", s0); } else if (cmp(line, "OptotrakGetErrorString")){ i0 = OptotrakGetErrorString(s0, len); printf("'%s'\n", s0); } else if (cmp(line, "OptoGetExtendedErrorCode")){ i0 = OptoGetExtendedErrorCode(); printf("%d\n", i0); } else if (cmp(line, "TransputerLoadSystem")){ strtok(line, "\""); char* s = strtok(NULL, "\""); // may be null i0 = TransputerLoadSystem(s); //i0 = TransputerLoadSystem("/opt/NDIoapi/ndigital/realtime/system.nif"); printf("%d\n", i0); } else if (cmp(line, "TransputerInitializeSystem")){ i0 = TransputerInitializeSystem(OPTO_LOG_ERRORS_FLAG); printf("%d\n", i0); } else if (cmp(line, "TransputerShutdownSystem")){ i0 = TransputerShutdownSystem(); printf("%d\n", i0); } else if (cmp(line, "TransputerDetermineSystemCfg")){ strtok(line, "\""); char* s = strtok(NULL, "\""); // may be null i0 = TransputerDetermineSystemCfg(s); printf("%d\n", i0); } else if (cmp(line, "OptotrakLoadCameraParameters")){ strtok(line, "\""); char* s = strtok(NULL, "\""); // may be null OptotrakLoadCameraParameters(s); printf("%d\n", i0); } else if (cmp(line, "OptotrakLoadAutoScale")){ strtok(line, "\""); char* s = strtok(NULL, "\""); // may be null OptotrakLoadAutoScale(s); printf("%d\n", i0); } else if (cmp(line, "OptotrakLockTemperatures")){ i0 = OptotrakLockTemperatures(); printf("%d\n", i0); } else if (cmp(line, "OptotrakSetCollectionFile")){ strtok(line, "\""); char* s = strtok(NULL, "\""); // may be null OptotrakSetCollectionFile(s); printf("%d\n", i0); } else if (cmp(line, "OptotrakSetupCollectionFromFile")){ strtok(line, "\""); char* s = strtok(NULL, "\""); // may be null OptotrakSetupCollectionFromFile(s); printf("%d\n", i0); } else if (cmp(line, "OptotrakSetupCollection")){ float fFrameFrequency, fMarkerFrequency; int nThreshold, nMinimumGain, nStreamData; float fDutyCycle, fVoltage, fCollectionTime, fPreTriggerTime; int nFlags; strtok(line, "("); char* s = strtok(NULL, ")"); int i = sscanf(s, "%d, %f, %f, %d, %d, %d, %f, %f, %f, %f, %d", &nMarkers, &fFrameFrequency, &fMarkerFrequency, &nThreshold, &nMinimumGain, &nStreamData, &fDutyCycle, &fVoltage, &fCollectionTime, &fPreTriggerTime, &nFlags); if(i==11){ i0 = OptotrakSetupCollection(nMarkers, fFrameFrequency, fMarkerFrequency, nThreshold, nMinimumGain, nStreamData, fDutyCycle, fVoltage, fCollectionTime, fPreTriggerTime, nFlags); printf("%d\n", i0); allocSpace(nMarkers); } else printf("ERROR: %d arguments read (11 expected)\n", i); } else if (cmp(line, "OptotrakActivateMarkers")){ i0 = OptotrakActivateMarkers(); printf("%d\n", i0); } else if (cmp(line, "OptotrakDeActivateMarkers")){ i0 = OptotrakDeActivateMarkers(); printf("%d\n", i0); } else if (cmp(line, "OptotrakGetStatus")){ int nNumSensors, nNumOdaus, nNumRigidBodies, nMarkers; float fFrameFrequency, fMarkerFrequency; int nThreshold, nMinimumGain, nStreamData; float fDutyCycle, fVoltage, fCollectionTime, fPreTriggerTime; int nFlags; i0 = OptotrakGetStatus(&nNumSensors, &nNumOdaus, &nNumRigidBodies, &nMarkers, &fFrameFrequency, &fMarkerFrequency, &nThreshold, &nMinimumGain, &nStreamData, &fDutyCycle, &fVoltage, &fCollectionTime, &fPreTriggerTime, &nFlags); printf("(%d, %d, %d, %d, %f, %f, %d, %d, %d, %f, %f, %f, %f, 0x%x)\n", nNumSensors, nNumOdaus, nNumRigidBodies, nMarkers, fFrameFrequency, fMarkerFrequency, nThreshold, nMinimumGain, nStreamData, fDutyCycle, fVoltage, fCollectionTime, fPreTriggerTime, nFlags); } else if (cmp(line, "OptotrakSetStroberPortTable")){ int nPort1, nPort2, nPort3, nPort4; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %d, %d, %d", &nPort1, &nPort2, &nPort3, &nPort4) == 4){ i0 = OptotrakSetStroberPortTable(nPort1, nPort2, nPort3, nPort4); printf("%d\n", i0); } else printf("ERROR: reading 4 arguments\n"); } else if (cmp(line, "OptotrakSaveCollectionToFile")){ strtok(line, "\""); char* s = strtok(NULL, "\""); if (s) i0 = OptotrakSaveCollectionToFile(s); else i0 = OptotrakSaveCollectionToFile(""); printf("%d\n", i0); } else if (cmp(line, "OptotrakSetCameraParameters")){ int nMarkerType, nWaveLength, nModelType; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %d, %d", &nMarkerType, &nWaveLength, &nModelType) == 3){ i0 = OptotrakSetCameraParameters(nMarkerType, nWaveLength, nModelType); printf("%d\n", i0); } else printf("ERROR: reading 3 arguments\n"); } else if (cmp(line, "OptotrakGetCameraParameterStatus")){ int curMarkerType, nCurWaveLength, nCurModelType; char szStatus[len]; i0 = OptotrakGetCameraParameterStatus(&curMarkerType, &nCurWaveLength, &nCurModelType, szStatus, len); printf("(%d, %d, %d, '%s')\n", curMarkerType, nCurWaveLength, nCurModelType, szStatus); } else if (cmp(line, "OdauSaveCollectionToFile")){ strtok(line, "\""); char* s = strtok(NULL, "\""); if (s){ i0 = OptotrakSaveCollectionToFile(s); printf("%d\n", i0); } else printf("ERROR: reading filename\n"); } else if (cmp(line, "OdauSetupCollectionFromFile")){ strtok(line, "\""); char* s = strtok(NULL, "\""); if (s){ i0 = OdauSetupCollectionFromFile(s); printf("%d\n", i0); } else printf("ERROR: reading filename\n"); } else if (cmp(line, "OdauSetTimer")){ //int OdauSetTimer( int nOdauId, unsigned uTimer, unsigned uMode, unsigned long ulVal ); int nOdauId; unsigned uTimer, uMode; unsigned long ulVal; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %u, %u, %lu", &nOdauId, &uTimer, &uMode, &ulVal) == 4){ i0 = OdauSetTimer(ODAU1+nOdauId-1, uMode, uTimer, ulVal); printf("%d\n", i0); } else printf("ERROR: reading 4 arguments\n"); } else if (cmp(line, "OdauSetAnalogOutputs")){ //int OdauSetAnalogOutputs( int nOdauId, float *pfVoltage1, float *pfVoltage2, unsigned uChangeMask ); int nOdauId; // 1-4 -> ODAU1-ODAU4 float fVoltage1; float fVoltage2; unsigned uChangeMask; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %f, %f, %u", &nOdauId, &fVoltage1, &fVoltage2, &uChangeMask) == 4){ i0 = OdauSetAnalogOutputs(ODAU1+nOdauId-1, &fVoltage1, &fVoltage2, uChangeMask); printf("(%f, %f)\n", fVoltage1, fVoltage1); } else printf("ERROR: reading 4 arguments\n"); } else if (cmp(line, "OdauSetDigitalOutputs")){ //int OdauSetDigitalOutputs( int nOdauId, unsigned *puDigitalOut, unsigned uUpdateMask ); int nOdauId; // 1-4 -> ODAU1-ODAU4 unsigned uDigitalOut, uUpdateMask; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %u, %u", &nOdauId, &uDigitalOut, &uUpdateMask) == 4){ i0 = OdauSetDigitalOutputs(ODAU1+nOdauId-1, &uDigitalOut, uUpdateMask); printf("0x%x\n", uDigitalOut); } else printf("ERROR: reading 3 arguments\n"); } else if (cmp(line, "OdauSetupCollection")){ //OdauSetupCollection( int nOdauId, int nChannels, int nGain, int nDigitalMode, float fFrameFreq, float fScanFreq, int nStreamData, float fCollectionTime, float fPreTriggerTime, unsigned uFlags ); int nOdauId, nChannels, nGain, nDigitalMode; float fFrameFreq, fScanFreq; int nStreamData; float fCollectionTime, fPreTriggerTime; unsigned uFlags; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %d, %d, %d, %f, %f, %d, %f, %f, %u", &nOdauId, &nChannels, &nGain, &nDigitalMode, &fFrameFreq, &fScanFreq, &nStreamData, &fCollectionTime, &fPreTriggerTime, &uFlags) == 10){ i0 = OdauSetupCollection(ODAU1+nOdauId-1, nChannels, nGain, nDigitalMode, fFrameFreq, fScanFreq, nStreamData, fCollectionTime, fPreTriggerTime, uFlags); printf("%d\n", i0); } else printf("ERROR: reading 10 arguments\n"); } else if (cmp(line, "OptotrakStopCollection")){ i0 = OptotrakStopCollection(); printf("%d\n", i0); } else if (cmp(line, "OdauGetStatus")){ //int OdauGetStatus( int nOdauId, int *pnChannels, int *pnGain, int *pnDigitalMode, float *pfFrameFrequency, float *pfScanFrequency, int *pnStreamData, float *pfCollectionTime, float *pfPreTriggerTime, unsigned *puCollFlags, int *pnFlags ); int nOdauId, nChannels, nGain, nDigitalMode; float fFrameFrequency, fScanFrequency; int nStreamData; float fCollectionTime, fPreTriggerTime; unsigned uCollFlags; int nFlags; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d", &nOdauId) == 1){ i0 = OdauGetStatus(ODAU1+nOdauId-1, &nChannels, &nGain, &nDigitalMode, &fFrameFrequency, &fScanFrequency, &nStreamData, &fCollectionTime, &fPreTriggerTime, &uCollFlags, &nFlags); printf("(%d, %d, %d, %f, %f, %d, %f, %f, 0x%04x, %d)\n", nChannels, nGain, nDigitalMode, fFrameFrequency, fScanFrequency, nStreamData, fCollectionTime, fPreTriggerTime, uCollFlags, nFlags); } else printf("ERROR: reading argument\n"); } else if (cmp(line, "RigidBodyAddFromFile")){ int nRigidBodyId, nStartMarker; char szRigFile[len]; int nFlags; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %d, %s, %d", &nRigidBodyId, &nStartMarker, szRigFile, &nFlags) != 4){ i0 = RigidBodyAddFromFile(nRigidBodyId, nStartMarker, szRigFile, nFlags); printf("%d\n", i0); } else printf("ERROR: reading 4 arguments\n"); } else if (cmp(line, "RigidBodyAdd")){ //int ( int nRigidBodyId, int nStartMarker, int nNumMarkers, float *pRigidCoordinates, float *pNormalCoordinates, int nFlags ); int nRigidBodyId, nStartMarker, nNumMarkers; float *rigidCoordinates, *normalCoordinates; int nFlags; char* s = strtok(line, "("); if(s && sscanf(line+strlen(s)+1, "%d, %d, %d", &nRigidBodyId, &nStartMarker, &nNumMarkers)==3){ rigidCoordinates = calloc(3*nNumMarkers, sizeof(float)); normalCoordinates = calloc(3*nNumMarkers, sizeof(float)); s = strtok(NULL, "[("); // up to first list/tuple if(!s){ printf("ERROR: reading rigid values\n"); goto end; } for(int i=0; i<3*nNumMarkers; i++){ char* s = strtok(NULL, ","); if(!s){ printf("ERROR: reading rigid value %d\n", i); goto end; } if(sscanf(s, "%f", (float*)&rigidCoordinates[i]) != 1){ printf("ERROR: parsing rigid value %d\n", i); goto end; } } s = strtok(NULL, "[("); // up to first list/tuple if(!s){ printf("ERROR: reading normal values\n"); goto end; } for(int i=0; i<3*nNumMarkers; i++){ char* s = strtok(NULL, ","); if(!s){ printf("ERROR: reading normal value %d\n", i); goto end; } if(sscanf(s, "%f", (float*)&normalCoordinates[i]) != 1){ printf("ERROR: parsing normal value %d\n", i); goto end; } } s = strtok(NULL, "],) "); //s = strtok(NULL, ")"); if(s && sscanf(s, "%d", &nFlags)==1){ i0 = RigidBodyAdd(nRigidBodyId, nStartMarker, nNumMarkers, rigidCoordinates, normalCoordinates, nFlags); printf("%d\n", i0); } else printf("ERROR: reading last argument\n"); } else printf("ERROR: reading first 3 arguments\n"); //int RigidBodyAddFromFile( int nRigidBodyId, int nStartMarker, char *pszRigFile, int nFlags ); //int RigidBodyChangeSettings( int nRigidBodyId, int nMinMarkers, int nMaxMarkersAngle, float fMax3dError, float fMaxSensorError, float fMax3dRmsError, float fMaxSensorRmsError, int nFlags ); //int RigidBodyDelete( int nRigidBodyId ); //int RigidBodyChangeFOR( int nRigidId, int nRotationMethod ); } else if (cmp(line, "RigidBodyChangeSettings")){ int nRigidBodyId, nMinMarkers, nMaxMarkersAngle; float fMax3dError, fMaxSensorError, fMax3dRmsError, fMaxSensorRmsError; int nFlags; strtok(line, "("); char* s = strtok(NULL, ")"); if(s && sscanf(s, "%d, %d, %d, %f, %f, %f, %f, %d", &nRigidBodyId, &nMinMarkers, &nMaxMarkersAngle, &fMax3dError, &fMaxSensorError, &fMax3dRmsError, &fMaxSensorRmsError, &nFlags) != 4){ i0 = RigidBodyChangeSettings(nRigidBodyId, nMinMarkers, nMaxMarkersAngle, fMax3dError, fMaxSensorError, fMax3dRmsError, fMaxSensorRmsError, nFlags); printf("%d\n", i0); } else printf("ERROR: reading 8 arguments\n"); } else if (cmp(line, "DataGetLatestRaw")){ uint uFrameNumber=999, uElements=999, uFlags=999; i0 = DataGetLatestRaw(&uFrameNumber, &uElements, &uFlags, pFullRawData); printf("Frame Number: %8u\n", uFrameNumber); printf("Elements : %8u\n", uElements); printf("Flags : 0x%04x\n", uFlags); for(uint uMarkerCnt=0; uMarkerCnt<nMarkers; uMarkerCnt++){ // Print out the current marker number. fprintf( stdout, "Marker %u, ", uMarkerCnt + 1 ); //Print out the information for each sensor. for(uint uSensorCnt = 0; uSensorCnt<NUM_SENSORS; ++uSensorCnt ){ //Print out the current sensor number. fprintf( stdout, "Sensor %u, ", uSensorCnt + 1 ); // Print out the centroid. If it is bad print out *the string 'missing'. //if( pFullRawData[uMarkerCnt].fCentroid[uSensorCnt] < MAX_NEGATIVE ) //printf("data missing, " ); //else printf("data: %8.2g, ", (float)pFullRawData[uMarkerCnt].fCentroid[uSensorCnt] ); //Print out the rest of this sensor’s information. printf("peak: %4d, DRC: %4d, sensorCode: %u\n", pFullRawData[uMarkerCnt].SensorData[uSensorCnt].ucPeak, pFullRawData[uMarkerCnt].SensorData[uSensorCnt].ucDRC, (uint)pFullRawData[uMarkerCnt].SensorData[uSensorCnt].ucCode); } /* for */ } /* for */ } else if (cmp(line, "DataGetLatest3D")){ //int DataGetLatest3D( unsigned *pnFrame, unsigned *pElems, unsigned *pFlags, void *pDataDest ); uint nFrame=999, elems=999, flags=999; //Position3d dataDest[NUM_MARKERS]; i0 = DataGetLatest3D(&nFrame, &elems, &flags, pPosition3d); printf("(%d, %u, %u, 0x%X, (", i0, nFrame, elems, flags); for(uint i=0; i<nMarkers; i++){ printf(" (%10.3g, %10.3g, %10.3g),", pPosition3d[i].x, pPosition3d[i].y, pPosition3d[i].z); } printf("))\n"); } else if (cmp(line, "RequestLatest3D")){ i0 = RequestLatest3D(); printf("%d\n", i0); } else if (cmp(line, "DataIsReady")){ i0 = DataIsReady(); printf("%d\n", i0); } else if (cmp(line, "DataReceiveLatest3D")){ // alle markers 3d uint nFrame=999, elems=999, flags=999; Position3d dataDest; i0 = DataReceiveLatest3D(&nFrame, &elems, &flags, &dataDest); printf("(%d, %u, %u, 0x%X, (", i0, nFrame, elems, flags); for(uint i=0; i<nMarkers; i++){ printf(" (%10.3g, %10.3g, %10.3g),", pPosition3d[i].x, pPosition3d[i].y, pPosition3d[i].z); } printf("))\n"); } else if (cmp(line, "DataReceiveLatestRaw")){ uint nFrame, elems, flags; void *dataDest; // todo allocate! i0 = DataReceiveLatestRaw(&nFrame, &elems, &flags, &dataDest); printf("(%d, %u, 0x%x)\n", i0, nFrame, flags); } else if (cmp(line, "DataBufferInitializeFile")){ //unsigned uDataId; char pszFileName[len]; strtok(line, "\""); char* s = strtok(NULL, "\""); if(sscanf(s, "%s", pszFileName)==1){ i0 = DataBufferInitializeFile(OPTOTRAK, s); printf("%d\n", i0); } else printf("ERROR: could not read filename\n"); } else if (cmp(line, "DataBufferSpoolData")){ int i = 999; i0 = DataBufferSpoolData(&i); printf("(%d, %d)\n", i0, i); } else if (cmp(line, "DataBufferStart")){ i0 = DataBufferStart(); printf("%d\n", i0); } else if (cmp(line, "DataBufferStop")){ i0 = DataBufferStop(); printf("%d\n", i0); } else if (cmp(line, "DataBufferWriteData")){ unsigned uRealtimeData=999, uSpoolComplete=0, uSpoolStatus=999; unsigned long ulFramesBuffered=999; i0 = DataBufferWriteData(&uRealtimeData, &uSpoolComplete, &uSpoolStatus, &ulFramesBuffered); printf("(%d, %u, %u, %u, %lu)\n", i0, uRealtimeData, uSpoolComplete, uSpoolStatus, ulFramesBuffered); } else if (cmp(line, "DataBufferAbortSpooling")){ i0 = DataBufferAbortSpooling(); printf("%d\n", i0); } else { printf("ERROR: no such command: %s\n", line); } end: fflush(stdout); } exit(EXIT_SUCCESS); }
//============================================================================== int COptoTrack::ConnectOpto( ){ BOOL bRes; int iErr; int iFrameSize; int iAttempt, nAttempts; CP_printf("Connecting to OptoTrak...\n"); if( IsRunning() ) { CP_printf(" OptoTrak is already connected!\n"); return 1; } m_iReadCount = 0; m_iOptoFrameIdx = 0; m_iPrevFrame = 0; m_nMissedTimes = 0; m_nMissedFrames = 0; // Make several attempts to load system. If OptoTrack was just // turned on, first attempt is unsuccessful nAttempts = 2; iErr = 1; // we exit the loop when iErr==0 for( iAttempt = 0; iAttempt < nAttempts && iErr; iAttempt++ ){ // Load OptoTrack transputers with system software CP_printf("TransputerLoadSystem() Attempt %d of %d\n", iAttempt+1, nAttempts); iErr = TransputerLoadSystem( "system" ); Sleep( 1000 ); // Wait one second to let the system finish loading. } if( iErr ) { CP_printf("Error: %d attempts of TransputerLoadSystem() failed!\n", iAttempt); m_PrintOptoError( iErr ); CP_printf("Make sure that both OptoTrak modules are turned on.\n"); CP_printf("Giving up on TransputerLoadSystem()\n"); return 1; } CP_printf("TransputerLoadSystem(): Ok \n"); // Initialize the transputer system. iErr = TransputerInitializeSystem( 0 ); // 0 == don't create log files if( iErr ) { CP_printf("Error: TransputerInitializeSystem() failed!\n"); return 1; } CP_printf("TransputerInitializeSystem(): Ok \n"); // Set optional processing flags (this overrides settings in OPTOTRAK.INI). iErr = OptotrakSetProcessingFlags( // OPTO_LIB_POLL_REAL_DATA | // if this flag is set, CPU clocks are waisted OPTO_CONVERT_ON_HOST | // Convert raw to 3D on PC OPTO_RIGID_ON_HOST ); // Convert 3D to rigid on PC if( iErr ) { CP_printf("Error: OptotrakSetProcessingFlags() failed!\n"); return 1; } CP_printf("OptotrakSetProcessingFlags(): Ok \n"); // Load the standard camera parameters. iErr = OptotrakLoadCameraParameters( "standard" ); if( iErr ) { CP_printf("Error: OptotrakLoadCameraParameters() failed!\n"); return 1; } CP_printf("OptotrakLoadCameraParameters(): Ok \n"); // create sliding buffer iFrameSize = sizeof(tOptoFrame) * m_nSensorsToWrite; bRes = SetBuffer( iFrameSize, // Item size int(BUFFER_SIZE_SECONDS * FRAME_RATE_HZ) ); // N items if( !bRes ) { CP_printf("Error: SetBuffer() failed!\n"); iErr = 1; goto errExit; } // CP_printf("Raw frame size: %d \n\n", sizeof(tOptoFrame)); m_iPrevFrame = 0; iErr = OptotrakSetStroberPortTable( m_anSensorsPerPort[0], m_anSensorsPerPort[1], m_anSensorsPerPort[2], m_anSensorsPerPort[3] ); if( iErr ) { CP_printf("Error: OptotrakSetStroberPortTable() failed!\n"); iErr = 1; goto errExit; } // Set up collection // This starts data acquisition iErr = OptotrakSetupCollection( m_nSensorsToRead, // Number of markers in the collection. FRAME_RATE_HZ, // Frequency to collect data frames at. 2000.0f, // Marker frequency for marker maximum on-time. 30, // Dynamic or Static Threshold value to use. 160, // Minimum gain code amplification to use. 0, // Stream mode for the data buffers. 0.5f, // Marker Duty Cycle to use. 5.0f, // Voltage to supply strobers and LEDs // 7.5f, // Voltage to supply strobers and LEDs 0.0f, // Number of seconds of data to collect. 0.0f, // Number of seconds to pre-trigger data by. 0 ); // No flags // Possible flags (not used): // OPTOTRAK_GET_NEXT_FRAME_FLAG // Don't receive the same frame twice // | OPTOTRAK_BUFFER_RAW_FLAG if( iErr ) { CP_printf("Error: OptotrakSetupCollection() failed!\n"); iErr = 1; goto errExit; } // manual warns of errors if we don't wait enough // after calling OptotrakSetupCollection() Sleep( 1000 ); // TODO: what should be the default state?? // iErr = OptotrakDeActivateMarkers(); // Start the thread if( m_StartReadingThread( )) { CP_printf("Error: m_StartReadingThread() failed!\n"); iErr = 1; goto errExit; } CP_printf("Connected!\n"); return 0; errExit: DisconnectOpto(); return iErr; }