bool NullLocalization::run(const RobotState & robotState, const GameState & gameState, const VisionFeatures & visionFeatures, Pose & pose) { pose.setPosition(0, 0); pose.setAngle(0); return false; }
Pose toQPose(flatworld::Pose p) { Pose qp; qp.setPosition({p.x, p.y}); qp.setOrientation(p.heading); return qp; }