#include <gtsam/navigation/CombinedImuFactor.h>
#include <gtsam/navigation/GPSFactor.h>
#include <gtsam/navigation/ImuFactor.h>
#include <gtsam/slam/dataset.h>
#include <gtsam/slam/BetweenFactor.h>
#include <gtsam/slam/PriorFactor.h>
#include <gtsam/nonlinear/ISAM2.h>
#include <gtsam/nonlinear/ISAM2Params.h>
#include <gtsam/nonlinear/NonlinearFactorGraph.h>
#include <gtsam/inference/Symbol.h>
#include <cstring>
#include <fstream>
#include <iostream>
Go to the source code of this file.
Classes | |
struct | GpsMeasurement |
struct | ImuMeasurement |
struct | KittiCalibration |
Functions | |
void | loadKittiData (KittiCalibration &kitti_calibration, vector< ImuMeasurement > &imu_measurements, vector< GpsMeasurement > &gps_measurements) |
int | main (int argc, char *argv[]) |
Variables | |
const string | output_filename = "IMUKittiExampleGPSResults.csv" |
void loadKittiData | ( | KittiCalibration & | kitti_calibration, |
vector< ImuMeasurement > & | imu_measurements, | ||
vector< GpsMeasurement > & | gps_measurements | ||
) |
Definition at line 70 of file IMUKittiExampleGPS.cpp.
Main loop: (1) we read the measurements (2) we create the corresponding factors in the graph (3) we solve the graph to obtain and optimal estimate of robot trajectory
Definition at line 160 of file IMUKittiExampleGPS.cpp.
const string output_filename = "IMUKittiExampleGPSResults.csv" |
Definition at line 68 of file IMUKittiExampleGPS.cpp.