Formula Student Autonomous Systems
The code for the main driverless system
Loading...
Searching...
No Matches
utils.hpp
Go to the documentation of this file.
1#pragma once
2
3#include <gtsam/geometry/Pose2.h>
4
5#include <Eigen/Dense>
6
7gtsam::Pose2 eigen_to_gtsam_pose(const Eigen::Vector3d& pose);
8
9Eigen::Vector3d gtsam_pose_to_eigen(const gtsam::Pose2& pose);
10
11Eigen::Vector3d pose_difference_eigen(const Eigen::Vector3d& pose1, const Eigen::Vector3d& pose2);
pose_difference_eigen
Eigen::Vector3d pose_difference_eigen(const Eigen::Vector3d &pose1, const Eigen::Vector3d &pose2)
Definition utils.cpp:11
gtsam_pose_to_eigen
Eigen::Vector3d gtsam_pose_to_eigen(const gtsam::Pose2 &pose)
Definition utils.cpp:7
eigen_to_gtsam_pose
gtsam::Pose2 eigen_to_gtsam_pose(const Eigen::Vector3d &pose)
Definition utils.cpp:3