-
Notifications
You must be signed in to change notification settings - Fork 0
/
ZAHYOU.go
78 lines (62 loc) · 1.72 KB
/
ZAHYOU.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
//This file is part of EESLISM.
//
//Foobar is free software : you can redistribute itand /or modify
//it under the terms of the GNU General Public License as published by
//the Free Software Foundation, either version 3 of the License, or
//(at your option) any later version.
//
//Foobar is distributed in the hope that it will be useful,
//but WITHOUT ANY WARRANTY; without even the implied warranty of
//MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.See the
//GNU General Public License for more details.
//
//You should have received a copy of the GNU General Public License
//along with Foobar.If not, see < https://www.gnu.org/licenses/>.
/*
モンテカルロ法を用いる際の座標変換
FILE=ZAHYOU.c
Create Date=1999.6.7
*/
package eeslism
import "math"
func ZAHYOU(Op, G XYZ, op *XYZ, wa, wb float64) {
Cwa := math.Cos(wa * math.Pi / 180)
Swa := math.Sin(wa * math.Pi / 180)
Cwb := math.Cos((-wb) * math.Pi / 180)
Swb := math.Sin((-wb) * math.Pi / 180)
p := XYZ{
X: Op.X - G.X,
Y: Op.Y - G.Y,
Z: Op.Z - G.Z,
}
q := XYZ{
X: p.X*Cwa - p.Y*Swa,
Y: p.X*Swa + p.Y*Cwa,
Z: p.Z,
}
op.X = q.X
op.Y = q.Y*Cwb - q.Z*Swb
op.Z = q.Y*Swb + q.Z*Cwb
CAT(&op.X, &op.Y, &op.Z)
}
/*------------------------------------------------------------------*/
func R_ZAHYOU(Op, G XYZ, op *XYZ, wa, wb float64) {
Cwa := math.Cos((-wa) * math.Pi / 180)
Swa := math.Sin((-wa) * math.Pi / 180)
Cwb := math.Cos(wb * math.Pi / 180)
Swb := math.Sin(wb * math.Pi / 180)
p := XYZ{
X: Op.X,
Y: Op.Y*Cwb - Op.Z*Swb,
Z: Op.Y*Swb + Op.Z*Cwb,
}
q := XYZ{
X: p.X*Cwa - p.Y*Swa,
Y: p.X*Swa + p.Y*Cwa,
Z: p.Z,
}
op.X = q.X + G.X
op.Y = q.Y + G.Y
op.Z = q.Z + G.Z
CAT(&op.X, &op.Y, &op.Z)
}