円と直線の交点

Calendar Clock iconCalendar Clock icon

geometry

目次

# 解説

円の中心座標をCC、半径をRR、直線llが通る2点を左からp1p_1, p2p_2とおく.
円と直線の交点をaabbとおく.

交点を求めるには以下3つの情報があれば良い.

  1. 円Cから直線llへの垂線と直線llとの交点pp.
  2. 直線ll上の単位ベクトルe\vec{e}.
  3. 線分ababの長さ.

1〜3の情報から、交点ppからe\vec{e}のプラスマイナスの方向へ長さab2\frac{ab}{2}だけ進んだ点2つが解となる.

# 1. 交点ppを求める

射影の公式を使って求める.

Vector2 project(Vector2 p1, Vector2 p2, Vector2 c) {
    Vector2 v = p2 - p1;
    return p1 + v * (v.dot(c - p1) / v.norm());
}

# 2. 単位ベクトルe\vec{e}を求める

単位ベクトルはベクトルをその長さで割ると求められる.

Vector2 unitVec(Vector2 v) {
  return v / v.length();
}

# 3. 線分ababの長さを求める

CCから直線llへ垂線を引きllとの交点をppとおく.
この時、点ppは線分ababを2等分する点である.
また、Cpb\angle{Cpb}は直角三角形である.
線分apappbpbの長さは三平方の定理より、

ap=pb=R2Cp2ap = pb = \sqrt{R^2 - |\vec{Cp}|^2}

# 4. 交点を求める

a,b=p+e±apa, b = \vec{p} + \vec{e} \cdot \pm ap

# コード全体

// C++ 14
#include <iostream>
#include <string>
#include <vector>
#include <list>
#include <algorithm>
#include <queue>
#include <stack>
#include <set>
#include <map>
#include <unordered_map>
#include <math.h>

#define ll long long
#define Int int
#define loop(x, start, end) for(Int x = start; x < end; x++)
#define loopdown(x, start, end) for(int x = start; x > end; x--)
#define rep(n) for(int x = 0; x < n; x++)
#define span(a,x,y) a.begin()+x,a.begin()+y
#define span_all(a) a.begin(),a.end()
#define len(x) (x.size())
#define last(x) (*(x.end()-1))

using namespace std;

#define EPS 0.0000000001
#define fequals(a,b) (fabs((a) - (b)) < EPS)

class Vector2 {
public:
  double x, y;
  
  Vector2(double x = 0, double y = 0): x(x), y(y) {}
  
  Vector2 operator + (const Vector2 v) const { return Vector2(x + v.x, y + v.y); }
  Vector2 operator - (const Vector2 v) const { return Vector2(x - v.x, y - v.y); }
  Vector2 operator * (const double k) const { return Vector2(x * k, y * k); }
  Vector2 operator / (const double k) const { return Vector2(x / k, y / k); }
  
  double length() { return sqrt(norm()); }
  double norm() { return x * x + y * y; }
  double dot (Vector2 const v) { return x * v.x + y * v.y; }
  double cross (Vector2 const v) { return x * v.y - y * v.x; }
  
  bool parallel(Vector2 &other) {
    return fequals(0, cross(other));
  }
  
  bool orthogonal(Vector2 &other) {
    return fequals(0, dot(other));
  }
  
  bool operator < (const Vector2 &v) {
    return x != v.x ? x < v.x : y < v.y;
  }
  
  bool operator == (const Vector2 &v) {
    return fabs(x - v.x) < EPS && fabs(y - v.y) < EPS;
  }
};

ostream & operator << (ostream & out, Vector2 const & v) { 
  out<< "Vector2(" << v.x << ", " << v.y << ')';
  return out;
}

istream & operator >> (istream & in, Vector2 & v) { 
  double x, y;
  in >> x;
  in >> y;
  v.x = x;
  v.y = y;
  return in;
}
double R;
Vector2 C, p1, p2;

Vector2 project(Vector2 p1, Vector2 p2, Vector2 c) {
    Vector2 v = p2 - p1;
    return p1 + v * (v.dot(c - p1) / v.norm());
}

Vector2 unitVec(Vector2 v) {
  return v / v.length();
}

pair<Vector2, Vector2> crossPoints() {
  Vector2 p = project(p1, p2, C);
  Vector2 e = unitVec(p2 - p1);
  double len = sqrt(R*R - (p - C).norm());
  Vector2 a = p + e * (-len);
  Vector2 b = p + e * len;
  if (fabs(a.x) < EPS) a.x = 0.0;
  if (fabs(a.y) < EPS) a.y = 0.0;
  if (fabs(b.x) < EPS) b.x = 0.0;
  if (fabs(b.y) < EPS) b.y = 0.0;
  if (a < b) return make_pair(a, b);
  return make_pair(b, a);
}

リモートフリーランス。ウェブサービス、スマホアプリエンジニア。
東アジアを拠点に世界を移動しながら活動してます!

お仕事のご依頼・お問い合わせはこちら

コメント