bool NullLocalization::run(const RobotState     & robotState,
                           const GameState      & gameState,
                           const VisionFeatures & visionFeatures,
                           Pose & pose) {
  pose.setPosition(0, 0);
  pose.setAngle(0);

  return false;
}
Example #2
0
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;
}