|
|
|
@@ -22,16 +22,12 @@
|
|
|
|
|
// SOFTWARE.
|
|
|
|
|
//
|
|
|
|
|
|
|
|
|
|
#ifdef WIN32
|
|
|
|
|
#include <windows.h>
|
|
|
|
|
#else
|
|
|
|
|
#include <unistd.h>
|
|
|
|
|
#endif
|
|
|
|
|
#include <apr_general.h>
|
|
|
|
|
#include <apr_getopt.h>
|
|
|
|
|
#include <thread>
|
|
|
|
|
#include <chrono>
|
|
|
|
|
#include <string.h>
|
|
|
|
|
#include <algorithm>
|
|
|
|
|
#include "lvx_file.h"
|
|
|
|
|
#include "cmdline.h"
|
|
|
|
|
|
|
|
|
|
DeviceItem devices[kMaxLidarCount];
|
|
|
|
|
LvxFileHandle lvx_file_handler;
|
|
|
|
@@ -262,7 +258,7 @@ void OnDeviceBroadcast(const BroadcastDeviceInfo *info) {
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool result = false;
|
|
|
|
|
livox_status result = kStatusFailure;
|
|
|
|
|
uint8_t handle = 0;
|
|
|
|
|
result = AddHubToConnect(info->broadcast_code, &handle);
|
|
|
|
|
if (result == kStatusSuccess) {
|
|
|
|
@@ -275,81 +271,33 @@ void OnDeviceBroadcast(const BroadcastDeviceInfo *info) {
|
|
|
|
|
/** Set the program options.
|
|
|
|
|
* You can input the registered device broadcast code and decide whether to save the log file.
|
|
|
|
|
*/
|
|
|
|
|
int SetProgramOption(int argc, const char *argv[]) {
|
|
|
|
|
apr_status_t rv;
|
|
|
|
|
apr_pool_t *mp = nullptr;
|
|
|
|
|
static const apr_getopt_option_t opt_option[] = {
|
|
|
|
|
/** Long-option, short-option, has-arg flag, description */
|
|
|
|
|
{ "code", 'c', 1, "Register device broadcast code" },
|
|
|
|
|
{ "log", 'l', 0, "Save the log file" },
|
|
|
|
|
{ "time", 't', 1, "Time to save point cloud to the lvx file" },
|
|
|
|
|
{ "help", 'h', 0, "Show help" },
|
|
|
|
|
{ nullptr, 0, 0, nullptr },
|
|
|
|
|
};
|
|
|
|
|
apr_getopt_t *opt = nullptr;
|
|
|
|
|
int optch = 0;
|
|
|
|
|
const char *optarg = nullptr;
|
|
|
|
|
|
|
|
|
|
if (apr_initialize() != APR_SUCCESS) {
|
|
|
|
|
return -1;
|
|
|
|
|
void SetProgramOption(int argc, const char *argv[]) {
|
|
|
|
|
cmdline::parser cmd;
|
|
|
|
|
cmd.add<std::string>("code", 'c', "Register device broadcast code", false);
|
|
|
|
|
cmd.add("log", 'l', "Save the log file");
|
|
|
|
|
cmd.add<int>("time", 't', "Time to save point cloud to the lvx file", false);
|
|
|
|
|
cmd.add("help", 'h', "Show help");
|
|
|
|
|
cmd.parse_check(argc, const_cast<char **>(argv));
|
|
|
|
|
if (cmd.exist("code")) {
|
|
|
|
|
std::string sn_list = cmd.get<std::string>("code");
|
|
|
|
|
printf("Register broadcast code: %s\n", sn_list.c_str());
|
|
|
|
|
broadcast_code_list.clear();
|
|
|
|
|
broadcast_code_list.push_back(sn_list);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (apr_pool_create(&mp, NULL) != APR_SUCCESS) {
|
|
|
|
|
return -1;
|
|
|
|
|
if (cmd.exist("log")) {
|
|
|
|
|
printf("Save the log file.\n");
|
|
|
|
|
SaveLoggerFile();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rv = apr_getopt_init(&opt, mp, argc, argv);
|
|
|
|
|
if (rv != APR_SUCCESS) {
|
|
|
|
|
printf("Program options initialization failed.\n");
|
|
|
|
|
return -1;
|
|
|
|
|
if (cmd.exist("time")) {
|
|
|
|
|
printf("Time to save point cloud to the lvx file:%d.\n", cmd.get<int>("time"));
|
|
|
|
|
lvx_file_save_time = cmd.get<int>("time");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/** Parse the all options based on opt_option[] */
|
|
|
|
|
bool is_help = false;
|
|
|
|
|
while ((rv = apr_getopt_long(opt, opt_option, &optch, &optarg)) == APR_SUCCESS) {
|
|
|
|
|
switch (optch) {
|
|
|
|
|
case 'c': {
|
|
|
|
|
printf("Register broadcast code: %s\n", optarg);
|
|
|
|
|
broadcast_code_list.push_back(optarg);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
case 'l': {
|
|
|
|
|
printf("Save the log file.\n");
|
|
|
|
|
SaveLoggerFile();
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
case 't': {
|
|
|
|
|
printf("Time to save point cloud to the lvx file:%s.\n", optarg);
|
|
|
|
|
lvx_file_save_time = atoi(optarg);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
case 'h': {
|
|
|
|
|
printf(
|
|
|
|
|
" [-c] Register device broadcast code\n"
|
|
|
|
|
" [-l] Save the log file\n"
|
|
|
|
|
" [-t] Time to save point cloud to the lvx file\n"
|
|
|
|
|
" [-h] Show help\n"
|
|
|
|
|
);
|
|
|
|
|
is_help = true;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
if (rv != APR_EOF) {
|
|
|
|
|
printf("Invalid options.\n");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
apr_pool_destroy(mp);
|
|
|
|
|
mp = nullptr;
|
|
|
|
|
if (is_help)
|
|
|
|
|
return 1;
|
|
|
|
|
return 0;
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int main(int argc, const char *argv[]) {
|
|
|
|
|
/** Set the program options. */
|
|
|
|
|
if (SetProgramOption(argc, argv))
|
|
|
|
|
return 0;
|
|
|
|
|
SetProgramOption(argc, argv);
|
|
|
|
|
|
|
|
|
|
printf("Livox SDK initializing.\n");
|
|
|
|
|
/** Initialize Livox-SDK. */
|
|
|
|
|