int UHD_SAFE_MAIN(int argc, char *argv[]){ uhd::set_thread_priority_safe(); std::string args; //Set up program options po::options_description desc("Allowed options"); desc.add_options() ("help", "help message") ("args", po::value<std::string>(&args)->default_value(""), "Device address arguments specifying a single USRP") ("clock", "query a clock device's sensors") ; po::variables_map vm; po::store(po::parse_command_line(argc, argv, desc), vm); po::notify(vm); //Print the help message if (vm.count("help")) { std::cout << boost::format("Query GPSDO Sensors, try to lock the reference oscillator to the GPS disciplined clock, and set the device time to GPS time") << std::endl << std::endl << desc; return EXIT_FAILURE; } //If specified, query a clock device instead if(vm.count("clock")) { return query_clock_sensors(args); } //Create a USRP device std::cout << boost::format("\nCreating the USRP device with: %s...\n") % args; uhd::usrp::multi_usrp::sptr usrp = uhd::usrp::multi_usrp::make(args); std::cout << boost::format("Using Device: %s\n") % usrp->get_pp_string(); //Verify GPS sensors are present (i.e. EEPROM has been burnt) std::vector<std::string> sensor_names = usrp->get_mboard_sensor_names(0); if(std::find(sensor_names.begin(), sensor_names.end(), "gps_locked") == sensor_names.end()) { std::cout << boost::format("\ngps_locked sensor not found. This could mean that you have not installed the GPSDO correctly.\n\n"); std::cout << boost::format("Visit one of these pages if the problem persists:\n"); std::cout << boost::format(" * N2X0/E1X0: http://files.ettus.com/manual/page_gpsdo.html"); std::cout << boost::format(" * X3X0: http://files.ettus.com/manual/page_gpsdo_x3x0.html\n\n"); exit(EXIT_FAILURE); } // Explicitly set time source to gpsdo boost::this_thread::sleep(boost::posix_time::seconds(1)); try { usrp->set_time_source("gpsdo"); } catch (uhd::value_error &e) { std::cout << "could not set the time source to \"gpsdo\"; error was:" <<std::endl; std::cout << e.what() << std::endl; std::cout << "trying \"external\"..." <<std::endl; try { usrp->set_time_source("external"); } catch (uhd::value_error&) { std::cout << "\"external\" failed, too." << std::endl; } } std::cout<< std::endl << "Time source is now " << usrp->get_time_source(0) << std::endl; //Check for GPS lock uhd::sensor_value_t gps_locked = usrp->get_mboard_sensor("gps_locked",0); if(not gps_locked.to_bool()) { std::cout << boost::format("\nGPS does not have lock. Wait a few minutes and try again.\n"); std::cout << boost::format("NMEA strings and device time may not be accurate until lock is achieved.\n\n"); } else { std::cout << boost::format("GPS Locked"); } std::cout << "\nSetting the reference clock source to \"gpsdo\"...\n"; try { usrp->set_clock_source("gpsdo"); } catch (uhd::value_error &e) { std::cout << "could not set the clock source to \"gpsdo\"; error was:" <<std::endl; std::cout << e.what() << std::endl; std::cout << "trying \"external\"..." <<std::endl; try{ usrp->set_clock_source("external"); } catch (uhd::value_error&) { std::cout << "\"external\" failed, too." << std::endl; } } std::cout<< std::endl << "Clock source is now " << usrp->get_clock_source(0) << std::endl; print_notes(); //Check for 10 MHz lock if(std::find(sensor_names.begin(), sensor_names.end(), "ref_locked") != sensor_names.end()) { uhd::sensor_value_t gps_locked = usrp->get_mboard_sensor("ref_locked",0); if(not gps_locked.to_bool()) { std::cout << boost::format("USRP NOT Locked to GPSDO 10 MHz Reference.\n"); std::cout << boost::format("Double check installation instructions (N2X0/E1X0 only): https://www.ettus.com/content/files/gpsdo-kit_4.pdf\n\n"); std::cout << boost::format("Locking the internal reference to the GPSDO might take a second to reach stability. Retrying in 10 s...\n\n"); boost::this_thread::sleep(boost::posix_time::seconds(10)); } if(usrp->get_mboard_sensor("ref_locked",0).to_bool()) { std::cout << boost::format("USRP Locked to GPSDO 10 MHz Reference.\n"); } } else { std::cout << boost::format("ref_locked sensor not present on this board.\n"); } //Check PPS and compare UHD device time to GPS time boost::this_thread::sleep(boost::posix_time::seconds(1)); uhd::sensor_value_t gps_time = usrp->get_mboard_sensor("gps_time"); uhd::time_spec_t last_pps_time = usrp->get_time_last_pps(); //we only care about the full seconds signed gps_seconds = gps_time.to_int(); long long pps_seconds = last_pps_time.to_ticks(1.0); if(pps_seconds != gps_seconds) { std::cout << boost::format("\nGPS and UHD Device time are NOT aligned;\nlast_pps: %ld vs gps: %ld. Trying to set the device time to GPS time...") % pps_seconds % gps_seconds << std::endl; //full next after next second uhd::time_spec_t next_pps_time(gps_seconds + 2.0); //instruct the USRP to wait for the next PPS edge, then set the new time on the following PPS usrp->set_time_unknown_pps(next_pps_time); //allow some time to make sure the PPS has come… boost::this_thread::sleep(boost::posix_time::milliseconds(1100)); //…then ask gps_seconds = usrp->get_mboard_sensor("gps_time").to_int(); pps_seconds = usrp->get_time_last_pps().to_ticks(1.0); } std::cout << boost::format("last_pps: %ld vs gps: %ld.") % pps_seconds % gps_seconds << std::endl; if (pps_seconds == gps_seconds) { std::cout << boost::format("GPS and UHD Device time are aligned.\n"); } else { std::cout << boost::format("Could not align UHD Device time to GPS time. Giving up.\n"); } //print NMEA strings try { uhd::sensor_value_t gga_string = usrp->get_mboard_sensor("gps_gpgga"); uhd::sensor_value_t rmc_string = usrp->get_mboard_sensor("gps_gprmc"); std::cout << boost::format("Printing available NMEA strings:\n"); std::cout << boost::format("%s\n%s\n") % gga_string.to_pp_string() % rmc_string.to_pp_string(); } catch (uhd::lookup_error&) { std::cout << "NMEA strings not implemented for this device." << std::endl; } std::cout << boost::format("GPS Epoch time at last PPS: %.5f seconds\n") % usrp->get_mboard_sensor("gps_time").to_real(); std::cout << boost::format("UHD Device time last PPS: %.5f seconds\n") % (usrp->get_time_last_pps().get_real_secs()); std::cout << boost::format("UHD Device time right now: %.5f seconds\n") % (usrp->get_time_now().get_real_secs()); std::cout << boost::format("PC Clock time: %.5f seconds\n") % time(NULL); //finished std::cout << boost::format("\nDone!\n\n"); return EXIT_SUCCESS; }
int UHD_SAFE_MAIN(int argc, char* argv[]) { uhd::set_thread_priority_safe(); std::string args; // Set up program options po::options_description desc("Allowed options"); // clang-format off desc.add_options() ("help", "help message") ("args", po::value<std::string>(&args)->default_value(""), "Device address arguments specifying a single USRP") ("clock", "query a clock device's sensors") ; // clang-format on po::variables_map vm; po::store(po::parse_command_line(argc, argv, desc), vm); po::notify(vm); // Print the help message if (vm.count("help")) { std::cout << boost::format( "Query GPSDO Sensors, try to lock the reference oscillator to " "the GPS disciplined clock, and set the device time to GPS time") << std::endl << std::endl << desc; return EXIT_FAILURE; } // If specified, query a clock device instead if (vm.count("clock")) { return query_clock_sensors(args); } // Create a USRP device std::cout << boost::format("\nCreating the USRP device with: %s...\n") % args; uhd::usrp::multi_usrp::sptr usrp = uhd::usrp::multi_usrp::make(args); std::cout << boost::format("Using Device: %s\n") % usrp->get_pp_string(); // Verify GPS sensors are present (i.e. EEPROM has been burnt) std::vector<std::string> sensor_names = usrp->get_mboard_sensor_names(0); if (std::find(sensor_names.begin(), sensor_names.end(), "gps_locked") == sensor_names.end()) { std::cout << boost::format("\ngps_locked sensor not found. This could mean that " "you have not installed the GPSDO correctly.\n\n"); std::cout << boost::format("Visit one of these pages if the problem persists:\n"); std::cout << boost::format( " * N2X0/E1X0: http://files.ettus.com/manual/page_gpsdo.html\n"); std::cout << boost::format( " * X3X0: http://files.ettus.com/manual/page_gpsdo_x3x0.html\n\n"); return EXIT_FAILURE; } bool ref_set_to_gpsdo = false; // Set clock source to gpsdo if supported if (uhd::has(usrp->get_clock_sources(0), "gpsdo")) { std::cout << "Setting the reference clock source to \"gpsdo\"..." << std::endl; usrp->set_clock_source("gpsdo"); ref_set_to_gpsdo = true; } std::cout << "Clock source is now " << usrp->get_clock_source(0) << std::endl; // Set time source to gpsdo if supported if (uhd::has(usrp->get_time_sources(0), "gpsdo")) { std::cout << "Setting the reference clock source to \"gpsdo\"..." << std::endl; usrp->set_time_source("gpsdo"); ref_set_to_gpsdo = true; } std::cout << "Time source is now " << usrp->get_time_source(0) << std::endl; if (not ref_set_to_gpsdo) { std::cerr << "ERROR: Unable to set clock or time reference to \"gpsdo\"" << std::endl; return EXIT_FAILURE; } // Check for ref lock if (std::find(sensor_names.begin(), sensor_names.end(), "ref_locked") != sensor_names.end()) { uhd::sensor_value_t ref_locked = usrp->get_mboard_sensor("ref_locked", 0); for (size_t i = 0; not ref_locked.to_bool() and i < 300; i++) { std::this_thread::sleep_for(std::chrono::milliseconds(100)); ref_locked = usrp->get_mboard_sensor("ref_locked", 0); } if (not ref_locked.to_bool()) { std::cout << boost::format("USRP NOT Locked to Reference.\n"); std::cout << boost::format( "Double check installation instructions (N2X0/E1X0 only): " "https://www.ettus.com/content/files/gpsdo-kit_4.pdf\n\n"); return EXIT_FAILURE; } else { std::cout << boost::format("USRP Locked to Reference.\n"); } } else { std::cout << boost::format("ref_locked sensor not present on this board.\n"); } print_notes(); // The TCXO has a long warm up time, so wait up to 30 seconds for sensor data // to show up std::cout << "Waiting for the GPSDO to warm up..." << std::flush; auto end = std::chrono::steady_clock::now() + std::chrono::seconds(30); while (std::chrono::steady_clock::now() < end) { try { usrp->get_mboard_sensor("gps_locked", 0); break; } catch (std::exception&) { } std::this_thread::sleep_for(std::chrono::milliseconds(250)); std::cout << "." << std::flush; } std::cout << std::endl; try { usrp->get_mboard_sensor("gps_locked", 0); } catch (std::exception&) { std::cout << "No response from GPSDO in 30 seconds" << std::endl; return EXIT_FAILURE; } std::cout << "The GPSDO is warmed up and talking." << std::endl; // Check for GPS lock uhd::sensor_value_t gps_locked = usrp->get_mboard_sensor("gps_locked", 0); ; if (not gps_locked.to_bool()) { std::cout << boost::format( "\nGPS does not have lock. Wait a few minutes and try again.\n"); std::cout << boost::format("NMEA strings and device time may not be accurate " "until lock is achieved.\n\n"); } else { std::cout << boost::format("GPS Locked"); } // Check PPS and compare UHD device time to GPS time uhd::sensor_value_t gps_time = usrp->get_mboard_sensor("gps_time"); uhd::time_spec_t last_pps_time = usrp->get_time_last_pps(); // we only care about the full seconds signed gps_seconds = gps_time.to_int(); long long pps_seconds = last_pps_time.to_ticks(1.0); if (pps_seconds != gps_seconds) { std::cout << "\nTrying to align the device time to GPS time..." << std::endl; gps_time = usrp->get_mboard_sensor("gps_time"); // set the device time to the GPS time // getting the GPS time returns just after the PPS edge, so just add a // second and set the device time at the next PPS edge usrp->set_time_next_pps(uhd::time_spec_t(gps_time.to_int() + 1.0)); // allow some time to make sure the PPS has come… std::this_thread::sleep_for(std::chrono::milliseconds(1100)); //…then ask gps_seconds = usrp->get_mboard_sensor("gps_time").to_int(); pps_seconds = usrp->get_time_last_pps().to_ticks(1.0); } if (pps_seconds == gps_seconds) { std::cout << boost::format("GPS and UHD Device time are aligned.\n"); } else { std::cout << boost::format( "Could not align UHD Device time to GPS time. Giving up.\n"); } std::cout << boost::format("last_pps: %ld vs gps: %ld.") % pps_seconds % gps_seconds << std::endl; // print NMEA strings try { uhd::sensor_value_t gga_string = usrp->get_mboard_sensor("gps_gpgga"); uhd::sensor_value_t rmc_string = usrp->get_mboard_sensor("gps_gprmc"); std::cout << boost::format("Printing available NMEA strings:\n"); std::cout << boost::format("%s\n%s\n") % gga_string.to_pp_string() % rmc_string.to_pp_string(); } catch (uhd::lookup_error&) { std::cout << "NMEA strings not implemented for this device." << std::endl; } std::cout << boost::format("GPS Epoch time at last PPS: %.5f seconds\n") % usrp->get_mboard_sensor("gps_time").to_real(); std::cout << boost::format("UHD Device time last PPS: %.5f seconds\n") % (usrp->get_time_last_pps().get_real_secs()); std::cout << boost::format("UHD Device time right now: %.5f seconds\n") % (usrp->get_time_now().get_real_secs()); std::cout << boost::format("PC Clock time: %.5f seconds\n") % time(NULL); // finished std::cout << boost::format("\nDone!\n\n"); return EXIT_SUCCESS; }