pose.cpp

Go to the documentation of this file.

#include "control/pose.hpp"
 
#include <iostream>
#include <Eigen/Dense>
 
using namespace galaxis::control;
 
CarPose::CarPose(Eigen::Vector2f const& position, float orientation) {
  this->orientation = orientation;
  this->position    = position;
}
 
std::ostream& operator<<(std::ostream& strm, CarPose const& pose) {
  return strm << "(" << pose.position[0] << ", " << pose.position[1] << "; " << pose.orientation << ")";
}