結果

問題 No.1932 動く点 P / Moving Point P
コンテスト
ユーザー tnakao0123
提出日時 2022-05-08 22:51:06
言語 C++14
(gcc 13.3.0 + boost 1.87.0)
結果
AC  
実行時間 527 ms / 6,000 ms
コード長 2,989 bytes
コンパイル時間 638 ms
コンパイル使用メモリ 63,404 KB
実行使用メモリ 21,620 KB
最終ジャッジ日時 2024-07-08 12:40:11
合計ジャッジ時間 20,850 ms
ジャッジサーバーID
（参考情報） 		judge4 / judge1
このコードへのチャレンジ
（要ログイン）
ファイルパターン 結果
sample AC * 1
other AC * 11
権限があれば一括ダウンロードができます

ソースコード

diff # 

/* -*- coding: utf-8 -*-
 *
 * 1932.cc:  No.1932 動く点 P / Moving Point P - yukicoder
 */

#include<cstdio>
#include<cmath>
#include<vector>
#include<algorithm>
 
using namespace std;

/* constant */

const int M = 3;
const int MAX_N = 100000;
const double PI = acos(-1.0);

/* typedef */

struct Mat {
  double v[M][M];
  Mat() {}

  void init() { for (int i = 0; i < M; i++) fill(v[i], v[i] + M, 0.0); }
  void unit() { init(); for (int i = 0; i < M; i++) v[i][i] = 1.0; }

  Mat operator*(const Mat &m) const {
    Mat r;
    for (int i = 0; i < M; i++)
      for (int j = 0; j < M; j++) {
	r.v[i][j] = 0.0;
	for (int k = 0; k < M; k++)
	  r.v[i][j] += v[i][k] * m.v[k][j];
      }
    return r;
  }

};

struct Vec {
  double v[M];
  Vec() {}

  Vec operator*(const Mat &m) const {
    Vec r;
    for (int i = 0; i < M; i++) {
      r.v[i] = 0.0;
      for (int j = 0; j < M; j++)
	r.v[i] += v[j] * m.v[j][i];
    }
    return r;
  }
};

template <typename T>
struct SegTreeOp {
  int e2;
  vector<T> nodes;
  T defv, (*fop)(T,T);
  SegTreeOp() {}

  void init(int n, T _defv, T (*_fop)(T,T)) {
    defv = _defv, fop = _fop;
    for (e2 = 1; e2 < n; e2 <<= 1);
    nodes.assign(e2 * 2, defv);
  }

  T &geti(int i) { return nodes[e2 - 1 + i]; }
  void seti(int i, T v) { geti(i) = v; }

  void setall() {
    for (int j = e2 - 2; j >= 0; j--)
      nodes[j] = fop(nodes[j * 2 + 1], nodes[j * 2 + 2]);
  }

  void set(int i, T v) {
    int j = e2 - 1 + i;
    nodes[j] = v;
    while (j > 0) {
      j = (j - 1) / 2;
      nodes[j] = fop(nodes[j * 2 + 1], nodes[j * 2 + 2]);
    }
  }

  T op_range(int r0, int r1, int k, int i0, int i1) {
    if (r1 <= i0 || i1 <= r0) return defv;
    if (r0 <= i0 && i1 <= r1) return nodes[k];

    int im = (i0 + i1) / 2;
    T v0 = op_range(r0, r1, k * 2 + 1, i0, im);
    T v1 = op_range(r0, r1, k * 2 + 2, im, i1);
    return fop(v0, v1);
  }
  T op_range(int r0, int r1) { return op_range(r0, r1, 0, 0, e2); }
};

/* global variables */

SegTreeOp<Mat> st;

/* subroutines */

Mat op_mul(Mat a, Mat b) { return a * b; }

Mat makemat(double p, double q, double r) {
  Mat m0, m1, m2;
  m0.unit(), m1.unit(), m2.unit();

  m0.v[2][0] = -p, m0.v[2][1] = -q;
  m2.v[2][0] =  p, m2.v[2][1] =  q;

  double th = r * PI / 180;
  double cr = cos(th), sr = sin(th);
  m1.v[0][0] =  cr, m1.v[0][1] = sr;
  m1.v[1][0] = -sr, m1.v[1][1] = cr;

  return m0 * m1 * m2;
}

/* main */

int main() {
  int n;
  scanf("%d" ,&n);

  Mat me; me.unit();
  st.init(n, me, op_mul);

  for (int i = 0; i < n; i++) {
    double pi, qi, ri;
    scanf("%lf%lf%lf", &pi, &qi, &ri);

    Mat mi = makemat(pi, qi, ri);
    st.seti(i, mi);
  }
  st.setall();

  int qn;
  scanf("%d", &qn);

  while (qn--) {
    int si, ti;
    double xi, yi;
    scanf("%d%d%lf%lf", &si, &ti, &xi, &yi);
    si--;

    Mat mi = st.op_range(si, ti);
    Vec wi; wi.v[0] = xi, wi.v[1] = yi, wi.v[2] = 1.0;
    Vec v = wi * mi;
    printf("%.6lf %.6lf\n", v.v[0], v.v[1]);
  }
  return 0;
}
0