[Update]: imu assembly

This commit is contained in:
Jacob.lsx 2021-05-31 14:10:01 +08:00
parent 2cb4fe3f05
commit bc53e73549
6 changed files with 13 additions and 3 deletions

View File

@ -31,6 +31,8 @@ int main(int argc, char *argv[]) {
auto &&request = device::select_request(device, &ok);
if (!ok) return 1;
device->ConfigStreamRequest(request);
device->EnableImuCorrespondence(true);
device->EnableProcessMode(ProcessMode::PROC_IMU_ASSEMBLY);
std::size_t left_count = 0;
device->SetStreamCallback(

View File

@ -170,6 +170,7 @@ int main(int argc, char *argv[]) {
api->SetOptionValue(Option::IR_CONTROL, 80);
api->SetDisparityComputingMethodType(DisparityComputingMethod::SGBM);
api->EnableStreamData(Stream::DISPARITY_NORMALIZED);
api->EnableStreamData(Stream::DEPTH);

View File

@ -33,6 +33,7 @@ int main(int argc, char *argv[]) {
api->EnableMotionDatas();
// Enable imu timestamp correspondence int device;
api->EnableImuTimestampCorrespondence(true);
api->EnableProcessMode(ProcessMode::PROC_IMU_ASSEMBLY);
api->Start(Source::ALL);

View File

@ -56,3 +56,7 @@ standard/gyro_range: -1
# index_s_1: 1
standard/request_index: 0
# 0 - none process, 1 - scale and assembly process, 2 - temperature process, 3 - both
standard/imu_process_mode: 1

View File

@ -89,7 +89,7 @@
<rosparam file="$(find mynt_eye_ros_wrapper)/config/mesh/mesh.yaml" command="load" />
<param name="gravity" value="$(arg gravity)" />
<!-- <param name="ros_output_framerate_cut" value="2" /> -->
<!-- <param name="ros_output_framerate_cut" value="4" />-->
</node>
<!-- disable compressed depth plugin for image topics -->

View File

@ -1177,12 +1177,14 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
break;
}
}
std::int32_t process_mode = 0;
if (model_ == Model::STANDARD) {
private_nh_.getParamCached("standard/request_index", request_index);
frame_rate_ = api_->GetOptionValue(Option::FRAME_RATE);
private_nh_.getParamCached("standard/imu_process_mode", process_mode);
api_->EnableProcessMode(process_mode);
}
std::int32_t process_mode = 0;
if (model_ == Model::STANDARD2 ||
model_ == Model::STANDARD210A || model_ == Model::STANDARD200B) {
private_nh_.getParamCached("standard2/imu_process_mode", process_mode);