calcperpend.cc

2007年机器人足球世界杯3D仿真组亚军

#include "math.hh"

namespace bats {

  /**
   *  Calculates the perpendicular vector to @v.
   */
  Vector3D Math::calcPerpend(Vector3D const &v)
  {
    return Vector3D(1.0,-1.0/(v.getY()/v.getX()),0.0).normalize();
  }

}