bool NullLocalization::run(const RobotState & robotState, const GameState & gameState, const VisionFeatures & visionFeatures, Pose & pose) { pose.setPosition(0, 0); pose.setAngle(0); return false; }
Pose Pose::inverse() { Pose ret; ret.setRotation(_R.inverse()); ret.setAngle(normalize_angle(ret._R.angle())); //#ifdef _MSC_VER // ret._t=ret._R*(Vector2d(_t*-1.)); //#else ret.setTranslation(ret._R*(_t*-1.)); //#endif return ret; }