|
Formula Student Autonomous Systems
The code for the main driverless system
|
#include "slam_solver/graph_slam_solver/graph_slam_instance.hpp"#include <gtsam/base/Vector.h>#include <gtsam/geometry/Point2.h>#include <gtsam/geometry/Pose2.h>#include <gtsam/geometry/Rot2.h>#include <gtsam/inference/Symbol.h>#include <gtsam/nonlinear/LevenbergMarquardtOptimizer.h>#include <gtsam/nonlinear/Marginals.h>#include <gtsam/nonlinear/Values.h>#include <gtsam/sam/BearingFactor.h>#include <gtsam/sam/BearingRangeFactor.h>#include <gtsam/sam/RangeFactor.h>#include <gtsam/slam/BetweenFactor.h>#include <gtsam/slam/PriorFactor.h>#include <gtsam/slam/ProjectionFactor.h>#include "common_lib/maths/transformations.hpp"#include "slam_solver/graph_slam_solver/optimizer/isam2_optimizer.hpp"#include "slam_solver/graph_slam_solver/utils.hpp"