投稿日 11/4/2019最終更新日 11/4/2019

# 解説

２つの線分の交点を求める.

線分を $S1(p_0, p_1)$ , $S2(p_2, p_3)$ とおく.
S1を底辺とみなすと、 $p_2$ と $p_3$ をそれぞれ頂点として三角形が２つ出来る.
これらの高さをそれぞれ $h_1$ , $h_2$ とおく.

高さは、三角形の面積と底辺の長さで求まる.
底辺の長さは $|\vec{p_0 p_1}|$ .
面積は外積の絶対値の二分の一なので、 $\vec{p_0 p_1} \cross \vec{p_0 p_2}$ .

さて、交点を $p$ とおくと、求める $p$ は始点 $p_2$ から長さ $|\vec{p_2 p}|$ だけ $p_3$ に向けて進んだ位置にある.
その長さが分かれば解が求まる.
長さは以下の比を満たす.

|\vec{p_2 p}| : |\vec{p_2 p_3}| = h_1 : h_1 + h_2

求める長さについて変形して、

l = |\vec{p_2 p}| = \frac{|\vec{p_2 p_3}| \times h_1}{h_1 + h_2}

よって、

\vec{p_2 p} = \vec{p_2 p_3} \times l

求めるのはベクトル $\vec{p_2 p}$ ではなく点 $p$ なので、始点を加えてやって

p = p_2 + \vec{p_2 p}

最後に $p.x, p.y$ が0の誤差範囲内であれば0と出力することを忘れずに.

# コード

C++

// 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;
}

Vector2 crossPoint(Vector2 &p0, Vector2 &p1, Vector2 &p2, Vector2 &p3) {
  Vector2 baseSeg = p1 - p0;
  Vector2 crossSeg = p3 - p2;
  double h1 = fabs(baseSeg.cross(p2 - p0)) / (baseSeg.length() * 2);
  double h2 = fabs(baseSeg.cross(p3 - p0)) / (baseSeg.length() * 2);
  Vector2 p = p2 + crossSeg * h1 / (h1 + h2);
  if (fabs(p.x) < EPS) p.x = 0.0;
  if (fabs(p.y) < EPS) p.y = 0.0;
  return p;
}

シュン

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

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

線分の交点

# 解説

# コード

コメント