int ToFCameraPMDController::GetModulationFrequency() { unsigned int modulationFrequency = 0; this->m_PMDRes = pmdGetModulationFrequency (m_PMDHandle, &modulationFrequency, 0); ErrorText(this->m_PMDRes); return (modulationFrequency/1000000); }
int o3d3xx_sample_imager_settings_function(void) { PMDHandle hnd = 0; std::string command = ""; int res = 0; char err[256] = {0}; char response[SOURCE_CMD_BUFFER_LENGTH] = {0}; unsigned int integrationTime = 0; // connect to camera printf ("\n ====================O3D300 Sample Code for Imager Settings===================="); printf ("\n Connecting to camera: \n"); res = pmdOpen (&hnd, SOURCE_PLUGIN, SOURCE_PARAM, PROC_PLUGIN, PROC_PARAM); if (res != PMD_OK) { fprintf (stderr, "Could not connect: \n"); getchar(); return res; } // Change Exposure Mode to "moderate" printf ("\n -----------------------------------------------------------------------------"); printf ("\n--------------------Imager Settings Functionality-----------------------------"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Imager Setting Type\n"); command = "GetImagerSettingType"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not change exposure mode:\n%s\n", err); printf (" Press any key to continue...."); getchar(); } else { printf("Type: %s", response); printf ("\n DONE"); } printf ("\n -----------------------------------------------------------------------------"); printf ("\n Set Exposure Mode to 'moderate'\n"); command = "SetExposureMode 1"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not change exposure mode:\n%s\n", err); printf (" Press any key to continue...."); getchar(); } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Set unambiguous distance range to 'upto30m'\n"); command = "SetUnambiguousDistanceRange 1"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not change unambiguous distance range:\n%s\n", err); printf (" Press any key to continue...."); getchar(); } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Imager Setting Type\n"); command = "GetImagerSettingType"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not change exposure mode:\n%s\n", err); printf (" Press any key to continue...."); getchar(); } else { printf("Type: %s", response); printf ("\n DONE"); } // Get the current Exposure Time and Exposure Time Ratio printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Integration Time 1\n"); // Call pmdGetIntegrationTime with index 0 to get exposure time res = pmdGetIntegrationTime (hnd, &integrationTime , 0); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not get integration time 1:\n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else { printf("Integration time 1 = %d usec", integrationTime); printf ("\n DONE"); } printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Integration Time Ratio\n"); command = "GetExposureTimeRatio"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not get integration time ratio:\n%s\n", err); getchar(); } else { int integrationTimeRatio = atoi( response ); printf("Integration time Ratio = %d", integrationTimeRatio); printf ("\n DONE"); } // Change Exposure Time and Exposure Time Ratio printf ("\n -----------------------------------------------------------------------------"); printf ("\n Setting exposureTime to 1000 usec \n"); // Call pmdSetIntegrationTime with index 0 to set exposure time res = pmdSetIntegrationTime (hnd, 0 , 1000); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, "Could not set the exposure time: \n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else printf("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Setting exposureTimeRatio to 50 \n"); command = "SetExposureTimeRatio 50"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, "Could not set the exposure time ratio: \n%s\n", err); getchar(); } else printf("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Getting Exposure Time List \n"); command = "GetExposureTimeList"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, "Could not get the exposure time list: \n%s\n", err); getchar(); } else { printf("Exposure Time List = %s", response); printf("\n DONE"); } // Optimizing exposure time : Setting integration time 10,000 usec before optimizing // exposure time to see the effect of optimizing functionality printf ("\n -----------------------------------------------------------------------------"); printf ("\n Set Exposure Mode to 'low'\n"); command = "SetExposureMode 0"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not change exposure mode:\n%s\n", err); printf (" Press any key to continue...."); getchar(); } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Setting integrationTime to 10,000 usec \n"); res = pmdSetIntegrationTime (hnd, 0 , 10000); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, "Could not set the integration time: \n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } printf ("\n -----------------------------------------------------------------------------"); printf ("\n Call Optimize function\n"); command = "OptimizeExposureTime"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Error in Optimization Procedure:\n%s\n", err); printf (" Press any key to continue...."); getchar(); } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Integration Time 1\n"); res = pmdGetIntegrationTime (hnd, &integrationTime , 0); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not get integration time 1:\n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else { printf("Integration time 1 = %d usec", integrationTime); printf ("\n DONE"); } unsigned int modulationFrequencyChannel; printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Modulation Frequency Channel\n"); res = pmdGetModulationFrequency (hnd, &modulationFrequencyChannel, 0); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not get modulation frequency:\n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else { printf("Modulation Frequency Channel = %d", modulationFrequencyChannel); printf ("\n DONE"); } modulationFrequencyChannel = 2; printf ("\n -----------------------------------------------------------------------------"); printf ("\n Set Modulation Frequency Channel to 2\n"); res = pmdSetModulationFrequency (hnd, 0, modulationFrequencyChannel); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not set modulation frequency:\n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Get Modulation Frequency Channel\n"); res = pmdGetModulationFrequency (hnd, &modulationFrequencyChannel, 0); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not get modulation frequency:\n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else { printf("Modulation Frequency Channel = %d", modulationFrequencyChannel); printf ("\n DONE"); } modulationFrequencyChannel = 1; printf ("\n -----------------------------------------------------------------------------"); printf ("\n Set Modulation Frequency Channel to 2\n"); res = pmdSetModulationFrequency (hnd, 0, modulationFrequencyChannel); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not set modulation frequency:\n%s\n", err); pmdClose (hnd); printf("Camera Connection Closed. \n"); printf ("Exiting application after key press...."); getchar(); return res; } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n---------------Source Commands: Invalid Imager Settings Parameters------------"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Setting Exposure Mode with invalid arguments: ""SetExposureMode 5""\n"); command = "SetExposureMode 5"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { printf (" Result: \n"); pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not set exposure mode:\n%s\n", err); } else printf ("\n DONE"); printf ("\n -----------------------------------------------------------------------------"); printf ("\n Setting Unambiguous Range with invalid arguments: ""SetUnambiguousDistanceRange 5""\n"); command = "SetUnambiguousDistanceRange 5"; res = pmdSourceCommand (hnd, response, SOURCE_CMD_BUFFER_LENGTH, command.c_str()); if (res != PMD_OK) { printf (" Result: \n"); pmdGetLastError (hnd, err, 128); fprintf (stderr, " Could not set unambiguous distance range:\n%s\n", err); } else printf ("\n DONE"); // Closing the connection. res = pmdClose (hnd); if (res != PMD_OK) { pmdGetLastError (hnd, err, 128); fprintf (stderr, "Could not close the connection %s\n", err); return res; } printf ("\n Camera closed Successfully"); printf ("\n ================================================================================"); return PMD_OK; }